8自由度并联腿机器狗实现行走功能
本帖最后由 机器谱 于 2023-6-6 11:16 编辑1. 功能说明
本文示例将实现R309a样机8自由度并联腿机器狗行走的功能。
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAg5picowYoveW3PTDAHDjRHA!400x400.png.webp
2. 并联仿生机器人结构设计
机器狗是一种典型的并联仿生四足机器人，其腿部结构主要模仿了四足哺乳动物的腿部结构，主要由腿部的节段和旋转关节组成。在设计机器狗的腿部结构时，可基于四足哺乳动物的生理结构，使用连杆代替腿部的骨骼来提高机器人的性能，机器狗腿部采用5连杆结构设计。
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAg1p2cowYogK7czAYwkAI47gM!400x400.png.webp 五杆结构是平面连杆结构的一种，具有两个自由度的平面闭链五杆机构不仅使运动机构的刚度增加，更突出的优点在于它能够实现变轨迹的运动。
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAgp56cowYoua7tvgYwkAM4iwE.png.webp五杆结构
腿部旋转关节单元设计
腿部的旋转关节是机器人中很重要的一部分，它是整个机器人中的关键运动单元，关节的设计往往决定了机器人的运动特性和精度。关节单元主要是负责连接相邻的两端节段，从而实现腿部的摆动。由于腿部是往复运动，因此关节单元的设计要符合循环负载的载荷规律。
关节结构如图：
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAgiJ_cowYo9sCdQDD6ATjgAg!300x300.png.webp旋转关节结构图
侧摆关节设计
侧摆关节的主要作用是给机器狗提供回转方向的自由度，使机器狗的腿部能够偏离竖直平面运动，从而实现转弯、侧移、抗侧向冲击等步
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAg4J_cowYooNatigYw3QU41wU!600x600.png.webphttps://28846868.s21i.faiusr.com/4/ABUIABAEGAAgrKCcowYo8onXrQcwiAU43wI!400x400.png.webp组合后的机器狗的腿部结构图
机器狗的腿部关节大体分为两类，第一类是如四足哺乳动物前腿的肘关节一样的腿部关节设计，另一类是类似四足哺乳动物后腿的膝关节的腿部关节制造。基于以上原理，科学家们设计出四类机器狗的腿部结构：全膝式、全肘式、内膝肘式、外膝肘式。
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAg_aCcowYouMiHxgUw-AU4_gQ!600x600.png.webp腿部结构有四种形式
腿部的空间运动区域如下图：
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAgzKGcowYo3MmIJzDPBDjPAw!400x400.png.webp
各种布置结构的运动空间如下图：
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAg-qGcowYo_eiCcTCnBjiPBA!700x700.png.webp
内膝式结构条件下，运动中的机器狗内部结构质心曲线最为平滑，因此该结构也是最稳定的，为两侧提供的运动空间也更大。此外，运动时机器狗腿部重合的范围也缩小了。基于以上因素，内膝式结构条件有利于机器人的稳定操作。
3. 并联仿生机器人运动算法
在日常生活中，狗的品种、体型不尽相同，因此其运动状态也是多种多样，我们将以生活中最常见的一种运动状态进行分析。在研究中，我们可以通过对狗的行走过程进行高速摄影，抓拍到狗行走的运动全过程，如下图所示：
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAg3qKcowYo9v2BrAQw6wQ4ggM.png.webp狗行走过程分解图
然后我们可以对其中一条腿进行分析，将重叠其放在一个相对狗自身静止的坐标系中，如下图所示：
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAgt6WcowYo5KWmqQEw_gY4lQM!600x600.png.webp单条腿末端的运动轨迹 根据图示分析，我们可以将狗的腿部运动简单分为与地面接触的支撑阶段和离开地面的跨越阶段。将足部点相连，可近似得到如上图虚线所示的“馒头”状轨迹，支撑段——足接触地面且相对于地面静止不动，身体相对于地面前移；跨越段——足在空中运动，跨越障碍物。
要想让机器狗像真正的狗一样走路，我们就需要控制舵机，让机器狗的腿部走出类似上图中的“馒头”状轨迹。这段轨迹不能超出我们设计的机器狗腿部的运动范围，如下图所示（蓝色阴影区域为机器狗腿部结构的运动范围）:
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAg1KacowYonY3rpAYw_gI44AE.png.webp机器狗腿部结构的运动范围
从而得到“馒头”状轨迹曲线的坐标。
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAgsqecowYooPHwkgYwjQo4mQU!600x600.png.webp坐标系下的腿部末端运动轨迹
于是我们可以根据这个坐标为“馒头状”轨迹指定一个合适的方程，图中轨迹弧线部分可近似取为一个椭圆。
取轨迹原点在真实坐标系中的位置（x0,y0）
取椭圆两半轴长 a=4, b=3
则该椭圆方程为：
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAgkKmcowYoh7zpuwUwwwE4Qw.png.webp
或者：
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAgwKmcowYoi-2gpgUwiwI4Pg.png.webp
底部直线方程为：
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAg26mcowYo_MjV7QYw2QE4Hg.png.webp
通过这个方程，再结合机器狗腿部机构运动公式，即可反推出舵机的一系列运动参数。
机器狗的行进步态
机器狗是四足行走机构，由于四足动物运动的稳定性，相对于双足行走的人来说，其运动步态比较简单，大多机器狗简单的采用前后脚差90度或180度。
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAgpqucowYoion5gwMw8wI49wI!300x300.png.webp机器狗模型
机器狗采用前后脚差180度时的脚部运动落地顺序图如下（注：白色为要抬起的脚，灰色不抬起的脚）
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAg_aucowYojKmDnAMwnAY47wM!600x600.png.webp
机器狗采用前后脚差90度时的脚部运动落地顺序图如下：
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAgvqycowYoj6DKQjCzBzi3Aw!600x600.png.webp
机器狗四条腿腿同时动的时候的动作效果包括整体下蹲、整体站立、身体前后俯仰、身体侧翻等，效果图如下所示：
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAguK2cowYomOjAuQEwrQY4zAg.png.webp4. 电子硬件
本实验中采用了以下硬件：
主控板Basra主控板（兼容Arduino Uno）
扩展板Bigfish2.1扩展板
SH-SR舵机扩展板
电池7.4V锂电池
电路连接说明：将8个舵机连接在SH-SR扩展板上，舵机接线顺序为：1、2、3、4、5、6、7、8
https://28846868.s21i.faiusr.com/2/ABUIABACGAAg6a_cowYo37-lnwcwwB840Bc!600x600.jpg.webp
5. 功能实现
上位机：Controller 1.0
下位机编程环境：Arduino 1.8.19
5.1 调试舵机角度
机器大狗可以实现站立、下蹲、前趴、后仰的功能。我们可以利用上位机 Controller软件【https://www.robotway.com/h-col-129.html】调整大狗的舵机角度，记录下站立、下蹲、前趴、后仰 时舵机的角度；然后利用Arduino IDE进行下位机编程，利用这些角度实现大狗的预期效果。
对于8自由度的大狗，利用Controller软件进行调试角度界面（如下图所示）：
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAgtLecowYokd_M5wcwqgg40wU!600x600.png.webp
经过调试，对大狗的下蹲、站立、前趴、后仰四个功能的舵机角度值见下表：
功能
舵机角度值
下蹲
1069,736,1855,2174,1746,1839,1007,850
站立
1365,1163,1522,1837,1657,939,1253,1341
前趴
1069,736,1855,2174,1657,939,1253,1341
后仰
1365,1163,1522,1780,1746,1839,1007,850
利用上位机测出的舵机角度，可进行下位机编程。
5.2 示例程序
下面提供一个8自由度并联腿机器狗行走的参考例程（Dog_Walk.ino），具体实验效果可参考官网演示视频。
/*------------------------------------------------------------------------------------
版权说明：Copyright 2023 Robottime(Beijing) Technology Co., Ltd. All Rights Reserved.
Distributed under MIT license.See file LICENSE for detail or copy at
https://opensource.org/licenses/MIT
by 机器谱 2023-05-17 https://www.robotway.com/
------------------------------*/
#include "leg.h"
#include "gait.h"
#include "sensor.h"
enum{DOGBALANCE=1,DOGWALK,DogObstacleAvoidanceWalk};
float Eular; /* 欧拉角 */
void setup() {
// put your setup code here, to run once:
Serial.begin(115200);
Serial.begin(115200);
sensorSetup();
delay(3000);
}
void loop() {
// put your main code here, to run repeatedly:
Dog_Walk(); //狗前进（行走）
}
void Dog_Walk()
{
static long t_control = millis();
static int t0 = millis();
if(t_control){ t0 = millis(); }
if ((millis() - t_control) > 50)
{
float x, y;
long t = millis() - t0;
gait(t, 0.5, x, y, forwardGait);
gait(t, 0, x, y, forwardGait);
gait(t, 0, x, y, forwardGait);
gait(t, 0.5, x, y, forwardGait);
leg0.footPos(x, y);
leg1.footPos(x, y);
leg2.footPos(x, y);
leg3.footPos(x, y);
t_control = millis();
}
}
6. 扩展样机
本样机可以做出一些扩展，如下图所示的在样机上方增加一个平板。
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAgisqcowYouvn5ygIw5wM4kQM!400x400.png.webp
7. 资料下载
资料内容：
①行走-例程源代码
②行走-样机3D文件
资料下载地址：https://www.robotway.com/h-col-228.html
想了解更多机器人开源项目资料请关注 机器谱网站 https://www.robotway.com
页:
[1]