1. 功能描述

     R111样机是一款拥有12个自由度的串联仿生六足机器人。本文示例所实现的功能为：R111样机12自由度六足机器人原地舞蹈。

2. 结构说明

     R111样机（R111b）由6个2自由度连杆仿生腿结构组成，2自由度连杆仿生腿两两对称组合，分别构成机器昆虫的三对足。三对足之间由零件结合固定，从而构成机器昆虫的本体，呈现出非常规整的模块化结构。

      该2自由度串联结构由舵机1和舵机2驱动，其中舵机1实现腿部前后摆动，舵机2实现腿部的上下抬伸。其中抬伸通过一个平行四连杆ABCD作为传动结构以增加腿部的行程和增强腿部运动的稳定性。

3. 电子硬件

在这个示例中，我们采用了以下硬件，请大家参考：

电路连接说明：

因为12自由度六足机器人结构上装有12个舵机，所以将采用 SH-SR舵机扩展板 。

舵机接线顺序：1、3； 4、 5； 6、 8；11、13；15、 21；24、26。

4. 功能实现

上位机：Controller 1.0

下位机编程环境：Arduino 1.8.19

4.1初始位置的设定

① 将Controller下位机程序servo.ino直接下载到主控板。这段代码供Controller上位机与主控板通信，并允许调试舵机。代码如下：

下载完成后，保持主控板和电脑的USB连接，并打开主控板电源，以便利用上位机进行调试。

② 双击打开Controller 1.0b.exe：

③ 点击联机，选择对应的端口号，波特率设置为9600，如下图所示：

控制块内容说明如下：

④ 此时上位机软件已经与下位机建立通信连接，我们拖动舵机引脚号对应的滑块即可对舵机进行角度调节。下图为软件中各个按钮说明：

⑤ 设置面板说明：点击左上角设置-设置面板，即可打开（如下图）。点击对应序号的复选框即可控制软件主界面中相应控制块的显示和隐藏，以及全部显示和全部隐藏等；点击重置按钮，可将各个控制块恢复初始位置；点击确定可关闭设置界面。

⑥ 控制块任意位置拖动：如下图，可拖动至需要的形状。

注：每次重启会恢复初始位置。

3.2 示例程序

调试好角度后，将角度参数复制到下面的12自由度六足机器人原地舞蹈的参考例程（robot_dance.ino）之中，并下载到主控板：

      对于机器人来说，实现某一个自身结构的极限动作并不难，难度在于如何让动作变得有节奏-舞蹈。因为机器人无法达到人体的柔和度，所以为了让机器人跳舞更具有观赏性，建议大家选择节奏点清晰的音乐，尝试根据音乐节奏来设计舞蹈动作。

4. 扩展样机

     改变足对之间的连接零件，就可以扩展出不同的样机，甚至还可以考虑在足对之间加入关节，使其具备更丰富的自由度。

5. 资料下载

资料内容：

①样机3D文件

②原地舞蹈-例程源代码

③Controller1.0b资料包

④音乐素材.mp3

资料下载地址：https://www.robotway.com/h-col-197.html

想了解更多机器人开源项目资料请关注 机器谱网站 https://www.robotway.com