13
/
18
download SCServo library files to the local computer, and then put decompression into the librar
ies folder. At last run the Arduino software.
SCServo Arduino
库文件使用说明
SCServo Arduino lib instructions
先将SCServo 库引入程序头文件 #include <SCServo.h>
初始化必须设置串口通讯波特率，SCServo 出厂默认波特率设置是1M。
Serial.begin(1000000);//init Serial baudrate
SCServo 扭力输出使能指令有两个输入参数（SCServo.EnableTorque(ID,bit)），输入参数一是
ID（0～255），其中0xfe是广播ID；输入参数二是使能标志位，其中“1”为使能打开，“0”为
使能关闭。如使能处于关闭状态，那么舵机将没有任何扭力输出，但通讯正常工作。
SCServo.EnableTorque(1,1); //Enable ID 1 SCServo output torque; ON
SCServo.EnableTorque(1,0); //Enable ID 1 SCServo output torque; OFF
SCServo.EnableTorque(0xfe,1);// Enable ALL SCServo output torque; ON
SCServo.EnableTorque(0xfe,0); //Enable ALL SCServo output torque; OFF
读取SCServo 舵机当前位置信息指令有一个输入参数并返回一个参数。输入参数为SCServo ID，
一次只能读取一个ID的当前位置信息，此指令ID 不可以使用广播ID。
使用广播ID时指令是不作
数据返回的
。返回一个参数的数据类型是short型（即两个字节以上）。
#define
s16
short
s16 pos = SCServo.ReadPos(1);//read Servo ID:1 position
写位置指令需要三个输入参数。输入参数一是 ID（0～255）），其中 0xfe 是广播 ID；输入参数
二是位置数值（0～1023 有效对应转动角度是 0～215 度，但实际转动角度会受到位置限制参数
设置影响）；输入参数三是舵机运行速度级别（1～100），“1”对应舵机最慢转动速度级，“100”
对应最高转动速度级。当此指令对应 ID 的舵机收到指令后马上执行动作，不作任何等待。
SCServo.WritePos(0xfe,i,100);//All Servo(broadcast) rotate to the position i with max
speed
异步写指令（RegWritePos(ID,X,Y)）必须与执行指令(RegWriteAction())配合使用才可以达到
写指令的效果，即异步写指令输入同写指令一样三个参数后，接收到此指令的舵机必须还要收到
执行指令后才进行对异步写指令动作，否则保持前一指令动作。
SCServo.RegWritePos(1, 512, 100);
SCServo.RegWritePos(2,512, 100);
SCServo.RegWriteAction(); When SCServo receive this
instruction will action to rotation
同步写指令（SyncWritePos (ID,I,X,Y)）需要四个输入参数。输入参数 ID 是含 1 个或含多个
ID 的数组，输入参数二定义第一个参数 ID 的数值个数，输入参数三是位置数值（0～1023 有效
对应转动角度是 0～215 度，但实际转动角度会受到位置限制参数设置影响）；输入参数四是舵
机运行速度级别（1～100），“1”对应舵机最慢转动速度级，“100”对应最高转动速度级。当
此指令对应 ID 的舵机收到指令后马上执行动作，不作任何等待。
ID[0] = 1;
ID[1] = 2;
