CN107168351B - 一种足式机器人的柔顺控制方法及装置 - Google Patents
一种足式机器人的柔顺控制方法及装置 Download PDFInfo
- Publication number
- CN107168351B CN107168351B CN201710381874.XA CN201710381874A CN107168351B CN 107168351 B CN107168351 B CN 107168351B CN 201710381874 A CN201710381874 A CN 201710381874A CN 107168351 B CN107168351 B CN 107168351B
- Authority
- CN
- China
- Prior art keywords
- foot
- foot end
- robot
- expected
- elastic element
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 29
- 210000001503 joint Anatomy 0.000 claims abstract description 27
- 230000005021 gait Effects 0.000 claims abstract description 19
- 230000000694 effects Effects 0.000 abstract description 9
- 238000010586 diagram Methods 0.000 description 8
- 230000007246 mechanism Effects 0.000 description 6
- 230000008569 process Effects 0.000 description 6
- 238000004590 computer program Methods 0.000 description 5
- 230000006870 function Effects 0.000 description 5
- 230000008859 change Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 241000238631 Hexapoda Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000009191 jumping Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种足式机器人的柔顺控制方法及装置,其包括:根据置于足式机器人足端的弹性元件在碰撞发生时刻的速度与受力关系定义足式机器人的足端期望参数;根据足端期望参数,采用逆运动学解逆算法确定足式机器人腿部关节的期望角度;根据腿部关节期望角度的闭环控制调整足式机器人的位姿。本发明提供的技术方案对足式机器人足端与周围环境的碰撞力进行柔顺控制,改变了足式机器人在运动中的步态;无需利用足式机器人腿部驱动部件力传感器信息参与,简单易行且控制效果良好。
Description
技术领域
本发明涉及一种控制方法及装置,具体涉及一种足式机器人的柔顺控制方法及装置。
背景技术
足式机器人的运动由静态行走,向跳跃、奔跑等高速动态运动延伸,传统的刚性机体结构无法实现这些高级运动功能,机构的柔顺化是提高足式机器人运动性能的必然要求。足式机器人的柔顺性是指机器人适应地面环境变化的能力,表现为多肢体步态的协调性,足端与地面接触的柔顺性(即冲击力小)等方面。提高机器人的柔顺性有两种途径:即主动柔顺控制和被动柔顺控制。
主动柔顺控制是指机器人在与环境接触时通过自身的控制实现与环境的柔性接触。对于控制足端力闭环的主动柔顺性控制方法来说,通常由上层解算出的足端期望力,经过雅克比变换换算成各驱动机构的期望力或转矩,由驱动控制器实现驱动机构的力或转矩闭环。此种方法需要测量各驱动机构的转矩,成本高,在非结构化环境下控制效果差。
发明内容
为克服现有技术的缺陷,本发明提出一种足式机器人的柔顺控制方法及装置,将足端力的控制转化为足端位置控制,使力的控制通过位置控制得以实现,弥补了传统主动柔顺性控制的不足,提升了结构化环境下的柔顺性控制效果。
为了实现上述目的,包括以下步骤:
一种足式机器人的柔顺控制方法,所述方法包括:
根据置于足式机器人足端的弹性元件在碰撞发生时刻的速度与受力关系定义足式机器人的足端期望参数;
根据足端期望参数,采用逆运动学解逆算法确定足式机器人腿部关节的期望角度;
根据腿部关节期望角度的闭环控制调整足式机器人的位姿。
优选的,所述弹性元件在碰撞发生时刻的速度v与受力F关系如下式所示:
F=∫kvdt (1)
优选的,所述足式机器人的足端期望参数足包括足端期望速度νd和足端期望位置pf,d;其中,
按下式确定足式机器人的足端期望速度νd:
按下式确定足式机器人在每个步态控制周期内的足端期望位置pf,d:
pf,d=pf,a+vd·dt (3)
其中,pf,a为足端实际位置。
优选的,按下式确定腿部关节的期望角度qd:
qd=IK(pf,d) (4)
其中,IK为腿部各关节运动学逆解,pf,d为足式机器人在每个步态控制周期内的足端期望位置。
优选的,所述根据各关节期望角度的闭环控制改变足式机器人的位姿包括:将足式机器人腿部各关节的关节期望角度输入至设于足式机器人中的位姿闭环控制器,输出足式机器人腿部各关节的位置。
一种足式机器人的柔顺控制装置,所述装置包括力控制模块、足端控制模块和闭环控制模块;其中,
所述力控制模块,用于根据置于足式机器人足端的弹性元件在碰撞发生时刻的速度与受力关系定义足式机器人的足端期望参数;
所述位置控制模块,用于根据足端期望参数,采用逆运动学解逆算法确定足式机器人腿部关节的期望角度;
所述闭环控制模块,用于根据腿部关节期望角度的闭环控制调整足式机器人的位姿。
优选的,所述足式机器人,包括分别设置于身体上的位姿闭环控制器部和足端内的弹性元件;
所述弹性元件,用于以液压驱动或者电驱动的驱动方式与周围环境产生弹性碰撞;其中,所述弹性元件包括液压缸和电机。
与最接近的现有技术相比,本发明提供的技术方案具有以下有益效果:
针对在足式机器人行走的过程中,足端与周围环境发生多次碰撞,极大地影响步态控制效果及其动态稳定性。本发明提出一种足式机器人柔顺控制方法及装置,对足式机器人足端与周围环境的碰撞力进行柔顺控制。通过根据置于足式机器人足端的弹性元件在碰撞发生时刻的速度与受力关系定义足式机器人的足端期望参数;根据足端期望参数,采用逆运动学解逆算法确定足式机器人腿部关节的期望角度;根据腿部关节期望角度的闭环控制调整足式机器人的位姿。使得足式机器人在运动中的步态得到有效的控制,从而提高了柔顺力性和动态稳定性。
无需利用足式机器人腿部驱动部件力传感器信息参与,仅仅利用足式机器人运动控制所必须的腿部驱动机构的位置闭环控制即可实现腿部足端三维力的闭环,从而满足足式机器人足端柔顺性控制的要求,省去了腿部驱动机构力或转矩传感器,简单易行且控制效果良好。特别适用于非结构化环境足地接触发生变化的情况。
附图说明
图1为本发明实施例中提供的足式机器人柔顺控制方法流程图。
具体实施方式
为使本发明的目的、内容、和优点更加清楚,下面按照实施例,对本发明的具体实施方式作进一步详细描述。
针对在足式机器人行走的过程中,足端与周围环境发生多次碰撞,极大地影响步态控制效果及其动态稳定性。本发明提出一种足式机器人柔顺控制方法及装置,对足式机器人足端与周围环境的碰撞力进行柔顺控制,从而改变足式机器人在运动中的步态;无需利用足式机器人腿部驱动部件力传感器信息参与,简单易行且控制效果良好。
本发明可应用于双足、四足、六足机器人等多足机器人。足式机器人行走的过程,可以看作足端不断和周围环境发生碰撞的过程,足端与周围环境所发生碰撞的方式极大地影响步态控制效果及其动态稳定性。碰撞分为两种方式:硬性碰撞与弹性碰撞。硬性碰撞发生在一瞬间,两碰撞物体之间的作用力非常大,可能对碰撞物体产生很大的破坏作用。弹性碰撞,由于中间弹性元件的缓冲,碰撞要持续一段时间,碰撞过程中的力是持续变化的。此处的弹性元件,可以为通常意义上的弹簧,也可以指液压***的液压缸、电动机中的齿轮、轴等,而足式机器的驱动方式大多为液压驱动或者电驱动,其腿端的液压缸或电机可以看作足端的弹性元件。因而,足式机器人的足端与周围环境的碰撞可以看作弹性碰撞,实现其足端与周围环境弹性碰撞过程中的碰撞力控制,便实现足端与周围环境的柔顺性控制。其中,本实施例涉及的足式机器人柔顺控制方法,如图1所示,其方法包括以下步骤:
(1)根据置于足式机器人足端的弹性元件在碰撞发生时刻的速度与受力关系定义足式机器人的足端期望参数;
对于运动中含有弹性元件的物体,通过下式确定弹性元件在碰撞发生时刻速度与受力的关系:
F=∫kvdt (1)
通过下式确定足端期望速度νd:
根据速度与受力的关系定义足式机器人的足端期望速度,并结合足端实际位置确定足式机器人在每个步态控制周期内的足端期望位置;
足式机器人在每个步态控制周期内的足端期望位置pf,d通过下式确定:
pf,d=pf,a+vd·dt (3)
其中,pf,a为足端实际位置。
(2)根据足端期望参数,采用逆运动学解逆算法确定足式机器人腿部关节的期望角度;
腿部各关节的关节期望角度通过下式确定qd:
qd=IK(pf,d) (4)
其中,IK为腿部各关节运动学逆解,pf,d为足式机器人在每个步态控制周期内的足端期望位置。
(3)根据腿部关节期望角度的闭环控制调整足式机器人的位姿。
将足式机器人腿部各关节的关节期望角度输入至设于足式机器人中的位姿闭环控制器,输出足式机器人腿部各关节的位置。
基于同一发明构思,本发明还提供一种足式机器人的柔顺控制装置。其中,足式机器人包括分别设置于身体上的位姿闭环控制器部和足端内的弹性元件;
所述弹性元件,用于以液压驱动或者电驱动的驱动方式与周围环境产生弹性碰撞;其中,弹性元件包括液压缸和电机。
而足式机器人的柔顺控制装置包括力控制模块、位置控制模块和闭环控制模块;
力控制模块,用于根据置于足式机器人足端的弹性元件在碰撞发生时刻的速度与受力关系定义足式机器人的足端期望参数;足式机器人的足端期望参数足包括:足端期望速度和足端期望位置;
位置控制模块,用于根据足端期望参数,采用逆运动学解逆算法确定足式机器人腿部关节的期望角度;
闭环控制模块,用于根据腿部关节期望角度的闭环控制调整足式机器人的位姿。
其中,力控制模块,包括受力分析单元、足端期望速度获取单元和足端期望位置获取单元;
受力分析单元,用于通过下式确定弹性元件在碰撞发生时刻的速度v与受力F关系:
F=∫kvdt (1)
所述足端期望速度获取单元,用于按下式确定足式机器人的足端期望速度νd:
足端期望位置获取单元,用于按下式确定足式机器人在每个步态控制周期内的足端期望位置pf,d:
pf,d=pf,a+vd·dt (3)
其中,pf,a为足端实际位置。
位置控制模块,包括期望角度获取单元,用于按下式确定腿部关节的期望角度qd:
qd=IK(pf,d) (4)
其中,IK为腿部各关节运动学逆解,pf,d为足式机器人在每个步态控制周期内的足端期望位置。
闭环控制模块,包括输入单元和输出单元;
输入单元,用于将足式机器人腿部各关节的关节期望角度输入至设于足式机器人中的位姿闭环控制器;
输出单元,用于输出足式机器人腿部各关节的位置。
本申请是参照根据本申请实施例的方法、设备(***)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
最后应当说明的是:以上实施例仅用以说明本发明的技术方案而非对其限制,尽管参照上述实施例对本发明进行了详细的说明,所属领域的普通技术人员应当理解:依然可以对本发明的具体实施方式进行修改或者等同替换,而未脱离本发明精神和范围的任何修改或者等同替换,其均应涵盖在本发明的权利要求保护范围之内。
Claims (3)
1.一种足式机器人的柔顺控制方法,其特征在于,所述方法包括:
根据置于足式机器人足端的弹性元件在碰撞发生时刻的速度与受力关系定义足式机器人的足端期望参数;
根据足端期望参数,采用逆运动学解逆算法确定足式机器人腿部关节的期望角度;
根据腿部关节期望角度的闭环控制调整足式机器人的位姿;
所述弹性元件在碰撞发生时刻的速度v与受力F关系如下式所示:
F=∫kvdt (1)
所述足式机器人的足端期望参数包括足端期望速度νd和足端期望位置pf,d;其中,
按下式确定足式机器人的足端期望速度νd:
按下式确定足式机器人在每个步态控制周期内的足端期望位置pf,d:
pf,d=pf,a+vd·dt (3)
其中,pf,a为足端实际位置;
其中,按下式确定腿部关节的期望角度qd:
qd=IK(pf,d) (4)
其中,IK为腿部各关节运动学逆解,pf,d为足式机器人在每个步态控制周期内的足端期望位置;
其中,所述根据各关节期望角度的闭环控制改变足式机器人的位姿包括:将足式机器人腿部各关节的关节期望角度输入至设于足式机器人中的位姿闭环控制器,输出足式机器人腿部各关节的位置。
2.一种用于执行权利要求1所述方法的足式机器人的柔顺控制装置,其特征在于,所述装置包括足端力控制模块、足端位置控制模块和闭环控制模块;其中,
所述足端力控制模块,用于根据置于足式机器人足端的弹性元件在碰撞发生时刻的速度与受力关系定义足式机器人的足端期望参数;
所述足端位置控制模块,用于根据足端期望参数,采用逆运动学解逆算法确定足式机器人腿部关节的期望角度;
所述闭环控制模块,用于根据腿部关节期望角度的闭环控制调整足式机器人的位姿。
3.如权利要求2所述的装置,其特征在于,所述足式机器人,包括分别设置于身体上的位姿闭环控制器部和足端内的弹性元件;
所述弹性元件,用于以液压驱动或者电驱动的驱动方式与周围环境产生弹性碰撞;其中,所述弹性元件包括液压缸和电机。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710381874.XA CN107168351B (zh) | 2017-05-26 | 2017-05-26 | 一种足式机器人的柔顺控制方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710381874.XA CN107168351B (zh) | 2017-05-26 | 2017-05-26 | 一种足式机器人的柔顺控制方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107168351A CN107168351A (zh) | 2017-09-15 |
CN107168351B true CN107168351B (zh) | 2022-07-19 |
Family
ID=59822288
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710381874.XA Active CN107168351B (zh) | 2017-05-26 | 2017-05-26 | 一种足式机器人的柔顺控制方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107168351B (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109693237B (zh) * | 2017-10-23 | 2021-01-08 | 深圳市优必选科技有限公司 | 机器人及其弹跳控制方法、装置及计算机可读存储介质 |
CN109987169B (zh) * | 2017-12-29 | 2021-01-08 | 深圳市优必选科技有限公司 | 双足机器人的步态控制方法、装置、终端设备及介质 |
CN108508906B (zh) * | 2018-05-23 | 2020-11-27 | 哈尔滨理工大学 | 户外环境下的多足机器人双边触觉遥操作***及控制方法 |
CN109324624A (zh) * | 2018-10-12 | 2019-02-12 | 哈尔滨理工大学 | 一种基于可操作度分析的崎岖地形六足机器人操纵方法 |
CN110202584B (zh) * | 2019-07-11 | 2020-10-23 | 燕山大学 | 带半圆柱形足端的足式机器人腿部运动学修正方法及*** |
CN110412921B (zh) * | 2019-08-09 | 2021-07-27 | 山东大学 | 基于EtherCAT的机器人单腿高实时性控制*** |
CN111857170B (zh) * | 2020-07-29 | 2024-04-09 | 中国人民解放军陆军装甲兵学院 | 一种四足机器人腿部关节负载规律分析方法 |
CN112256028B (zh) * | 2020-10-15 | 2021-11-19 | 华中科技大学 | 一种双足机器人柔顺步态控制方法、***、设备及介质 |
CN112297009B (zh) * | 2020-10-29 | 2022-04-05 | 燕山大学 | 一种机器人三自由度腿部的阻抗新构型生成方法及*** |
CN112882485B (zh) * | 2021-01-25 | 2022-04-26 | 河南大学 | 一种双足机器人逆运动学的几何计算方法 |
CN113433961B (zh) * | 2021-07-02 | 2022-10-14 | 北方工业大学 | 一种足式机器人的足端触地反馈部件及其控制方法 |
CN113524190B (zh) * | 2021-07-26 | 2022-07-29 | 深圳市优必选科技股份有限公司 | 机器人足端碰撞稳定控制方法、装置和足式机器人 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103941582A (zh) * | 2014-03-25 | 2014-07-23 | 中国人民解放军国防科学技术大学 | 液压驱动型仿生单腿双环控制方法 |
CN104108433A (zh) * | 2014-06-30 | 2014-10-22 | 中国人民解放军国防科学技术大学 | 一种轮足式机器人的柔顺控制方法 |
CN104793621A (zh) * | 2015-05-12 | 2015-07-22 | 北京理工大学 | 一种模仿肌肉粘弹特性的仿人机器人行走稳定控制方法 |
CN105269577A (zh) * | 2015-06-26 | 2016-01-27 | 浙江大学 | 仿人双足机器人步态切换控制***及控制方法 |
CN105947012A (zh) * | 2016-05-10 | 2016-09-21 | 南京航空航天大学 | 差分齿轮驱动机器人腿机构及控制方法 |
CN106078750A (zh) * | 2016-07-08 | 2016-11-09 | 燕山大学 | 一种足式机器人液压驱动单元主动柔顺控制方法 |
CN106483964A (zh) * | 2015-08-31 | 2017-03-08 | 中南大学 | 一种基于接触力观测器的机器人柔顺控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080109115A1 (en) * | 2006-11-03 | 2008-05-08 | Michael Zin Min Lim | Dynamic force controller for multilegged robot |
-
2017
- 2017-05-26 CN CN201710381874.XA patent/CN107168351B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103941582A (zh) * | 2014-03-25 | 2014-07-23 | 中国人民解放军国防科学技术大学 | 液压驱动型仿生单腿双环控制方法 |
CN104108433A (zh) * | 2014-06-30 | 2014-10-22 | 中国人民解放军国防科学技术大学 | 一种轮足式机器人的柔顺控制方法 |
CN104793621A (zh) * | 2015-05-12 | 2015-07-22 | 北京理工大学 | 一种模仿肌肉粘弹特性的仿人机器人行走稳定控制方法 |
CN105269577A (zh) * | 2015-06-26 | 2016-01-27 | 浙江大学 | 仿人双足机器人步态切换控制***及控制方法 |
CN106483964A (zh) * | 2015-08-31 | 2017-03-08 | 中南大学 | 一种基于接触力观测器的机器人柔顺控制方法 |
CN105947012A (zh) * | 2016-05-10 | 2016-09-21 | 南京航空航天大学 | 差分齿轮驱动机器人腿机构及控制方法 |
CN106078750A (zh) * | 2016-07-08 | 2016-11-09 | 燕山大学 | 一种足式机器人液压驱动单元主动柔顺控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107168351A (zh) | 2017-09-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107168351B (zh) | 一种足式机器人的柔顺控制方法及装置 | |
Park et al. | Variable-speed quadrupedal bounding using impulse planning: Untethered high-speed 3d running of mit cheetah 2 | |
US8676381B2 (en) | Humanoid robot and walking control method thereof | |
US20210162589A1 (en) | Systems and methods for learning agile locomotion for multiped robots | |
US8781628B2 (en) | Walking robot and control method thereof | |
EP2426037B1 (en) | Walking robot and control method thereof | |
Gao et al. | Low impact force and energy consumption motion planning for hexapod robot with passive compliant ankles | |
Ba et al. | A novel position-based impedance control method for bionic legged robots’ HDU | |
Nor et al. | CPG-based locomotion control of a snake-like robot for obstacle avoidance | |
Duperret et al. | Core actuation promotes self-manipulability on a direct-drive quadrupedal robot | |
Miao et al. | Biped walking robot based on a 2-UPU+ 2-UU parallel mechanism | |
Chen et al. | Trajectory adaptation of biomimetic equilibrium point for stable locomotion of a large-size hexapod robot | |
Sadedel et al. | Heel-strike and toe-off motions optimization for humanoid robots equipped with active toe joints | |
Liu et al. | Design of a kangaroo robot with dynamic jogging locomotion | |
Yime et al. | Robot based on task-space dynamical model | |
Guo et al. | Motion planning for humanoid robot dynamically stepping over consecutive large obstacles | |
Hanazawa et al. | Asymmetric swing-leg motions for speed-up of biped walking | |
Kuber et al. | Estimation of zero moment point using centre of gravity based method | |
Ikeda et al. | Analysis of the energy loss on quadruped robot having a flexible trunk joint | |
Xu et al. | Dynamics modeling and smooth control of flexible robot joint | |
Du et al. | Fault tolerant gaits for a six-legged robot with one locked or uncontrollable failure | |
Grzelczyk et al. | Analysis of contact forces between the ground and the hexapod robot legs during tripod gait | |
JP2010253608A (ja) | 脚式ロボット及びその制御方法 | |
Masahiro et al. | Analysis of the Energy Loss on Quadruped Robot Having a Flexible Trunk Joint | |
Zhang et al. | Cylindrical inverted pendulum model for three dimensional bipedal walking |
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 |