使用Arduino IDE校准舵机
Last updated
Was this helpful?
Last updated
Was this helpful?
预组装版本的机器人应该已经正确安装了腿，但没有进行微调校准。
校准舵机前请确保您已经上传了OpenCat 。
在校准之前，通电前我们不知道舵机将指向哪里。 所以如果躯干连接上腿部部件，腿会旋转到随机角度，并可能与机器人的身体或其他腿碰撞并被堵转。 如果一个舵机堵转了很长时间，它可能会损坏。
进入（注释掉OpenCat.ino 中的 #define MAIN_SKETCH 并上传）后，您需要在出现提示时输入“Y”或“n”。 之后，所有的技能数据都会保存到控制器的静态内存中。 其中包括一个“校准”技能，这是一个所有关节都处在零位置的姿势。
上传（启用OpenCat.ino 中的#define MAIN_SKETCH 并上传）后，您可以在中输入“c”来校准关节。 该程序将读取“校准”姿势并将舵机旋转到已知位置。 所有舵机都应该从休息姿势旋转到校准位置。 然后你可以一个关节一个关节地连接腿部部件，连接时尽量垂直于周围的身体框架。
Nybble 和 Bittle 的校准原理相同。
进入校准模式需要做好以下准备：
1. 全部舵机线路与主板连接好
2. 电池电量充足
3. 连接好
如果您使用未组装的套件构建机器人，请在校准之前不要安装头，腿组件。 您还需要安装电池并长按电池上的按钮为机器人供电。
校准分为三个步骤：
进入校准模式，使舵机自由转动到中位；
安装各个肢体到校准位；
通过串口监视器微调关节修正量。
检查所有舵机接头插入的位置和方向，您必须把舵机和外接电池都插上NyBoard后才可以正确校准。 在我们安装腿部组件之前，舵机的输出轴应该处于零状态（转到中位然后停下）。
在串口监视器输入c来进入校准模式，舵机应该迅速地依次转到中位然后停下，同时齿轮箱会发出一些声响。由于舵机的起始位置各不相同，有些舵机的转角会大一些。在串口监视器会打印出一列表：
第一行是关节序号，第二行是它们的修正量，第三行是刚刚输入的校准指令。
Index
0
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
Offset
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
初始的关节修正量是 “-1” 或 “0”，需要测定后修改。
输入‘c’指令后，所有舵机都转到了中位，就可以安装之前组装好的舵机关联部件了。它们基本上按照相互垂直的角度互相连接，校准姿势如下图所示:
把舵机关联部件直插到舵机输出轴上，这过程中不要转动舵机输出轴。
关节角使用本体极坐标系，以逆时针转动为正。从机身左侧看，关节逆时针转动定义为正方向。
如果我们仔细观察舵机输出轴，可以发现它上面有一定数量的齿，这些齿可以防止输出轴在转动时相对摇臂滑动。在我们的舵机上，输出轴的圆周被分隔成25个齿，每个齿间隔14.4度（偏移 -7.2~7.2 度）。这意味着我们安装关节时不可能绝对垂直，只能尽可能地接近垂直。
比如:
c8 6表示给8号舵机+6度的修正量。对于每个舵机都需要进行这样的校准以使各部位转动到校准位。
c0 -4 表示给0号舵机-4度的修正量。
修正量的分辨率是1度，不要使小数。
找到可以使肢体达到零状态的最佳偏移量。 这是一个反复试验的过程。
校准后，记得要输入s来保存修正量，否则程序重启后它们就失效了。您甚至可以每校准一个舵机就保存一次。
实际测量时，我们的观测会由于透视关系而产生偏差，这也是为什么我们在读直尺的刻度时要尽量在尺的上方平视。
在校准机器人的关节时，保持平视也特别重要，所以我提供了“L”形的关节校准器辅助参考。按先调4个肩关节（8~11）后调4个膝关节（12~15）的顺序依次校准，目标是使校准器的三个尖角同时对准舵机螺丝或脚尖孔洞的圆心。在校准每个关节时，要从圆心-尖角的延长线上平视观察，校准器的三角窗口边应该和小腿上的三角窗口边平行。
校准后，可在串口监视器输入d或kbalance验证效果。机器人会在对应的休息和站立姿势间切换，它的四肢应该是前后、左右对称的。
您可能需要进行几轮校准才能达到最佳状态。
试着了解机器从如何在步行过程中保持平衡。如果要向机器人身体上添加新部件，请尽最大努力在脊柱周围对称分布其重量。也可以前后滑动电池座，以找到最佳的平衡位置。由于电池的前半部分较重，必要时您也可以反向插入电池，以使重心更多地向后移动。
请不要强行为机器人增加过重的物品，可能导致舵机扫齿或卡住。
校准的指令格式（参考）是cIndex Offset，Index是舵机编号， Offset是校准修正量。注意Index和Offset之间有空格。 机器人舵机编号如下图所示：
