专利名称：双足机器人动力式行走方法
技术领域：
本发明涉及双足机器人动力式行走方法，尤其涉及实现双足机器人快速行 走的一种开环控制方法。
背景技术：
目前，双足机器人的行走方法主要包括静态行走，ZMP行走，以及极限环 行走。其中静态行走是出现最早的也是最基础的一种行走方法，其要求行走过 程中机器人的质心始终保持在地面上双脚构成的多边形以内。这种方法很容易 保持机器人的稳定，但也极大的限制了机器人的行走速度。ZMP行走要求机器 人的零矩点始终保持在双脚构成的多边形以内，这种方法在一定程度上比静态 行走减少了人为约束，因此在一些机器人上实现了较高速度的行走。目前，ZMP 行走的成功实例包括本田公司的ASIMO，东京大学的HRP3，以及索尼公司的 Qrio等。但是与传统工业机器人相似，ZMP行走仍然采用了较多的人为约束， 因此在能量效率，行走速度，抗干扰能力，以及步态自然性等方面很难再有突 破。
极限环行走是近年来出现的一种新的行走理念，它的提出受到了人类行走 的启发，要求周期性的步态序列是轨道稳定的，即步态序列可以在状态空间中 形成一个稳定的极限环，但在步态周期中的任意瞬时并不具备局部稳定性。这 种方法对机器人的人为约束较少，充分地利用了机器人自身的动力学特性，因 而具有较大的空间提高机器人的能量效率，行走速度，以及抗干扰能力。目前， 采用极限环行走原理的成功实例包括MIT的Spring Flamingo及其虚拟模型控制Rabbit及其混合零动力学控制方法，Geng等人的RunBot 及其中枢神经控制方法，以及CMU的双足机器人及其再励学习方法等。这些机 器人在行走速度，能量效率，以及抗干扰能力等方面实现了较大的突破，但步 态生成方法较为繁琐，有些则需要使用机器学习，对实验环境的要求较高。
被动行走是极限环行走的一种典型范例，机器人沿微倾的斜坡向下行走， 不需要施加任何控制，斜坡提供的重力势能转化为机器人行走所需的动能。被 动行走生成的步态非常自然，能量效率可以达到人类的水平，约是ZMP行走机 器人ASIMO的十几分之一。为了将被动行走在平地实现，Cornell大学使用了 在机器人脚踝处增加激励的方法，在每步摆动腿与地面发生碰撞后脚掌蹬地， 为行走注入能量。Deflt大学则采用了在摆动腿与地面碰撞前加紧髋关节的做法， 同样达到了补入能量的目的。但是以上两种方法的能量补入时机均位于碰撞时 刻前后，能量为瞬时补入，要求具有极高的能量密度，因此在很大程度上限制 了机器人的行走速度，同时这种能量补入方法会给步态造成较大的扰动，降低 了行走的稳定性。
本发明所述的双足机器人行走方法以被动行走为基础，通过在支撑腿前摆 过程中伸直支撑腿膝关节逐渐提高机器人的重心，补入重力势能。这种方法与 Cornell大学及Deflt大学的做法相比，极大的降低了对能量密度的要求，同时消 除了在摆动腿与地面碰撞瞬间补入能量对行走稳定性造成的影响，因此能够使 机器人达到较高的行走速度及稳定性。与其他极限环行走方法相比，本方法只 需要开环控制，实现简单且计算量非常小，因此适用于对实时性要求较高的场 合
发明内容
本发明的目的在于提出一种在开环控制条件下能万向行走的双足机器人动 力式行走方法。
本发明的特征之一在于，依次含有以下步骤
步骤(1)构造一个双足机器人，如图3所示，其步骤如下
步骤(1.1)，建立驱干1与第一大腿6以及第二大腿7的连接。该驱干1与
两个旋转自由度电机2和3分别固定，驱干1与两个侧摆电机4和5分别固定。 再把所述电机2、 4与第一大腿6固定，所述电机3、 5与第二大腿7固定，
步骤(1.2)，建立所述第一大腿6与第一小腿12以及第二大腿7与第二小 腿13的连接。该第一大腿6与第一大腿的前摆电机8固定，该前摆电机8与第 一小腿的前摆电机10固定，该前摆电机10与第一小腿12固定；第二大腿7与 第二大腿的前摆电机9固定，该前摆电机9与第二小腿的前摆电机11固定，该 前摆电机11与第二小腿13固定，
步骤(1.3)，建立所述第一小腿12与第一脚板16以及第二小腿13与第二 脚板17的连接。该第一小腿12与第一脚踝的侧摆电机14固定，该侧摆电机与 第一脚板16固定；第二小腿13与第二脚踝的侧摆电机15固定，该侧摆电机与 第二脚板17固定，
步骤(1.4)，在步骤(1.1)、步骤(1.2)、步骤(1.3)中所述的10个电机 均采用伺服电机，用&。*， 5_2分别表示电机2和3的角度；Sh,一， &^12分别 表示电机4和5的角度，ShipSagl， Sh,分别表示电机8和9的角度，&rel， 、2 分别表示电机10和11的角度，， &^2分别表示电机14和15的角度，
步骤(1.5)，该步骤(1.1)、步骤(1.2)、步骤(1.3)中所述各个电机的控 制信号输入端分别与一个上位机的控制信号输出端相连；步骤(2)，在所述上位机内设定一个步态周期r，所述步态周期r是指每 一步的开始时刻^o到碰撞时刻^r所经历的时间，/ = 0表示所述第二大腿(7) 的摆动腿离地的瞬间，^r标志一个步态周期结束，下一个步态周期开始，此 时，所述第二大腿(7)的摆动腿变为支撑腿，而步态周期r时的支撑腿变为摆 动腿，
步骤(2)，在所述上位机内设定一个步态周期r，在r内所述机器人具有以
下行走参数，0.2s<r<0.5S，取初始值7 = 0.33，所述步态周期r指从一步开始时刻
到碰撞所经历的时间，其中，开始时刻 o是指视作第二大腿的摆动腿离地的瞬 间，碰撞是指摆动腿与地面发生碰撞，该碰撞时刻^r，表示一个步态周期的 结束，下一步态周期开始，此时视为第二大腿的摆动腿变为支撑腿，而前一个 步态周期的支撑腿变为摆动腿，所述行走参数包括e、"、"，单位为角度，
如图1所示，其中^为等效支撑腿18与等效摆动腿19之间的夹角；《为所述 支撑腿大腿6与等效支撑腿4之间的夹角；^为所述摆动腿大腿7与等效摆动腿 19之间的夹角；当所述等效摆动腿19位于等效支撑腿18之前时，^>0，之后 时^<0;当所述支撑腿的膝关节弯曲时">0，支撑腿膝关节伸直时"=0;当所 述摆动腿的膝关节弯曲时々> 0 ，摆动腿膝关节伸直时/ = 0 ，
步骤(3)，在上位机中，按以下步骤可以实现机器人的前向行走
步骤(3.1)，在所述的前向平面行走中，在所述的一个步态周期r内，设定
以下3个关键帧
第一关键帧，位于^0时，决定机器人一步的初始姿态，其中6 =-《，《 为一非负常数，表示^0时所述两条等效腿之间的夹角，决定步幅大小，初始值《=30°;"。为一非负常数，表示^0时所述支撑腿 大腿6相对于等效支撑腿大腿18的旋转角度，取初始值"。=《/2; "=(T，表示摆 动膝关节伸直，
第二关键帧，位于^7V2时，其中P = (T，表示所述等效支撑腿18与等效 摆动腿19平行；"= 。，与第一关键帧中的"相同，表示等效支撑腿18的长度 在第一关键帧和第二关键帧之间保持不变；々。为一非负常数，表示一步 中间时刻作为摆动腿的第二大腿7相对于等效摆动腿19的旋转角度，以防止一 步行走过程中摆动腿小腿与地面相碰，所述々。在《。+5°<"。<"。+25°中选取，设 "。= 。+15° ，决定摆动腿小腿13末端的抬高高度，
第三关键帧，位于 r时，决定碰撞时刻的机器人姿态，其中^ =《，表 示碰撞时刻两等效腿之间的夹角；"=(T，表示支撑腿膝关节伸直，为行走补入 能量；表示摆动腿膝关节弯曲，准备与地面碰撞，在^r时发生碰撞；
步骤(3.2)，所述上位机依次按以下步骤控制所述机器人行走，行走步数为
n，每行走一步用一个步态周期r:
步骤(3.2.1)，设定r = 0.3s，以及在所述三个关键帧的时刻 0， f = 772，
^r时所述e、 "、 / 的值，
步骤(3.2.2)，设定M为计算步长，/为计算次数，行走时f从0开始，按下 式计算每隔A,时间所述^、"、"的值，从而得到^力(0、 《 = 戶=力(0三 条曲线，变量^、 《、 -关于f的一阶导数连续，
<formula>formula see original document page 16</formula><formula>formula see original document page 17</formula>
2
步骤(3.2.3)，在所述上位机中，按下式计算当步数为"时，以所述行走参 数^， "， / 为变量，所述机器人中各个电机的旋转角度，以实现双足机器人的 行走控制，公式中当w为奇数时，Sh,pSagl、 &。61分别为所述支撑腿髋关节和膝关 节的角度，Sh,pSag2、 5^2分别为所述摆动腿髋关节和膝关节的角度，当w为偶数 时，&,psag2、 ^^分别为所述支撑腿髋关节和膝关节的角度，&ipSagl、 &^分别为 所述摆动腿髋关节和膝关节的角度，也就是说当n由奇数变为该奇数加1所形成 的偶数时，作为第一大腿的支撑腿与作为第二大腿的摆动腿在一步行走结束后 互换。
<formula>formula see original document page 17</formula>以上所述的/ 。按以下方式取值当《>40°时，《。+20° +25°，当6^1(T时，a。+5° </ 。 <"。+10°，当10° <6>。<40°时，《r。+10° < 〃。 < "。+20° 。
若操作人员发现以下情况，予以分别处理如所述机器人从^0时开始行走
后向前摔倒，说明"。过大，补入的能量过大，使"。减r，如此重复，直到该机器 能够行走为止；如所述机器人身体后倾，说明碰撞时刻过晚，使"。加(ir，如此
重复，直到碰撞时机器人身体竖起为止。
本发明的特征之二在于，依次含有以下步骤 步骤(1)构造一个双足机器人，如图3所示，其步骤如下 步骤(1.1)，建立驱干1与第一大腿6以及第二大腿7的连接。该驱干1与 两个旋转自由度电机2和3分别固定，驱干1与两个侧摆自由度电机4禾n 5分 别固定。再把所述电机2、 4与第一大腿6固定，所述电机3、 5与第二大腿7 固定，
步骤(1.2)，建立所述第一大腿6与第一小腿12以及第二大腿7与第二小 腿13的连接。该第一大腿6与第一大腿的前摆电机8固定，该前摆电机8与第 一小腿的前摆电机10固定，该前摆电机10与第一小腿12固定；第二大腿7与 第二大腿的前摆电机9固定，该前摆电机9与第二小腿的前摆电机11固定，该 前摆电机11与第二小腿13固定，
步骤(1.3)，建立所述第一小腿12与第一脚板16以及第二小腿13与第二 脚板17的连接。该第一小腿12与第一脚踝的侧摆电机14固定，该侧摆电机与 第一脚板16固定；第二小腿13与第二脚踝的侧摆电机15固定，该侧摆电机与 第二脚板17固定，
步骤(1.4)，在步骤(1.1)、步骤(1.2)、步骤(1.3)中所述的10个电机均采用伺服电机，用&。g， &_2分别表示电机2和3的角度；Ship,atl， &,—2分别 表示电机4和5的角度，ShipSagl， ^,分别表示电机8和9的角度，SknMl， 分别表示电机10和11的角度，， 5^62分别表示电机14和15的角度，
步骤(1.5)，该步骤(1.1)、步骤(1.2)、步骤(1.3)中所述各个电机的控
制信号输入端分别与一个上位机的控制信号输出端相连；
步骤(2)，在所述上位机内设定一个步态周期r，在r内所述机器人具有以 下行走参数，o.2S<r<o.5s，取初始值r-o.3s，所述步态周期r指从一步开始时刻 到碰撞所经历的时间，其中，开始时刻…o是指视作第二大腿的摆动腿离地的瞬 间，碰撞是指摆动腿与地面发生碰撞，该碰撞时刻 r，表示一个步态周期的 结束，下一步态周期开始，此时视为第二大腿的摆动腿变为支撑腿，而前一个 步态周期的支撑腿变为摆动腿，所述行走参数包括p、 r、 6单位为角度，
如图2所示，其中p为所述等效左腿20与等效右腿21在侧向平面的夹角；y 为所述等效左腿20与等效右腿21的夹角^的角平分线与竖直方向的夹角；当所 述两条等效腿向两侧分开时^>0;当所述夹角p的角平分线在竖直方向左侧时， y>0，当所述夹角p的角平分线在竖直方向右侧时，y<0;当所述等效左腿(20) 在竖直方向左侧时，->0，当所述等效左腿(20)在竖直方向右侧时，0<0， 或当所述等效右腿(21)在竖直方向右侧时，->0，当所述等效右腿(21)在 竖直方向左侧时，-<0;
步骤(3)，在上位机中，按以下步骤可以实现机器人的侧向行走 步骤(3.D，侧向给定一个固定的两条腿的夹角^ = %， ^为一个正的常数， 表示等效左腿和等效右腿在侧向平面的固定的夹角，用来保持机器人的稳定。 步骤(3.2)，在所述侧摆的运动中，决定机器人运动的关键角度是y。在所述连续两个步态周期r/2至5r/2内设置以下3个关键帧-
第一关键帧位于 7V2时，决定机器人侧摆的初始姿态。其中，y = &， &
为一个常数，表示 r/2时，身体侧摆的角度，-5°<&<5°，取初始值& = 0°
第二关键帧位于^3772时，决定机器人一步侧摆的终止状态。其中， ^ = 1。，表示？ = 3772时身体侧摆的角度。
第三关键帧位于 57V2时，决定机器人第二步侧摆的终止状态。其中， y = &，表示^577 2时身体侧摆的角度。
步骤(3.3)，设定"为计算步长，/为计算次数，行走时f从0开始，按下式 计算每隔"时间所述y的值，从而得到7 = /,^曲线，变量^关于^的一阶导数连
续，
步骤(3.4)，在所述侧移的运动中，决定机器人运动的关键角度是^。在所 述连续两个步态周期0至2r内设置以下3个关键帧
第一关键帧位于^0时，决定机器人侧移的初始姿态。- = 卩。为一个 常数，表示,=0时，两条等效腿在侧向平面的张角，-10°<^。<10°，取初始值忾=0°
第二关键帧位于^r时，决定机器人侧移一步的末状态。- = -a，表示^r
时，两条等效腿在侧向平面的张角；
第三关键帧位于^ = 27时，决定机器人侧移两步的末状态。0 = ^，表示/ = 27
时，两条等效腿在侧向平面的张角，
步骤(3.5)，设定A,为计算步长，/为计算次数，行走时/从0开始，按下式 计算每隔Af时间所述^的值，从而得到0 =厶(/)曲线，变量^关于,的一阶导数连 续，<formula>formula see original document page 21</formula>步骤(3.6)，在所述上位机中，按下式计算当步数为n时，以所述行走参数p， p卩为变量，所述机器人中各个电机的旋转角度，以实现双足机器人的行走控
制，Ship,atl、 &^,分别为所述左腿髋关节侧摆和踝关节的角度，
'anklel
hipLat2 ankle2
& We，分另u
为所述右腿髋关节侧摆和踝关节的角度<
<formula>formula see original document page 21</formula>本发明的特征之三在于，依次含有以下步骤
步骤(1)构造一个双足机器人，如图3所示，其步骤如下
步骤(l.l)，建立驱干1与第一大腿6以及第二大腿7的连接。该驱干l与
两个旋转自由度电机2和3分别固定，驱干1与两个侧摆自由度电机4和5分 别固定。再把所述电机2、 4与第一大腿6固定，所述电机3、 5与第二大腿7 固定，
步骤(1.2)，建立所述第一大腿6与第一小腿12以及第二大腿7与第二小 腿13的连接。该第一大腿6与第一大腿的前摆电机8固定，该前摆电机8与第 一小腿的前摆电机10固定，该前摆电机10与第一小腿12固定；第二大腿7与 第二大腿的前摆电机9固定，该前摆电机9与第二小腿的前摆电机11固定，该 前摆电机11与第二小腿13固定，
步骤(1.3)，建立所述第一小腿12与第一脚板16以及第二小腿13与第二 脚板17的连接。该第一小腿12与第一脚踝的侧摆电机14固定，该侧摆电机与 第一脚板16固定；第二小腿13与第二脚踝的侧摆电机15固定，该侧摆电机与第二脚板17固定，
步骤(1.4)，在步骤(1.1)、步骤(1.2)、步骤(1.3)中所述的10个电机 均采用伺服电机，ffl&。tatel， 5_2分别表示电机2和3的角度；Shiputl， &一分别 表示电机4和5的角度，ShlpSagl， Sh,分别表示电机8和9的角度，&nral， Sknra2 分别表示电机10和11的角度，^m， &,2分别表示电机14和15的角度，
步骤(1.5)，该步骤(1.1)、步骤(1.2)、步骤(1.3)中所述各个电机的控
制信号输入端分别与一个上位机的控制信号输出端相连；
步骤(2)，在所述上位机内设定一个步态周期r，所述步态周期r是指每 一步的开始时刻^o到碰撞时刻,-r所经历的时间， o表示所述第二大腿(7) 的摆动腿离地的瞬间， r标志一个步态周期结束，下一个步态周期开始，此 时，所述第二大腿(7)的摆动腿变为支撑腿，而步态周期r时的支撑腿变为摆
动腿，所述行走参数包括A，单位为角度，如图4所示，其中义为所述第一 脚板16在旋转方向与身体前向的夹角；或所述第二脚板17在旋转方向与身体 前向的夹角，当所述脚16在旋转平面内向外侧旋转时;i〉0;当所述脚16在旋
转平面上向正前方时，/i = o，当所述脚16在旋转平面内向内侧旋转时;uo;当 所述脚17在旋转平面内向外侧旋转时，；i>o，当所述脚17在旋转平面上向正 前方时，；uo，当所述脚17在旋转平面内向内旋转时义<0，
步骤(3)，在上位机中，按以下步骤实现机器人的旋转运动 步骤(3.1)，在所述连续两个步态周期0至2r内设置以下3个关键帧 第一关键帧位于^0时，决定机器人旋转的初始姿态。A = ^， a为一个 常数，表示/ = 0时脚16与17的朝向，-10°<^<10°，取初始值a-(T
第二关键帧位于^r时，义=-a，表示^r时脚l6与l7的朝向；第三关键帧位于…2r时，；l = ^，表示 2r时脚16与17的朝向；
步骤(3.2)，设定Af为计算步长，/为计算次数，行走时/从0开始，按下式
计算每隔"时间所述A的值，从而得到;^/,(0曲线，变量/i关于^的一阶导数连
续，
步骤(3.3)，在所述上位机中，按下式计算当步数为，:时，以所述行走参数义
为变量，所述机器人中各个电机的旋转角度，以实现双足机器人的行走控制，
本发明所述的步态设计方法参数数量少，而且均具有明确的物理意义，使 得参数的调节非常容易。同时，关键帧之间可以使用简单的光滑曲线连接，使 步态的生成非常简单。在试验中，机器人可以实现前向、侧向与旋转的自由行 走。而且只需要将三种行走方法任意组合，就可以实现灵活的全方位行走。这 种以简单步态生成算法实现的全方位行走，在以往的机器人步态生成方法中， 是前所未有的。
图1为机器人前向平面的模型图。
图2为机器人侧向平面的模型图。
图3为机器人的自由度配置。其中1为躯干，2为第一旋转电机，3为第二 旋转电机，4为第一侧摆电机，5为第二侧摆电机，6为第一大腿，7为第二大
发明效果:腿，8为第一前摆电机，9为第三前摆电机，10为第二前摆电机，11为第四前 摆电机，12为第一小腿，13为第二小腿，14为第一踝关节侧摆电机，15为第 二踝关节侧摆电机，16为第一脚板，17为第二脚板。
图4为机器人的旋转模型。
图5为机器人前向平面的三个关键帧。
图6为机器人侧摆运动的三个关键帧。
图7为机器人侧移运动的三个关键帧。
图8为机器人旋转运动的三个关键帧。
图9为机器人行走方法流程图。
具体实施例方式
图3所示为本发明所使用的机器人的结构和关节角示意图，其中1为躯干， 与左右两个旋转电机2、 3的本体固定连接，两个旋转电机的输出轴分别与两个 大腿6、 7连接，躯干又与两个髋关节侧摆电机4、 5的本体固定连接，两个髋 关节侧摆的电机的转动输出轴分别与两个大腿6、 7连接，大腿6与大腿前摆电 机8的转动输出轴连接，大腿7与大腿前摆电机9的转动输出轴连接，大腿前 摆电机8与小腿前摆电机10的本体固定连接，大腿前摆电机9与小腿前摆电机 11的本体固定连接，小腿前摆电机10、 11的转动输出轴分别与小腿12、 13连 接，小腿12、 13的末端分别与踝关节转动电机的本体固定连接，踝关节的转动 输出轴分别与脚板16、 17连接。此机器人的具有IO个自由度，分别位于两个 髋关节旋转电机2、 3，两个髋关节侧摆电机4、 5，两个大腿前摆电机8、 9，两个小腿前摆电机IO、 11以及两个踝关节侧摆电机14、 15。十个电机均采用数字
询匕禾几，其方定转角度分另'J用《otatd 、 Srotate2 、《hipLatl、《hipLat2、 ^"hipSagl 、 ShipSag2 、 、《knee2 、
《anklel 、^nkle2表不。
本发明所述双足机器人的行走方法的实现由以下三个步骤组成(1)上位
机计算步态(2)上位机控制机器人(3)人工参数调节。在阶段(1)中，本发
明所述的双足机器人的行走方法由三个独立的部分组成，分别是机器人前进、 侧移和旋转。本发明所述的机器人前向行走中，人工设定一组参数e。、 《。、 A、
r，按照式(1)、 (2)计算参数^、"、 〃的值，再按照式(3)、 (4)计算机器 人关节角&ipSagl 、 ShipSag2、 ^^、 &^2、 S皿m、 &^2的值；本发明所述的机器人侧 向行走中，人工设定一组参数p。、 &、 -。，按照式(5)、 (6)计算参数y、 0的
值，再按照式(7)计算机器人关节角、 Shiput2、 &kld、 &^2的值；本发明
所述的机器人旋转运动中，人工设定一组参数^，按照式(8)计算参数A的值， 再按照式(9)计算机器人关节角Srotatel 、 &。tate2。
在阶段(2)中，将计算所得的电机角度，发送至机器人电机，控制机器人 运动。
阶段(3)为参数的人工调节阶段，按照步骤(1)控制的机器人行走，如
果机器人向前倒，则"。增加r，如果机器人向后倒，则a。减少r;如果所述双足 机器人在行走时，向左倒或向右倒，则^增加r，如果所述双足机器人左右摆动 过大，则&增加r。
将机器人的任意运动方式进行组合，可以实现灵活的全方位行走。
权利要求
1. 双足机器人动力式行走方法，是一种动力式前进行走方法，其特征在于，依次含有以下步骤步骤(1)，按以下步骤构造一个双足机器人步骤(1. 1)，建立驱干(1)与第一大腿(6)、驱干(1)与第二大腿(7)的连接该驱干(1)与第一旋转电机(2)、第二旋转电机(3)的本体固定连接，所述第一旋转电机(2)的输出轴与所述第一大腿(6)轴向转动连接，所述第二旋转电机(3)的输出轴与所述第二大腿(7)轴向转动连接，所述驱干(1)与第一侧摆电机(4)、第二侧摆电机(5)的本体固定连接，再把所述第一侧摆电机(4)的输出轴与所述第一大腿(6)左右摆动连接，把所述第二侧摆电机(5)的输出轴与所述第二大腿(7)左右摆动连接，步骤(1. 2)，建立所述第一大腿(6)与第一小腿(12)、所述第二大腿(7)与第二小腿(13)的连接所述第一大腿(6)的下端与第一前摆电机(8)的输出轴前后转动连接，所述第一小腿(12)的上端与第二前摆电机(10)的输出轴前后转动连接，再将所述第一前摆电机(8)与所述第二前摆电机(10)的本体固定连接，所述第二大腿(7)的下端与第三前摆电机(9)的输出轴前后转动连接，所述第二小腿(13)的上端与第四前摆电机(11)的输出轴前后转动连接，再将所述第三前摆电机(9)与所述第四前摆电机(11)的本体固定连接，步骤(1. 3)，建立所述第一小腿(12)与第一脚板(16)、所述第二小腿(13)与第二脚板(17)的连接所述第一小腿(12)的下端与第三侧摆电机(14)的本体固定连接，再将所述第三侧摆电机(14)的输出轴与所述第一脚板(16)左右摆动连接，所述第二小腿(13)的下端与第四侧摆电机(15)的本体固定连接，再将所述第四侧摆电机(15)的输出轴与所述第二脚板(17)左右摆动连接，步骤(1. 4)，用Srotate1表示所述第一旋转电机(2)的旋转角度，Srotate2表示所述第二旋转电机(3)的旋转角度，用ShipLat1表示所述第一侧摆电机(4)侧摆角度，ShipLat2表示所述第二侧摆电机(5)的侧摆角度，用ShipSag1表示所述第一前摆电机(8)的前摆角度，ShipSag2表示所述第三前摆电机(9)的前摆角度，用Sknee1表示所述第二前摆电机(10)的前摆角度，Sknee2表示所述第四前摆电机(11)的前摆角度，用Sankle1表示所述第三侧摆电机(14)的侧摆角度，Sankle2表示所述第四侧摆电机(15)的侧摆角度，步骤(1. 5)，把步骤(1.1)到步骤(1.4)中各电机的控制信号输入端分别与一个上位机的控制信号输出端相连，所述各电机均为伺服电机；步骤(2)，在所述上位机内设定一个步态周期T，所述步态周期T是指每一步的开始时刻t＝0到碰撞时刻t＝T所经历的时间，t＝0表示所述第二大腿(7)的摆动腿离地的瞬间，t＝T标志一个步态周期结束，下一个步态周期开始，此时，所述第二大腿(7)的摆动腿变为支撑腿，而步态周期T时的支撑腿变为摆动腿，在所述步态周期T内所述双足机器人具有以下行走参数θ，为等效支撑腿(18)与等效摆动腿(19)之间的夹角，单位为度，所述等效支撑腿(18)是指在t＝0时刻从所述驱干(1)到作为支撑腿的第一小腿(12)末端之间的虚拟等效腿，所述等效摆动腿(19)是指在t＝0时刻从所述驱干(1)到作为摆动腿的第二小腿(13)末端之间的虚拟等效腿，α，为在t＝0时刻起支撑作用的第一大腿(6)与所述等效支撑腿(18)之间的夹角，单位为度，β，为在t＝0时刻起摆动作用的第二大腿(7)与所述等效摆动腿(19)之间的夹角，单位为度，当所述等效摆动腿(19)位于所述等效支撑腿(18)之前时，所述θ>0，之后时θ<0，当起支撑作用的第一大腿(6)的膝关节弯曲时，所述α>0，伸直时α＝0，当起摆动作用的第二大腿(7)的膝关节弯曲时，所述β>0，伸直时β＝0，步骤(3)，所述双足机器在前进运动中，所述上位机按以下步骤控制该双足机器人进行动力式行走步骤(3. 1)，在一个所述步态周期内，设定以下三个关键帧第一关键帧，位于t＝0时刻，为初始姿态，此时θ＝-θ0，θ0为一个非负常数，决定步幅大小，0°≤θ0≤60°，初始时θ0＝30°，α＝α0，α0为一个非负常数，初始时，α0＝θ0/2，β＝0°，第二关键帧，位于t＝T/2时刻，θ＝0°，表示所述等效支撑腿(18)平行于所述等效摆动腿(19)，α＝α0，β＝β0，β0为一个非负常数，α0+5°<β0<α0+25°，在t＝T/2时设定β0＝α0+15°，决定所述摆动时第二小腿(13)末端的抬高高度，第三关键帧，位于t＝T时，决定碰撞时刻双足机器人的姿态，此时，θ＝θ0，α＝0°，表示所述第一大腿(6)的膝关节伸直，为行走补入能量，β＝α0，表示所述第二大腿(7)的膝关节弯曲，准备在t＝T时发生碰撞，步骤(3. 2)，所述上位机依次按以下步骤控制所述双足机器人行走，行走步数为n，每行走一步用一个步态周期T步骤(3. 2.1)，设定Δt为计算步长，i为计算次数，行走时i从0开始，所述上位机按下式计算每隔Δt时间所述θ，α，β之值，当时当时步骤(3. 2.2)，所述上位机按下式计算当步数为n时行走参数θ，α，β在所述步骤(3.2.1)所得到的参数值下，所述双足机器人的ShipSag1、ShipSag2、Sknee1、Sknee2当n＝1，3，5，7，9…时当n＝2，4，6，8，10…时
2. 根据权利要求1所述的双足机器人动力式行走方法，其特征在于，当所述双足机器人向后倒时，所述a。增加r，向前倒时所述a。减少r，当摆动腿与地面碰撞时， 〃。增加r。
3. 双足机器人动力式行走方法，是一种动力式侧向行走方法，其特征在于，依次含有以下步骤步骤(1)，按以下步骤构造一个双足机器人步骤(1.1)，建立驱干(1)与第一大腿(6)、驱干(1)与第二大腿(7)的连接该驱干(1)与第一旋转电机(2)、第二旋转电机(3)的本体固定连接，所述第一旋 转电机(2)的输出轴与所述第一大腿(6)轴向转动连接，所述第二旋转电机(3)的输 出轴与所述第二大腿(7)轴向转动连接，所述驱干(1)与第一侧摆电机(4)、第二侧摆电机(5)的本体固定连接，再把所述 第一侧摆电机(4)的输出轴与所述第一大腿(6)左右摆动连接，把所述第二侧摆电机 (5)的输出轴与所述第二大腿(7)左右摆动连接，步骤(1.2),建立所述第一大腿(6)与第一小腿(12)、所述第二大腿(7)与第二 小腿(13)的连接所述第一大腿(6)的下端与第一前摆电机(8)的输出轴前后转动连接，所述第一小 腿(12)的上端与第二前摆电机(10)的输出轴前后转动连接，再将所述第一前摆电机 (8)与所述第二前摆电机(10)的本体固定连接，所述第二大腿(7)的下端与第三前摆电机(9)的输出轴前后转动连接，所述第二小 腿(13)的上端与第四前摆电机(11)的输出轴前后转动连接，再将所述第三前摆电机 (9)与所述第四前摆电机(11)的本体固定连接，步骤(1.3)，建立所述第一小腿(12)与第一脚板(16)、所述第二小腿(13)与第 二脚板(17)的连接所述第一小腿(12)的下端与第三侧摆电机(14)的本体固定连接，再将所述第三侧 摆电机(14)的输出轴与所述第一脚板(16)左右摆动连接，所述第二小腿(13)的下端与第四侧摆电机(15)的本体固定连接，再将所述第四侧 摆电机(15)的输出轴与所述第二脚板(17)左右摆动连接，步骤(1.4)，用&。t^表示所述第一旋转电机(2)的旋转角度，&。^2表示所述第二旋转电机(3)的旋转角度，用&ip^表示所述第一侧摆电机(4)侧摆角度，&^12表示所述第二侧摆电机(5)的侧摆角度，用Sh,^g,表示所述第一前摆电机(8)的前摆角度，Ships^表示所述第三前摆电机(9) 的前摆角度，用S^d表示所述第二前摆电机(10)的前摆角度，S^。表示所述第四前摆电机(11) 的前摆角度，用S皿^表示所述第三侧摆电机(14)的侧摆角度，5^62表示所述第四侧摆电机(15)的侧摆角度，步骤(1.5)，把步骤(1.1)到步骤(1.4)中各电机的控制信号输入端分别与一个上 位机的控制信号输出端相连，所述各电机均为伺服电机；步骤(2)，在所述上位机内设定一个步态周期r，所述步态周期r是指每一步的开始时刻^ = 0到碰撞时刻？ = 7所经历的时间"=0表示所述第二大腿(7)的摆动腿离地的瞬间，^ = 7 标志一个步态周期结束，下一个步态周期开始，此时，所述第二大腿(7)的摆动腿变为支撑腿，而步态周期r时的支撑腿变为摆动腿，在所述步态周期r内所述双足机器人具有以下行走参数p，为等效左腿(20)与等效右腿(21)，在侧向行走平面内的夹角，单位为度，所述等 效左腿(20)是指所述第一大腿(6)和所述第一小腿(12)在侧向投影上位于一条直线上时的等效腿，所述等效右腿(21)是指所述第二大腿(7)和所述第二小腿(13)在侧向投影上 位于一条直线上时的等效腿，"为所述等效左腿(20)与所述等效右腿(21)的所述夹角p的角平分线与竖直方向的夹角，0，为所述等效左腿(20)与竖直方向的夹角，或所述等效右腿(21)与竖直方向的夹角， 当所述等效左腿(20)与所述等效腿(21)在侧向平面向两侧分开时，所述^>0， 当所述夹角p的角平分线在竖直方向左侧时，^>0，当所述夹角p的角平分线在竖直方 向右侧时，y<0，当所述等效左腿(20)在竖直方向左侧时，0>0，当所述等效左腿(20)在竖直方向右侧时，-<0，或当所述等效右腿(21)在竖直方向右侧时，->0，当所述等效右腿(21)在竖直方向左侧时，-<0，步骤(3)，所述双足机器人在侧向运动时，存在侧摆和侧移两种运动，这两种运动在初 始时，所述等效左腿和等效右腿在侧向平面上有一个固定的用于保持稳定的夹角％，为一个 正常数。步骤(3.1)，在侧摆运动时，在所述连续两个步态周期7V2至57V2内设置以下3个关 键帧侧摆运动第一关键帧,=772时，所述双足机器人处于侧摆的初始状态，^=&， y。为常数，表示^ = 772时的侧摆角度，-5°<&<5°，初始时&=0°，侧摆运动第二关键帧f = 3772时，所述双足机器人处于侧摆了 一步后的终止状态，y= - & ，表示,=3772时身体侧摆的角度， 侧摆运动第三关键帧 = 5772时，所述双足机器人处于侧摆了两步后的终止状态，rr。，表示h5772时身体侧摆的角度，步骤(3.2)，在侧向移动时，在所述连续两个步态周期0至2r内设置以下3个关键帧侧向移动第一关键帧 = 0时，所述双足机器人处于侧向移动的初状态，- =-10°<^<10°，侧向移动第二关键帧/二r时，所述双足机器人处于侧移半步的末状态，0 = -^，侧向移动第三关键帧r二2r时，所述双足机器人处于侧移一步的末状态，0 = 0。，步骤(3.3)，设定Af为计算步长，f为计算次数，行走时/从0开始，所述上位机按下 式计算每隔Ar时间所述0， 7之值， 乂 兀A^ ■. 兀Af.步骤(3.4)，所述上位机按下式计算所述双足机器人中各个电机的旋转角度，实现动力式行走控制所述左腿髋关节侧摆的角度shipI_atl为所述左腿踝关节侧摆的角度smkld为所述右腿髋关节侧摆的角度ShipLat2为 所述右腿踝关节侧摆的角度S^d为
4. 根据权利要求，所述的双足机器人动力式行走方法，其特征在于，当所述双足机器人在行走时，向左倒或向右倒，则增加^角， 一直到能稳定踏步为止。
5. 根据权利要求，所述的双足机器人动力式行走方法，其特征在于，当所述双足机器人左右摆动过大时，增加初始时y。角，直到能平稳踏步为止。
6.双足机器人动力式行走方法，是一种动力式旋转行走方法，其特征在于，依次含有以 下步骤步骤(1)，按以下步骤构造一个双足机器人步骤(1.1),建立驱干(1)与第一大腿(6)、驱干(1)与第二大腿(7)的连接 该驱干(1)与第一旋转电机(2)、第二旋转电机(3)的本体固定连接，所述第一旋转电机(2)的输出轴与所述第一大腿(6)轴向转动连接，所述第二旋转电机(3)的输 出轴与所述第二大腿(7)轴向转动连接，所述驱干(1)与第一侧摆电机(4)、第二侧摆电机(5)的本体固定连接，再把所述 第一侧摆电机(4)的输出轴与所述第一大腿(6)左右摆动连接，把所述第二侧摆电机 (5)的输出轴与所述第二大腿(7)左右摆动连接，步骤(1.2)，建立所述第一大腿(6)与第一小腿(12)、所述第二大腿(7)与第二 小腿(13)的连接所述第一大腿(6)的下端与第一前摆电机(8)的输出轴前后转动连接，所述第一小 腿(12)的上端与第二前摆电机(10)的输出轴前后转动连接，再将所述第一前摆电机(8) 与所述第二前摆电机(10)的本体固定连接，所述第二大腿(7)的下端与第三前摆电机(9)的输出轴前后转动连接，所述第二小 腿(13)的上端与第四前摆电机(11)的输出轴前后转动连接，再将所述第三前摆电机(9) 与所述第四前摆电机(11)的本体固定连接，步骤(1.3)，建立所述第一小腿(12)与第一脚板(16)、所述第二小腿(13)与第 二脚板(17)的连接所述第一小腿(12)的下端与第三侧摆电机(14)的本体固定连接，再将所述第三侧 摆电机(14)的输出轴与所述第一脚板(16)左右摆动连接，所述第二小腿(13)的下端与第四侧摆电机(15)的本体固定连接，再将所述第四侧 摆电机(15)的输出轴与所述第二脚板(17)左右摆动连接，步骤(1.4)，用&。,^表示所述第一旋转电机(2)的旋转角度，^。t^表示所述第二旋转电机(3)的旋转角度，用Sh,put,表示所述第一侧摆电机(4)侧摆角度，Sh,pL^表示所述第二侧摆电机(5) 的侧摆角度，用&^gi表示所述第一前摆电机(8)的前摆角度，Ship^2表示所述第三前摆电机(9) 的前摆角度， .用"^^表示所述第二前摆电机(io)的前摆角度，S^^表示所述第四前摆电机(11)的前摆角度，用&^表示所述第三侧摆电机(14)的侧摆角度，S^e,表示所述第四侧摆电机(15) 的侧摆角度，步骤(1.5)，把步骤(1.1)到步骤(1.4)中各电机的控制信号输入端分别与一个上 位机的控制信号输出端相连，所述各电机均为伺服电机；步骤(2)，在所述上位机内设定一个步态周期r，所述步态周期r是指每一步的开始时 刻^-o到碰撞时刻^-r所经历的时间〃-o表示所述第二大腿(7)的摆动腿离地的瞬间j二r标志一个步态周期结束，下一个步态周期开始，此时，所述第二大腿(7)的摆动腿变为支撑腿，而步态周期r时的支撑腿变为摆动腿，在所述步态周期r内所述双足机器人具有以下行走参数义，为所述第一脚板(16)与前进方向的夹角，或所述第二脚板(17)与前进方向的夹角，当所述第一脚板(16)在所述前进方向左侧时，义>0，所述第一脚板(16)在所述前进 方向右侧时，义<0，或当所述第二脚板(17)在所述前进方向右侧时，义>0，所述第二脚板(17)在所述前进方向左侧时，；i<o，步骤(3)，所述双足机器人在旋转运动时，在所述连续两个步态周期0至2r内设置以下3个关键帧-旋转运动第一关键帧^ = 0时，为旋转运动的初始状态，；u^， -10。〈a〈i(t，旋转运动第二关键帧r二r时，为旋转运动半步的末状态，；1 = -;^，旋转运动第三关键帧^二2r时，为旋转运动一步的末状态，；i-;io，所述上位机按下式计算每隔时间、步长次数为z'时的所述/1角， i 兀"， 义=々cos~^~z所述上位机按下式计算当步数为w,时，所述第一旋转自由度电机(2)、第二旋转自由度 电机(3)的旋转角度&。，及&。^2Sr。tatel =义 Sr。tate2 =义
全文摘要
双足机器人的动力式行走方法属于机器人行走方法技术领域，其特征在于，是一种在开环控制条件下能万向行走的双足机器人动力式行走方法，在上位机控制下，按照前进、侧摆和侧移、以及旋转行走三种不同的动力行走方式，分别控制安装在所述双足机器人髋关节、膝关节、踝关节的伺服电机。根据每个周期下每个计算步长Δt内运动角度与行走次数之间的关系计算每个步长下的不同运动方式时的角度，并据此来控制各个所述伺服电机的转角，来满足动力式平稳行走的条件，相应地提出了设定状态下各个关节运动角度的控制方法。本发明具有能万向地平稳行走的优点。
文档编号B25J13/00GK101531006SQ200910081288
公开日2009年9月16日 申请日期2009年3月31日 优先权日2009年3月31日
发明者李立国, 浩 董, 赵明国 申请人:清华大学