命令格式说明
位置值计算:
逆时针:位置值 = 角度 × (编码器分辨率 ÷ 360)
顺时针:位置值 = -角度 × (编码器分辨率 ÷ 360)
对于顺时针旋转的负值,需要转换为16位有符号整数的补码:
- 正数:直接转换为16进制
- 负数:取绝对值,转换为16进制,然后取补码(0xFFFF - 值 + 1)
- 例如:-2000的补码 = 0xFFFF - 0x07D0 + 1 = 0xF830
示例1: 逆时针旋转72度
72 × (10000 ÷ 360) = 72 × 27.7778 ≈ 2000 = 0x07D0
位置控制命令: 23 02 20 01 07 D0 00 00
示例2: 顺时针旋转72度
-72 × (10000 ÷ 360) = -72 × 27.7778 ≈ -2000
-2000的补码: 65536 - 2000 = 63536 = 0xF830
位置控制命令: 23 02 20 01 F8 30 00 00