CN111230868A - 双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法 - Google Patents
双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法 Download PDFInfo
- Publication number
- CN111230868A CN111230868A CN202010063092.3A CN202010063092A CN111230868A CN 111230868 A CN111230868 A CN 111230868A CN 202010063092 A CN202010063092 A CN 202010063092A CN 111230868 A CN111230868 A CN 111230868A
- Authority
- CN
- China
- Prior art keywords
- robot
- gait
- state
- initial
- theta
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明提供一种双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法。当机器人含有欠驱动脚踝,或脚踝处于力控模式时,机器人受到的外部扰动可通过踝关节自由度(或其它与之相关的变量)的状态变化体现出来。基于该思路,本发明所提供的步态规划与控制方法对机器人的踝关节采用力控模式,然后选取支撑腿脚踝、支撑腿髋关节间的连线与竖直方向的夹角θ作为机器人的状态变量对机器人的状态进行表征,并基于简化倒立摆模型对机器人的状态进行实时估计和计算。基于本发明所提供的方法,无需对机器人受到的外部推力信息进行测量,即可实现实时反馈和控制。
Description
技术领域
本发明属于机器人技术领域,具体涉及一种双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法。
背景技术
双足机器人在步行过程中不可避免地会受到各种外部扰动的影响,如何实现双足机器人在外部扰动下的稳定行走,对于它们的实际应用具有非常重要的意义。从已公开的一些仿真以及实验结果来看,双足机器人目前抗扰动能力依然较弱,鲁棒性仍然较差,特别是当双足机器人在前进方向受到外部推力扰动时,很容易发生失稳摔倒。
目前,国内外研究人员考虑双足机器人在外部推力扰动下的步态规划与控制问题时,常假设推力信息已知或可测量(包括推力的幅值以及作用位置等),然后再通过补偿控制或者跟踪控制的方法来实现稳定步行,例如文献《On the adaptation of dynamicwalking to persistent external forcing using hybrid zero dynamics control》、《Event-Based Stabilization of Periodic Orbits for Underactuated 3-D BipedalRobots With Left-Right Symmetry》以及最近发表的《不确定性扰动下3-D双足机器人动态步行的鲁棒控制研究》。然而,在实际应用中,双足机器人受到的推力信息,特别是作用位置信息,很难被准确感知。在此情形下,往往难以实现有效的补偿控制或者跟踪控制,尤其是存在被动动态的情形。
发明内容
为克服上述问题,本发明提供一种双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法。当机器人含有欠驱动脚踝,或脚踝处于力控模式时,机器人受到的外部扰动可通过踝关节自由度(或其它与之相关的变量)的状态变化体现出来。基于该思路,本发明所提供的步态规划与控制方法对机器人的踝关节采用力控模式,然后选取一个合适的状态变量对机器人的状态进行表征,并基于简化倒立摆模型对机器人的状态进行实时估计和计算。基于本发明所提供的方法,无需对机器人受到的外部推力信息进行测量,即可实现实时反馈和控制。
本发明的技术目的通过以下技术方案实现:
一种双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法,包含以下步骤:
步骤一,根据给定的机器人初始状态和末状态,规划出机器人的初始步态。其中,在初始步态下,支撑腿膝关节自由度处于锁死状态,支撑腿踝关节俯仰自由度的驱动力矩为零,以提高步行能效。
步骤二,基于简化倒立摆模型,对机器人的状态进行实时估计和计算:
首先,将机器人简化为倒立摆模型,倒立摆质心位于机器人支撑腿髋关节处,并将支撑腿脚踝与支撑腿髋关节间的连线作为虚拟腿,虚拟腿长为l,虚拟腿与竖直方向的夹角为θ。
接着,基于机器人的当前状态预估机器人的落地时间。具体计算过程为,选取当前状态作为初始值,然后计算机器人到达给定末状态角度θf所需的时间。同样将sinθ简化为θ,则机器人从当前状态到落地时刻所需的时间为
步骤三,根据步骤二的状态估计与角速度偏差计算结果,对机器人支撑脚踝关节俯仰自由度施加力矩
uankle,st=-kue
其中ku为比例系数。若uankle,st的幅值大于电机额定转矩umax,则其幅值取umax。
步骤四,基于步骤二的落地时间估计,对机器人的规划步态进行修正。根据机器人的当前状态以及给定的末状态,选取落地时间tland作为步行时长对机器人重新规划步态。
进一步地,采用三次贝塞尔多项式对机器人重新规划步态,贝尔塞多项式的系数根据机器人的当前状态以及给定的末状态来进行确定。
本发明的有益效果在于:本发明提供了一种双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法。该方法对机器人的踝关节采用力控模式,然后选取一个合适的状态变量对机器人的状态进行表征,并基于简化倒立摆模型对机器人的状态进行实时估计和计算。本发明方法通过支撑腿脚踝、支撑腿髋关节间的连线与竖直方向的夹角θ反应机器人受到的前进方向的外部推力,无需对机器人受到的外部推力信息进行测量,即可实现实时反馈和控制。
附图说明
图1为11自由度双足机器人的模型示意图,其中a为前向平面,b为侧向平面;
图2为双足机器人的简化倒立摆模型;
具体实施方式
以下结合附图和实施例对本发明作进一步说明。
如图1所示,本实施例考虑具有11个自由度的双足机器人,qankle,roll为支撑脚踝关节在前向平面内的自由度,qankle,st为支撑脚踝关节俯仰自由度(在侧向平面内的自由度),qknee,st为支撑腿膝关节自由度,qyaw,st为支撑腿髋关节的转动自由度,qroll,st为支撑腿髋关节的摆动自由度,qpitch,st为支撑腿髋关节的俯仰自由度,qyaw,sw为摆动腿髋关节的转动自由度,qroll,sw为摆动腿髋关节的摆动自由度,qpitch,sw为摆动腿髋关节的俯仰自由度,qknee,sw为摆动腿膝关节自由度其中,qankle,sw为摆动腿踝关节俯仰自由度,其中,qankle,roll是没有电机驱动的欠驱动自由度。
本发明所提供的一种双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法,包含如下步骤:
步骤一,根据给定的机器人初始状态和末状态,规划出机器人的初始步态。在初始步态下,为使机器人支撑腿长度尽量保持不变,机器人支撑腿膝关节角度qknee,st处于锁死状态。此外,使支撑腿踝关节俯仰自由度qankle,st的驱动力矩为零。机器人的关节轨迹可规划为如下三次贝塞尔多项式:
其中qst=[qknee,st,qyaw,st,qroll,st,qpitch,st]T表示机器人支撑腿的驱动自由度,qsw=[qyaw,sw,qroll,sw,qpitch,sw,qknee,sw,qankle,sw]T表示机器人摆动腿的驱动自由度,Td表示机器人初始步态的步行时长,t为时间;向量ak(k=0,1,2,3)为qst的贝塞尔多项式系数,而标量βk(k=0,1,2,3)为qsw的贝塞尔多项式系数,各贝塞尔多项式系数可根据机器人初始步态的初始状态以及末状态来进行确定,其中,qknee,st的初始状态和末状态保持一致以实现膝关节的锁死。
步骤二,基于简化倒立摆模型,对机器人的状态进行实时估计和计算:
首先,将机器人简化为倒立摆模型,倒立摆质心位于机器人支撑腿髋关节处,并将支撑腿脚踝与支撑腿髋关节间的连线作为虚拟腿,虚拟腿长为l,虚拟腿与竖直方向的夹角为θ,如图2所示。在本实例中,θ的具体表达如下:
θ=qankle,st+0.5qknee,st
接着,基于机器人的当前状态预估机器人的落地时间。具体计算过程为,选取当前状态作为初始值,然后计算机器人到达给定末状态角度θf所需的时间。同样将sinθ简化为θ,则机器人从当前状态到落地时刻所需的时间为
步骤三,根据步骤二的状态估计与计算结果,对机器人支撑脚踝关节俯仰自由度施加力矩
uankle,st=-kue
其中ku为比例系数,该比例系数可以根据电机和实验效果来进行确定,本实施例中采用40。若uankle,st的幅值大于电机额定转矩umax,则其幅值取umax。
步骤四,基于步骤二的落地时间估计,对机器人的规划步态进行修正。根据机器人的当前状态以及给定的末状态,选取落地时间tland作为步行时长,并基于三次贝塞尔多项式重新规划步态,贝尔塞多项式的系数根据机器人的当前状态以及给定的末状态来进行确定。
本发明方法通过支撑腿脚踝、支撑腿髋关节间的连线与竖直方向的夹角θ反应机器人受到的前进方向的外部推力,无需对机器人受到的外部推力信息进行测量,即可实现实时反馈和控制。
以上实施例仅用于说明本发明的设计思想和特点,其目的在于使本领域内的技术人员能够了解本发明的内容并据以实施,本发明的保护范围不限于上述实施例。所以,凡依据本发明所揭示的原理、设计思路所作的等同变化或修饰,均在本发明的保护范围之内。
Claims (3)
1.一种双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法,其特征在于,将根据机器人的初始状态规划机器人初始步态,所述初始步态中,支撑腿膝关节自由度处于锁死状态,支撑腿踝关节俯仰自由度的驱动力矩为零;将支撑腿脚踝、支撑腿髋关节间的连线与竖直方向的夹角θ作为机器人的状态变量,计算机器人当前步态与初始步态之间的θ对应的角速度偏差,同时以当前状态作为初始值预估机器人摆动腿的落地时间。根据计算得到的偏差值对机器人支撑脚踝关节俯仰自由度施加力矩,并选取预估的落地时间作为步行时长,基于贝塞尔多项式重新规划步态。通过对夹角θ进行实时估计和计算和反馈,实现对机器人在前进方向受到外部推力扰动时的步态规划与控制。
2.如权利要求1所述的一种双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法,其特征在于,具体包括以下步骤:
步骤一,根据给定的机器人初始状态和末状态,规划出机器人的初始步态。其中,在初始步态下,支撑腿膝关节自由度处于锁死状态,支撑腿踝关节俯仰自由度的驱动力矩为零,以提高步行能效。
步骤二,基于简化倒立摆模型,对机器人的状态进行实时估计和计算:
首先,将机器人简化为倒立摆模型,倒立摆质心位于机器人支撑腿髋关节处,并将支撑腿脚踝与支撑腿髋关节间的连线作为虚拟腿,虚拟腿长为l,虚拟腿与竖直方向的夹角为θ。
接着,基于机器人的当前状态预估机器人的落地时间。具体计算过程为:选取当前状态作为初始值,然后计算机器人到达给定末状态角度θf所需的时间。同样将sinθ简化为θ,则机器人从当前状态到落地时刻所需的时间为
步骤三,根据步骤二的状态估计与角速度偏差计算结果,对机器人支撑脚踝关节俯仰自由度施加力矩
uankle,st=-kue
其中ku为比例系数。若uankle,st的幅值大于电机额定转矩umax,则其幅值取umax。
步骤四,基于步骤二的落地时间估计,对机器人的规划步态进行修正。根据机器人的当前状态以及给定的末状态,选取落地时间tland作为步行时长对机器人重新规划步态。
3.如权利要求2所述的一种双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法,其特征在于,所述步骤四中,采用三次贝塞尔多项式对机器人重新规划步态,贝尔塞多项式的系数根据机器人的当前状态以及给定的末状态来进行确定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010063092.3A CN111230868B (zh) | 2020-01-19 | 2020-01-19 | 双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010063092.3A CN111230868B (zh) | 2020-01-19 | 2020-01-19 | 双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111230868A true CN111230868A (zh) | 2020-06-05 |
CN111230868B CN111230868B (zh) | 2022-01-04 |
Family
ID=70878106
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010063092.3A Active CN111230868B (zh) | 2020-01-19 | 2020-01-19 | 双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111230868B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112698650A (zh) * | 2020-12-16 | 2021-04-23 | 深圳市优必选科技股份有限公司 | 仿人机器人的类人步态控制方法、装置、设备及存储介质 |
CN112918585A (zh) * | 2021-02-20 | 2021-06-08 | 杭州三因云信息技术有限公司 | 一种欠驱动双足步行机器人的步态控制方法 |
CN113830197A (zh) * | 2021-11-23 | 2021-12-24 | 之江实验室 | 一种应用于双足机器人动态行走的平衡控制方法 |
CN114200947A (zh) * | 2022-02-15 | 2022-03-18 | 之江实验室 | 一种双足机器人的仿人步态规划方法、系统及装置 |
CN114248855A (zh) * | 2021-12-20 | 2022-03-29 | 北京理工大学 | 双足机器人空间域步态规划与控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108237532A (zh) * | 2016-12-23 | 2018-07-03 | 深圳光启合众科技有限公司 | 多足机器人的步态控制方法、装置和机器人 |
CN109202901A (zh) * | 2018-08-29 | 2019-01-15 | 厦门理工学院 | 一种双足机器人爬楼梯步态规划方法、装置及机器人 |
CN109605345A (zh) * | 2018-12-20 | 2019-04-12 | 清华大学 | 一种模块化机器人结构感知方法 |
CN110315543A (zh) * | 2019-07-29 | 2019-10-11 | 北京理工大学 | 一种双足机器人步态生成与优化方法 |
JP2019193965A (ja) * | 2017-09-21 | 2019-11-07 | 上銀科技股▲分▼有限公司 | ロボットアームのための負荷推定及び重力補償方法、並びにそのシステム |
US10493617B1 (en) * | 2016-10-21 | 2019-12-03 | X Development Llc | Robot control |
-
2020
- 2020-01-19 CN CN202010063092.3A patent/CN111230868B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10493617B1 (en) * | 2016-10-21 | 2019-12-03 | X Development Llc | Robot control |
CN108237532A (zh) * | 2016-12-23 | 2018-07-03 | 深圳光启合众科技有限公司 | 多足机器人的步态控制方法、装置和机器人 |
JP2019193965A (ja) * | 2017-09-21 | 2019-11-07 | 上銀科技股▲分▼有限公司 | ロボットアームのための負荷推定及び重力補償方法、並びにそのシステム |
CN109202901A (zh) * | 2018-08-29 | 2019-01-15 | 厦门理工学院 | 一种双足机器人爬楼梯步态规划方法、装置及机器人 |
CN109605345A (zh) * | 2018-12-20 | 2019-04-12 | 清华大学 | 一种模块化机器人结构感知方法 |
CN110315543A (zh) * | 2019-07-29 | 2019-10-11 | 北京理工大学 | 一种双足机器人步态生成与优化方法 |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112698650A (zh) * | 2020-12-16 | 2021-04-23 | 深圳市优必选科技股份有限公司 | 仿人机器人的类人步态控制方法、装置、设备及存储介质 |
CN112698650B (zh) * | 2020-12-16 | 2024-05-07 | 深圳市优必选科技股份有限公司 | 仿人机器人的类人步态控制方法、装置、设备及存储介质 |
CN112918585A (zh) * | 2021-02-20 | 2021-06-08 | 杭州三因云信息技术有限公司 | 一种欠驱动双足步行机器人的步态控制方法 |
CN113830197A (zh) * | 2021-11-23 | 2021-12-24 | 之江实验室 | 一种应用于双足机器人动态行走的平衡控制方法 |
CN114248855A (zh) * | 2021-12-20 | 2022-03-29 | 北京理工大学 | 双足机器人空间域步态规划与控制方法 |
CN114248855B (zh) * | 2021-12-20 | 2022-10-21 | 北京理工大学 | 双足机器人空间域步态规划与控制的方法 |
CN114200947A (zh) * | 2022-02-15 | 2022-03-18 | 之江实验室 | 一种双足机器人的仿人步态规划方法、系统及装置 |
CN114200947B (zh) * | 2022-02-15 | 2022-06-10 | 之江实验室 | 一种双足机器人的仿人步态规划方法、系统及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN111230868B (zh) | 2022-01-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111230868B (zh) | 双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法 | |
Park et al. | Variable-speed quadrupedal bounding using impulse planning: Untethered high-speed 3d running of mit cheetah 2 | |
CN110315543B (zh) | 一种双足机器人步态生成与优化方法 | |
US10935986B1 (en) | Gliding depth control method, system and device for biomimetic gliding robotic dolphin | |
US11253993B2 (en) | Method for modeling robot simplified for stable walking control of bipedal robot | |
KR100685339B1 (ko) | 이동 로봇 | |
JP3269852B2 (ja) | 脚式移動ロボットの姿勢安定化制御装置 | |
US11230001B2 (en) | Biped robot gait control method and biped robot | |
CN103149933B (zh) | 基于闭环控制的仿人机器人全向行走方法 | |
US8024070B2 (en) | Passive walking legged robot | |
CN104108433B (zh) | 一种轮足式机器人的柔顺控制方法 | |
CN103955223A (zh) | 一种深空探测软着陆过程的姿轨耦合控制方法 | |
CN114578836B (zh) | 一种双轮足机器人跳跃控制方法 | |
CN114625129B (zh) | 位控腿足机器人的运动控制方法及系统 | |
CN104898672A (zh) | 一种仿人机器人行走轨迹的优化控制方法 | |
CN111176342B (zh) | 一种双足机器人仿人步态的步行速度调节方法 | |
Orsolino et al. | A combined limit cycle-zero moment point based approach for omni-directional quadrupedal bounding | |
CN112918585A (zh) | 一种欠驱动双足步行机器人的步态控制方法 | |
Jin et al. | A gyroscope-based inverted pendulum with application to posture stabilization of bicycle vehicle | |
Lim et al. | Control design to achieve dynamic walking on a bipedal robot with compliance | |
CN114564010A (zh) | 一种双轮足机器人单边越障控制方法 | |
Liu et al. | Research on Horizontal Path Tracking Control of a Biomimetic Robotic Fish | |
Song et al. | Development of an omnidirectional walking engine for full-sized lightweight humanoid robots | |
Palmer et al. | Force redistribution in a quadruped running trot | |
CN106019942A (zh) | 一种基于动力学模型的机器人最大速度获取方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |