CN111857173A - 一种四足机器人跳跃步态规划控制***及其方法 - Google Patents
一种四足机器人跳跃步态规划控制***及其方法 Download PDFInfo
- Publication number
- CN111857173A CN111857173A CN202010824019.3A CN202010824019A CN111857173A CN 111857173 A CN111857173 A CN 111857173A CN 202010824019 A CN202010824019 A CN 202010824019A CN 111857173 A CN111857173 A CN 111857173A
- Authority
- CN
- China
- Prior art keywords
- jumping
- quadruped robot
- motion
- control system
- information
- 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.)
- Pending
Links
- 230000009191 jumping Effects 0.000 title claims abstract description 84
- 230000005021 gait Effects 0.000 title claims abstract description 31
- 238000000034 method Methods 0.000 title claims abstract description 15
- 230000033001 locomotion Effects 0.000 claims abstract description 67
- 238000012545 processing Methods 0.000 claims abstract description 18
- 238000001914 filtration Methods 0.000 claims description 3
- 238000007726 management method Methods 0.000 claims description 2
- 238000012876 topography Methods 0.000 abstract description 4
- 230000001174 ascending effect Effects 0.000 abstract description 2
- 210000001364 upper extremity Anatomy 0.000 description 10
- 241000282414 Homo sapiens Species 0.000 description 4
- 230000005484 gravity Effects 0.000 description 3
- 238000011160 research Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008447 perception 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
本发明公开了一种四足机器人跳跃步态规划控制***及其方法,***包括外部环境获取***、姿态获取***、运动规划决策***和执行控制***;外部环境获取***获取四足机器人所需跳跃的地形信息,经数据处理后输入运动规划决策***;姿态获取***获取四足机器人当前的姿态信息,经数据处理后输入运动规划决策***;运动规划决策***依据当前地形信息和四足机器人的姿态信息分析规划出四足机器人跳跃的运动轨迹,并传递至执行控制***;执行控制***根据运动轨迹计算各个关节所需的控制力矩,以及进行ZMP控制算法。本发明依据地形概况,设计了平地跳跃、上坡跳跃、下坡跳跃和非平地跳跃等四种跳跃步态方式,可有效适应于不同的地形环境。
Description
技术领域
本发明涉及机器人控制技术领域,特别是一种四足机器人跳跃步态规划控制***及其方法。
背景技术
机器人是一种能够半自主或全自主工作的智能机器,具有感知、决策、执行等基本特征,可以辅助甚至替代人类完成危险、繁重、复杂的工作,提高工作效率与质量,服务人类生活,扩大或延伸人的活动及能力范围。随着科技信息的快速发展,机器人控制技术得到了不断的完善,机器人在各行各业的应用也越来越广泛。机器人的类型也是多种多样的,尤其是机器人的结构,更是千差万别,不同结构的机器人具有其独特的功能和应用环境。四足机器人是机器人中的一种,四足机器人典型的特点是具有四只腿。四足机器人的研究和应用得到了众多学者的重视,不仅科研成果***,实际应用案例也是比比皆是。四足机器人在协助或替代人类在一定的环境中完成指定的工作任务过程中,需要四足机器人拥有精准的控制技术。同时,需要四足机器人具有灵活的运动控制技术,包括四足机器人的行走和跳跃。在未知的复杂的地形环境中,四足机器人需要通过行走或者跳跃的方式到达目的以完成指定的工作任务。目前,四足机器人的行走步态和跳跃步态控制规划方法各异,各有其优缺点。
发明内容
针对现有技术中存在的问题,本发明提供了一种通过依据地形概况,设计了平地跳跃、上坡跳跃、下坡跳跃和非平地跳跃等四种跳跃步态方式,以灵活的跳跃方式,使得四足机器人更加适应于不同的地形环境的四足机器人跳跃步态规划控制***及其方法。
一种四足机器人跳跃步态规划控制***,包括外部环境获取***、姿态获取***、运动规划决策***和执行控制***;所述外部环境获取***获取四足机器人所需跳跃的地形信息,经数据处理后输入运动规划决策***;所述姿态获取***获取四足机器人当前的姿态信息,经数据处理后输入运动规划决策***;所述运动规划决策***依据当前地形信息和四足机器人的姿态信息分析规划出四足机器人跳跃的运动轨迹,并传递至执行控制***;所述执行控制***根据运动轨迹计算各个关节所需的控制力矩,以及进行ZMP控制算法。
进一步地,所述外部环境获取***为ARM嵌入式***,通过CAN总线连接运动规划决策***,通过USB口连接一只迷你摄像头,通过视频处理技术和图像处理技术获取四足机器人前方跳跃区域的地形信息。
进一步地,所述姿态获取***为ARM嵌入式***,通过CAN总线连接运动规划决策***,获取四足机器人当前的姿态信息,包括:关节俯仰角度、偏航角度、控制力矩等,并设计滤波算法对姿态信息进行滤波处理。
进一步地,所述运动规划决策***为工业级PC,通过串口线连接执行控制***,分析规划出四足机器人的跳跃步态方式,包括:平地跳跃、上坡跳跃、下坡跳跃和非平地跳跃。
进一步地,所述平地跳跃为四足机器人跳跃区域的地形特征表现为平坦无坑无障碍。
进一步地,所述上坡跳跃为四足机器人跳跃区域的地形特征表现为斜坡向上,且不超过一定的坡度值。
进一步地,所述下坡跳跃为四足机器人跳跃区域的地形特征表现为斜坡向下,且不超过一定的坡度值。
进一步地,所述非平地跳跃为四足机器人跳跃区域的地形特征表现为崎岖不平,可能包含有大小不等的坑和障碍物等。
进一步地,所述执行控制***为工业级PC。
进一步地,所述部环境获取***、姿态获取***、运动规划决策***和执行控制***采用统一的电源管理***。
一种四足机器人跳跃步态规划控制方法,包括如下步骤:
SS00四足机器人准备跳跃;
SS01外部环境获取***获取四足机器人所需跳跃的地形信息,经数据处理后输入运动规划决策***;
SS02姿态获取***获取四足机器人当前的姿态信息,经数据处理后输入运动规划决策***;SS03运动规划决策***依据当前地形信息和四足机器人的姿态信息分析规划出四足机器人跳跃的运动轨迹,规划出包括:平地跳跃、上坡跳跃、下坡跳跃和非平地跳跃的运动轨迹中的一种,并将规划出的运动轨迹传递至执行控制***;
SS04执行控制***根据运动轨迹计算各个关节所需的控制力矩,并输入对应的关节,同时进行ZMP控制算法对各个关节角度进行适当调整,从而提高四足机器人的鲁棒性。
本发明具有以下有益效果:
1、本发明通过四足机器人的多模态跳跃步态形式,可有效适应于不同的地形环境。
2、本发明的四足机器人的跳跃步态运动控制更加灵活和精准。
当然,实施本发明的任一产品并不一定需要同时达到以上所述的所有优点。
附图说明
图1为本发明***结构示意图。
具体实施方式
下面结合说明书附图和具体的实施例,对本发明作详细描述。
如图1所示,本发明为一种四足机器人跳跃步态规划控制***,包括外部环境获取***1、姿态获取***2、运动规划决策***3和执行控制***4。
外部环境获取***1获取四足机器人所需跳跃的地形信息,经数据处理后输入运动规划决策***3;姿态获取***2获取四足机器人当前的姿态信息,经数据处理后输入运动规划决策***3;运动规划决策***3依据当前地形信息和四足机器人的姿态信息分析规划出四足机器人跳跃的运动轨迹,并传递至执行控制***4;执行控制***4根据运动轨迹计算各个关节所需的控制力矩,以及进行ZMP控制算法。
一种四足机器人跳跃步态规划方法,包括如下过程;
四足机器人准备跳跃时。外部环境获取***1获取四足机器人所需前方跳跃区域的地形信息,地形信息经视频处理技术和图像处理技术后输入运动规划决策***3。姿态获取***2获取四足机器人当前的姿态信息,包括:关节俯仰角度、偏航角度、控制力矩等,并设计滤波算法对姿态信息进行滤波处理,经处理后输入运动规划决策***3。运动规划决策***3依据当前地形信息和四足机器人的姿态信息分析规划出四足机器人跳跃的运动轨迹,规划出包括:平地跳跃、上坡跳跃、下坡跳跃和非平地跳跃的运动轨迹中的一种,并将规划出的运动轨迹传递至执行控制***4。执行控制***4响应运动规划决策***3,若运动轨迹为平地跳跃,则表示四足机器人跳跃区域的地形特征为平坦无坑无障碍,起跳前,执行控制***4根据运动轨迹计算各个关节所需的控制力矩,并输入对应的关节,控制左右后腿向下压至一定角度,控制左右前腿向上抬起一定角度,起跳时,左右前腿向前用力,左右后腿向上用力,落地时,控制四只腿站稳于地面,完成平地跳跃,以待下一次跳跃;若运动轨迹为上坡跳跃,则表示四足机器人跳跃区域的地形表现为斜坡向上,但这个斜坡的坡度值不能超过一定的角度值,否则四足机器人无法完成上坡跳跃,起跳前,执行控制***4根据运动轨迹计算各个关节所需的控制力矩,并输入对应的关节,控制左右后腿向下压至一定角度,控制左右前腿向上抬起一定角度,起跳时,左右前腿向前用力,左右后腿向上用力,落地时,由于地面是上坡,增加左右后腿的关节控制力矩,降低左右前腿的关节控制力矩,从而控制四足机器人的重心在稳定区域,完成上坡跳跃,以待下一次跳跃;若运动轨迹为下坡跳跃,则四足机器人跳跃区域的地形表现为斜坡向下,但这个斜坡的坡度值不能超过一定的角度值,否则四足机器人无法完成下坡跳跃,起跳前,执行控制***4根据运动轨迹计算各个关节所需的控制力矩,并输入对应的关节,控制左右后腿向下压至一定角度,控制左右前腿向上抬起一定角度,起跳时,左右前腿向前用力,左右后腿向上用力,落地时,由于地面是下坡,降低左右后腿的关节控制力矩,增加左右前腿的关节控制力矩,从而控制四足机器人的重心在稳定区域,完成下坡跳跃,以待下一次跳跃;若运动轨迹为非平地跳跃,则四足机器人跳跃区域的地形表现为崎岖不平,可能包含有大小不等的坑和障碍物等,起跳前,执行控制***4根据运动轨迹计算各个关节所需的控制力矩,并输入对应的关节,控制左右后腿向下压至一定角度,控制左右前腿向上抬起一定角度,起跳时,左右前腿向前用力,左右后腿向上用力,落地时,由于地面崎岖不平,在ZMP控制算法的前提下,分别为四只腿的关节计算合适的调控控制力矩,以确保四足机器人维持稳定,完成非平地跳跃,以待下一次跳跃。四足机器人完成跳跃步态规划的过程中始终伴随着ZMP控制算法,ZMP控制算法是四足机器人完成跳跃步态规划过程的基本保障,确保四足机器人的重心始终保持在稳定的范围内,即提高四足机器人的鲁棒性。
在本说明书的描述中,参考术语“具体实施方式”的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
以上公开的本发明优选实施例只是用于帮助阐述本发明。优选实施例并没有详尽叙述所有的细节,也不限制该发明仅为所述的具体实施方式。显然,根据本说明书的内容,可作很多的修改和变化。本说明书选取并具体描述这些实施例,是为了更好地解释本发明的原理和实际应用,从而使所属技术领域技术人员能很好地理解和利用本发明。本发明仅受权利要求书及其全部范围和等效物的限制。
Claims (10)
1.一种四足机器人跳跃步态规划控制***,其特征在于:包括外部环境获取***(1)、姿态获取***(2)、运动规划决策***(3)和执行控制***(4);所述外部环境获取***(1)获取四足机器人所需跳跃的地形信息,经数据处理后输入所述运动规划决策***(3);所述姿态获取***(2)获取四足机器人当前的姿态信息,经数据处理后输入所述运动规划决策***(3);所述运动规划决策***(3)依据当前地形信息和四足机器人的姿态信息分析规划出四足机器人跳跃的运动轨迹,并传递至所述执行控制***(4);所述执行控制***(4)根据运动轨迹计算各个关节所需的控制力矩,以及进行ZMP控制算法。
2.根据权利要求1所述的一种四足机器人跳跃步态规划控制***,其特征在于,所述外部环境获取***(1)为ARM嵌入式***,通过CAN总线连接运动规划决策***(3),通过USB口连接一只迷你摄像头,通过视频处理技术和图像处理技术获取四足机器人前方跳跃区域的地形信息。
3.根据权利要求1所述的一种四足机器人跳跃步态规划控制***,其特征在于,所述姿态获取***(2)为ARM嵌入式***,通过CAN总线连接运动规划决策***(3),获取四足机器人当前的姿态信息,所述四足机器人当前的姿态信息包括:关节俯仰角度、偏航角度、控制力矩等,并设计滤波算法对姿态信息进行滤波处理。
4.根据权利要求1所述的一种四足机器人跳跃步态规划控制***,其特征在于,所述运动规划决策***(3)为工业级PC,通过串口线连接执行控制***(4),分析规划出四足机器人的跳跃步态方式,所述四足机器人的跳跃步态方式包括:平地跳跃、上坡跳跃、下坡跳跃和非平地跳跃。
5.根据权利要求4所述的一种四足机器人跳跃步态规划控制***,其特征在于,所述平地跳跃为四足机器人跳跃区域的地形特征表现为平坦无坑无障碍。
6.根据权利要求4所述的一种四足机器人跳跃步态规划控制***,其特征在于,所述上坡跳跃为四足机器人跳跃区域的地形特征表现为斜坡向上,且不超过坡度值,或者所述下坡跳跃为四足机器人跳跃区域的地形特征表现为斜坡向下,且不超过坡度值。
7.根据权利要求4所述的一种四足机器人跳跃步态规划控制***,其特征在于,所述非平地跳跃为四足机器人跳跃区域的地形特征表现为崎岖不平,包含有坑和障碍物。
8.根据权利要求4所述的一种四足机器人跳跃步态规划控制***,其特征在于,所述执行控制***(4)为工业级PC。
9.根据权利要求1所述的一种四足机器人跳跃步态规划控制***,其特征在于,所述部环境获取***(1)、姿态获取***(2)、运动规划决策***(3)和执行控制***(4)采用统一的电源管理***。
10.一种四足机器人跳跃步态规划控制方法,其特征在于,包括如下步骤:
SS00四足机器人准备跳跃;
S01外部环境获取***(1)获取四足机器人所需跳跃的地形信息,经数据处理后输入运动规划决策***(3);
SS02姿态获取***(2)获取四足机器人当前的姿态信息,经数据处理后输入运动规划决策***(3);
SS03运动规划决策***(3)依据当前地形信息和四足机器人的姿态信息分析规划出四足机器人跳跃的运动轨迹,规划出包括:平地跳跃、上坡跳跃、下坡跳跃和非平地跳跃的运动轨迹中的一种,并将规划出的运动轨迹传递至执行控制***(4);
SS04执行控制***(4)根据运动轨迹计算各个关节所需的控制力矩,并输入对应的关节,同时进行ZMP控制算法对各个关节角度进行适当调整,从而提高四足机器人的鲁棒性。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010824019.3A CN111857173A (zh) | 2020-08-17 | 2020-08-17 | 一种四足机器人跳跃步态规划控制***及其方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010824019.3A CN111857173A (zh) | 2020-08-17 | 2020-08-17 | 一种四足机器人跳跃步态规划控制***及其方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111857173A true CN111857173A (zh) | 2020-10-30 |
Family
ID=72969092
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010824019.3A Pending CN111857173A (zh) | 2020-08-17 | 2020-08-17 | 一种四足机器人跳跃步态规划控制***及其方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111857173A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112859851A (zh) * | 2021-01-08 | 2021-05-28 | 广州视源电子科技股份有限公司 | 多足机器人控制***及多足机器人 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2011067621A1 (en) * | 2009-12-04 | 2011-06-09 | Toyota Jidosha Kabushiki Kaisha | Robot control system, motion data creation apparatus and its creating method |
CN104875813A (zh) * | 2015-05-26 | 2015-09-02 | 上海大学 | 一种电驱动小型仿生四足机器人 |
CN107065867A (zh) * | 2017-03-28 | 2017-08-18 | 浙江大学 | 一种面向未知崎岖地形的四足机器人运动规划方法 |
CN108237532A (zh) * | 2016-12-23 | 2018-07-03 | 深圳光启合众科技有限公司 | 多足机器人的步态控制方法、装置和机器人 |
CN108860360A (zh) * | 2018-08-01 | 2018-11-23 | 清华大学深圳研究生院 | 一种四足机器人跳跃障碍的*** |
CN109946974A (zh) * | 2019-04-12 | 2019-06-28 | 山东大学 | 一种电驱动四足机器人的控制*** |
CN110405763A (zh) * | 2019-07-24 | 2019-11-05 | 北京理工大学 | 一种仿人机器人多关节协同爆发跳跃的规划方法 |
CN111483532A (zh) * | 2020-06-02 | 2020-08-04 | 山东大学 | 一种静步态上楼梯的四足机器人运动控制方法 |
-
2020
- 2020-08-17 CN CN202010824019.3A patent/CN111857173A/zh active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2011067621A1 (en) * | 2009-12-04 | 2011-06-09 | Toyota Jidosha Kabushiki Kaisha | Robot control system, motion data creation apparatus and its creating method |
CN104875813A (zh) * | 2015-05-26 | 2015-09-02 | 上海大学 | 一种电驱动小型仿生四足机器人 |
CN108237532A (zh) * | 2016-12-23 | 2018-07-03 | 深圳光启合众科技有限公司 | 多足机器人的步态控制方法、装置和机器人 |
CN107065867A (zh) * | 2017-03-28 | 2017-08-18 | 浙江大学 | 一种面向未知崎岖地形的四足机器人运动规划方法 |
CN108860360A (zh) * | 2018-08-01 | 2018-11-23 | 清华大学深圳研究生院 | 一种四足机器人跳跃障碍的*** |
CN109946974A (zh) * | 2019-04-12 | 2019-06-28 | 山东大学 | 一种电驱动四足机器人的控制*** |
CN110405763A (zh) * | 2019-07-24 | 2019-11-05 | 北京理工大学 | 一种仿人机器人多关节协同爆发跳跃的规划方法 |
CN111483532A (zh) * | 2020-06-02 | 2020-08-04 | 山东大学 | 一种静步态上楼梯的四足机器人运动控制方法 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112859851A (zh) * | 2021-01-08 | 2021-05-28 | 广州视源电子科技股份有限公司 | 多足机器人控制***及多足机器人 |
CN112859851B (zh) * | 2021-01-08 | 2023-02-21 | 广州视源电子科技股份有限公司 | 多足机器人控制***及多足机器人 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11654984B2 (en) | Slip detection for robotic locomotion | |
US11654569B2 (en) | Handling gait disturbances with asynchronous timing | |
US11188081B2 (en) | Auto-swing height adjustment | |
US9926025B1 (en) | Slip avoidance | |
Jenelten et al. | Perceptive locomotion in rough terrain–online foothold optimization | |
Wang et al. | Flexible motion framework of the six wheel-legged robot: Experimental results | |
Bjelonic et al. | Whole-body mpc and online gait sequence generation for wheeled-legged robots | |
US20210309310A1 (en) | Control of Robotic Devices with Non-Constant Body Pitch | |
CN112859851B (zh) | 多足机器人控制***及多足机器人 | |
CN111857173A (zh) | 一种四足机器人跳跃步态规划控制***及其方法 | |
Xu et al. | Analytical review on developing progress of the quadruped robot industry and gaits research | |
Freitas et al. | Terrain model-based anticipative control for articulated vehicles with low bandwidth actuators | |
Chen et al. | CNNs based foothold selection for energy-efficient quadruped locomotion over rough terrains | |
Yin et al. | A novel control strategy for quadruped robot walking over irregular terrain | |
Ma et al. | Trotting gait control of quadruped robot based on Trajectory Planning | |
Roennau et al. | Six-legged walking in rough terrain based on foot point planning | |
Bi et al. | Intelligent Logistics Handling Robot: Design, Control, and Recognition | |
Palmer et al. | Toward innate leg stability on unmodeled and natural terrain: Quadruped walking | |
Jimenez et al. | A four-legged walking test bed | |
Shen et al. | Cooperative control strategy of wheel-legged robot based on attitude balance | |
Law et al. | Shared control for navigation and balance of a dynamically stable robot | |
Li et al. | The development on obstacle avoidance design for a humanoid robot based on four ultrasonic sensors for the learning behavior and performance | |
CN114633826B (zh) | 一种足式机器人腿部磕碰处理的方法及足式机器人 | |
Zhu et al. | Design and Implementation of an Automated Material Handling Robot | |
Arun et al. | Arduino Quadruped Robot |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20201030 |