授之以鱼,不如授之以渔。
最简单的创作新技能并生成技能数组的方法是使用技能创作坊。 关闭电源并重新启动后新技能仍可以保留,但是,通过技能编辑器导出的技能只是暂时地存储在EEPROM中,会被后来导出的新技能覆盖,所以您无法在一个程序中方便地调用两个新技能。 本章重点说明 OpenCat 技能相关的代码和数据结构,以便您可以将任意数量的新技能集成到源代码中。
熟悉上传程序固件(参考Nybble/Bittle用户手册第3章),组装流程(参考Nybble/Bittle用户手册第4章),校准舵机(参考Nybble/Bittle用户手册第6章)。 使用红外遥控器验证以下函数是否按预期工作。
机器人的所有技能数组定义在Instinct***.h
文件中。
Nybble: InstinctNybble.h
Bittle: InstinctBittle.h
以下是一个Instinct***.h
文件的缩略示例:
技能数组的数据结构含义如下图所示:
技能数组中第1个元素表示技能所包含所有动作帧的总数量,数值前如果有负号(-)表示此技能是一种行为。
上述数据结构示意图中,休息(rest) 是一种姿势。它只有1个动作帧(1行数据)。
向前爬行(crF) 是一种步态。 它包含 36 个动作帧(36行数据)。
技能数组中第2个元素和第3个元素表示身体方向期望值,即机器人在执行技能动作时身体保持的倾斜角度,分别对应身体的横滚角(Roll)和俯仰角(Pitch)。当机器人在执行技能动作时,如果身体倾斜度偏离了期望值,平衡算法将对相关腿部舵机的角度值做一些调整,以使身体倾斜度尽量保持在期望值附近。
上图所示机器人的俯仰角(Pitch),横滚角(Roll)都处于0度位置。左图中,机器人身体从0度位置绕中心点逆时针旋转,俯仰角为正值;顺时针旋转,俯仰角为负值。右图中,机器人身体从0度位置绕中心点逆时针旋转,横滚角为正值;顺时针旋转,横滚角为负值。
请看以下示例代码,站立:
坐:
数组中第 2 个元素和第 3 个元素表示身体方向期望值(对应身体的横滚角和俯仰角),单位是度。
激活陀螺仪后,轻微旋转 Bittle身体,当机身发生倾斜偏离了身体方向期望值时,平衡算法会以使机身尽量保持该姿势。
舵机序号如下图所示:
关节舵机旋转的角度范围请控制在[-125~125]之间,对于腿部舵机,在机器人的左侧观测,腿部从0度位置绕关节中心点(螺钉固定位置)逆时针旋转,角度为正值;顺时针旋转,角度为负值;在机器人的右侧观测,腿部旋转角度与左侧成镜像对称(从0度位置绕关节中心点顺时针旋转,角度为正值;逆时针旋转,角度为负值)。对于机器人颈部舵机,从机器人头顶向下俯视,颈部从0度位置绕关节中心点(螺钉固定位置)逆时针旋转,角度为正值;顺时针旋转,角度为负值。
对于Nybble头部舵机(1号舵机)在机器人的右侧观测,头部从0度位置绕关节中心点(螺钉固定位置)逆时针旋转,角度为正值;顺时针旋转,角度为负值。
对于Nybble尾部舵机(2号舵机)面对尾部向下俯视,尾部从0度位置绕中心点(螺钉固定位置)逆时针旋转,角度为正值;顺时针旋转,角度为负值。
技能数组中的每个动作帧都包含多个舵机的旋转角度值。
上述数据结构示意图中,休息(rest)动作帧中其中包含有16 个关节舵机角度值,对应舵机序号从0开始从小到大依次排列。
向前爬行(crF )中每个动作帧包含 8 个关节舵机角度值,对应舵机序号从8开始从小到大依次排列。
技能数组中第4个元素表示角度比率。当需要存储超出 -128 到 127 范围内的角度值时,可以增大角度比率值。比如将角度比率设置为 2,技能数组中所有关节舵机的角度值乘以2才是舵机的实际旋转角度。
请看以下示例技能数组 rc(四脚朝天后恢复站立):
数组中第 4 个元素(2)表示角度比率。 这意味着所有关节转动的实际角度值都等于数组中每一个关节角度值(从第8个元素开始)乘以此角度比率。
姿势技能数组只包含一个动作帧。以Bittle为例,在InstinctBittle.h
中找到 zero数组:
修改其中一些关节舵机角度值:
保存修改,将主功能程序OpenCat.ino上传到Bittle主板上。上传完成后,点击红外遥控器上的按钮 (7, 3) 即可看到修改过的零技能,新的姿势如下图所示:
数组中第一个元素(1)表示该技能的总帧数,1表示是姿势技能。
数组中第 4 个元素 (1) 表示角度比。 这意味着以下所有索引关节角度都是实际角度(因为它们中的每一个都乘以 1)。
数组中从第 5 到第 20 个元素分别代表 16 个关节在当前帧中各自对应的角度值。
对于 Bittle,数组中第 5 个元素(70,对应舵机序号0)表示 Bittle 颈部的舵机逆时针旋转 70度。 Bittle 的头转向机身左侧。
数组中第 13 个元素(-60,对应舵机序号8)表示 Bittle 的左前大腿围绕关节中心点顺时针旋转 60度。
数组中第 17 个元素(60,对应舵机序号12)表示 Bittle 的左前小腿绕关节中心点逆时针旋转 60度。
其他关节角度保持 0度不变。
步态技能数组包含多个连贯的动作帧,而且这些动作帧按照顺序循环不断重复执行,除非机器人收到新的技能命令,才会停止执行。例如后退(bk)步态技能数组定义如下所示:
数组中第一个元素 (35) 表示此技能有 35 个动作帧。 从第二行数据开始,每行是一个动作帧,其中包含了8 个关节舵机的角度值,对应舵机序号从8开始从小到大依次排列(共 35 行)。
对于步态技能,未来每个动作帧可能包含 12 个关节舵机角度值,对应舵机序号将从4开始从小到大依次排列,这取决于参与运动的腿部舵机数量。
行为技能数组同样包含了多个连贯的动作帧,而且所有动作帧按照顺序只执行一轮,但其中一部分连续动作帧可以循环执行多次。例如俯卧撑(pu)行为技能数组定义如下所示:
此数据结构包含了比姿势和步态更多的信息:
第1行的4个元素含义如前所述,其中第一个元素(总帧数)为负数,表明此技能是一个行为。
第2行的3个元素表示这个行为中包含的循环结构:开始帧,结束帧,循环次数。
示例中的 6, 7, 3 表示这个行为从第 7 帧到第 8 帧循环执行 3 次(帧序号从 0 开始)。 整个行为的动作序列只执行一轮,而不会像步态那样不断循环执行。
每个动作帧包含20个元素。前 16 个元素如前所述表示关节舵机的角度,对应舵机序号从0开始从小到大依次排列。后 4 个元素含义分别如下:
第一个表示速度因子。默认的速度因子是 4,它可以更改为从 1(慢)到 127(快)的整数。 单位是每步的度数。 如果设置为 0,舵机将以最大速度(约 0.07 秒/60 度)旋转到目标角度。 除非您了解风险,否则不建议使用大于 10 的值。
第二个表示延迟时间。默认延迟为 0。可设置范围为 0 到 127,单位为 50 毫秒(如设置为2,则实际延迟 100 毫秒)。
第三个表示触发轴。用来设置机器人触发下一帧动作时的身体旋转方向,有以下5个设置选项
0 表示无触发轴,解发角条件设置
1 表示正俯仰,机器人身体向前俯下方向旋转
-1 表示负俯仰,机器人身体向后仰起方向旋转
2 表示正横滚,机器人身体向自身左侧翻滚
-2 表示负横滚,机器人身体向自身右侧翻滚
第四个表示是触发角度。角度值正负含义与身体方向期望值相同。 触发角设置范围:-125 ~ 125 之间的整数值。
注意:
触发轴与触发角度需搭配使用:只有当机器人在完成此帧动作后,并按照设置的身体旋转方向旋转越过触发角度时,才会触发下一帧动作。如果触发轴设置为0时,触发角度大小则无意义。所以触发轴设置为0时,触发角度一般也随之设置为0。
如果动作帧中还设置了延迟时间,那么机器人在运行此动作帧时,不但要满足触发轴,触发角设置的触发条件,还要达到延时设置时长,才会触发执行下一帧动作。
EEPROM 的擦写次数有限(1,000,000次),为了尽量减少写入操作,定义两种技能:本能(Instinct)和 新技(Newbility)。它们的索引地址都作为查找表保存在芯片(ATmega328P)内置的EEPROM(1KB)里,但主体的数据却存在不同的存储单元:
I2C EEPROM (8KB) 存储本能(Instinct) 本能是指固定技能(或偶尔需要微调),可以把它们理解成“肌肉记忆”。
Flash (与Arduino程序代码分享32KB存储空间) 存储新技(Newbility) 新技是指用户自定义技能(可能修改增删)。它们并不会被写入静态的EERPOM,而是与Arduino程序代码一起上传至闪存(Flash)中。它们的索引地址由代码执行时实时分配,只要技能总数(包括所有本能和新技能)不变,该值很少改变。
具体示例代码如下:
在字符指针数组skillNameWithType中给每个技能数组名称加了一个后缀,“N”表示是新技,“I”表示是本能。
const char* progmemPointer[] = {crF, pu, rest, zero, };
这部分代码在上传主板配置程序时处于激活动状态。 它包含所有技能的数据和指针。
const char* progmemPointer[] = {zero};
这部分代码在上传主要功能程序时处于激活状态。 由于本能已经保存在外部I2C EEPROM 中,因此此处省略了它们的数据以节省空间。 如果只是对已有新技能(比如zero
)做动作调整,就无需重新上传主板配置程序了。
在创作或调试技能动作时可以采用以下两种方法:
通过运行Python脚本控制机器人做动作,详情请参考serialMaster使用指南。
Github中的SkillLibrary文件夹是OpenCat 机器人可以执行的新技能的集合,可以供您参考,使用。也欢迎您通过向此文件夹发送合并请求来分享您的新技能。
另一个方向是为Bittle建立模型及模拟环境,然后在现实中测试模型。您可以使用Bittle的统一机器人描述格式(URDF)文件并设置NVIDIA Omniverse进行模拟训练。
新增以 I 结尾的新技(testI)数组,需要在示例代码宏判断第1个分支中加入技能数组变量名(test),具体代码修改如下所示:
新增以 N 结尾的新技(testN)数组,需要在示例代码宏判断两个分支中都加入技能数组变量名(test),具体代码修改如下所示:
完成程序代码修改后,请将程序上传到主板上进行验证:
使用Arduino IDE上传主板配置程序后,打开串口监视器,当串口提示以下内容时:
输入‘Y’ 或者 ‘n’ 后,所有本能数组将一次性存储在I2C EEPROM里,同时所有技能的索引地址也会被生成并存储在芯片内置的EERPOM里,之后再上传主要功能程序。具体操作流程请参考为NyBoard上传程序中相关章节。
验证技能动作时,可以打开串口监视器,通过串口指令 ‘k’ 口令召唤。比如,ksit
可以Bittle变换到坐的姿势。
通过添加一些扩展模块(比如手势传感器),可以帮助机器人更好地感知环境甚至做出决策。 通过积累这些自动的行为,并设计决策树最终实现机器人的全自动智能运行!