8自由度并联腿机器狗实现行走功能_机械狗编程代码

       腿部的旋转关节是机器人中很重要的一部分，它是整个机器人中的关键运动单元，关节的设计往往决定了机器人的运动特性和精度。关节单元主要是负责连接相邻的两端节段，从而实现腿部的摆动。由于腿部是往复运动，因此关节单元的设计要符合循环负载的载荷规律。

关节结构如图：

侧摆关节设计

      侧摆关节的主要作用是给机器狗提供回转方向的自由度，使机器狗的腿部能够偏离竖直平面运动，从而实现转弯、侧移、抗侧向冲击等步

       机器狗的腿部关节大体分为两类，第一类是如四足哺乳动物前腿的肘关节一样的腿部关节设计，另一类是类似四足哺乳动物后腿的膝关节的腿部关节制造。基于以上原理，科学家们设计出四类机器狗的腿部结构：全膝式、全肘式、内膝肘式、外膝肘式。

腿部的空间运动区域如下图：

 各种布置结构的运动空间如下图：

      内膝式结构条件下，运动中的机器狗内部结构质心曲线最为平滑，因此该结构也是最稳定的，为两侧提供的运动空间也更大。此外，运动时机器狗腿部重合的范围也缩小了。基于以上因素，内膝式结构条件有利于机器人的稳定操作。

3. 并联仿生机器人运动算法

      在日常生活中，狗的品种、体型不尽相同，因此其运动状态也是多种多样，我们将以生活中最常见的一种运动状态进行分析。在研究中，我们可以通过对狗的行走过程进行高速摄影，抓拍到狗行走的运动全过程，如下图所示：

      然后我们可以对其中一条腿进行分析，将重叠其放在一个相对狗自身静止的坐标系中，如下图所示：

       根据图示分析，我们可以将狗的腿部运动简单分为与地面接触的支撑阶段和离开地面的跨越阶段。将足部点相连，可近似得到如上图虚线所示的“馒头”状轨迹，支撑段——足接触地面且相对于地面静止不动，身体相对于地面前移；跨越段——足在空中运动，跨越障碍物。

      要想让机器狗像真正的狗一样走路，我们就需要控制舵机，让机器狗的腿部走出类似上图中的“馒头”状轨迹。这段轨迹不能超出我们设计的机器狗腿部的运动范围，如下图所示（蓝色阴影区域为机器狗腿部结构的运动范围）:

       从而得到“馒头”状轨迹曲线的坐标。

       于是我们可以根据这个坐标为“馒头状”轨迹指定一个合适的方程，图中轨迹弧线部分可近似取为一个椭圆。

       取轨迹原点在真实坐标系中的位置

       取椭圆两半轴长

       则该椭圆方程为：

       或者：

       底部直线方程为：

       通过这个方程，再结合机器狗腿部机构运动公式，即可反推出舵机的一系列运动参数。

机器狗的行进步态

      机器狗是四足行走机构，由于四足动物运动的稳定性，相对于双足行走的人来说，其运动步态比较简单，大多机器狗简单的采用前后脚差90度或180度。

        机器狗采用前后脚差180度时的脚部运动落地顺序图如下（注：白色为要抬起的脚，灰色不抬起的脚）

        机器狗采用前后脚差90度时的脚部运动落地顺序图如下：

        机器狗四条腿腿同时动的时候的动作效果包括整体下蹲、整体站立、身体前后俯仰、身体侧翻等，效果图如下所示：

4. 电子硬件

      本实验中采用了以下硬件：

      利用上位机测出的舵机角度，可进行下位机编程。

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[3]; /* 欧拉角 */
 
 
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[4], y[4];
 
      long t = millis() - t0;
 
      gait(t, 0.5, x[0], y[0], forwardGait);
 
      gait(t, 0, x[1], y[1], forwardGait);
 
      gait(t, 0, x[2], y[2], forwardGait);
 
      gait(t, 0.5, x[3], y[3], forwardGait);
 
      leg0.footPos(x[0], y[0]);
 
      leg1.footPos(x[1], y[1]);
 
      leg2.footPos(x[2], y[2]);
 
      leg3.footPos(x[3], y[3]);
 
      t_control = millis();
 
    }     
 
}