CN113084799A - 一种基于六次多项式的六足机器人足端轨迹规划方法 - Google Patents
一种基于六次多项式的六足机器人足端轨迹规划方法 Download PDFInfo
- Publication number
- CN113084799A CN113084799A CN202110329510.3A CN202110329510A CN113084799A CN 113084799 A CN113084799 A CN 113084799A CN 202110329510 A CN202110329510 A CN 202110329510A CN 113084799 A CN113084799 A CN 113084799A
- Authority
- CN
- China
- Prior art keywords
- stage
- foot end
- ground
- curve
- point
- 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
- 238000000034 method Methods 0.000 title claims abstract description 32
- 241000238631 Hexapoda Species 0.000 title claims abstract description 22
- 230000009193 crawling Effects 0.000 claims abstract description 21
- 230000001133 acceleration Effects 0.000 claims abstract description 19
- 239000011159 matrix material Substances 0.000 claims description 21
- 238000004364 calculation method Methods 0.000 claims description 2
- 230000005021 gait Effects 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000004891 communication Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000008021 deposition Effects 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 239000000523 sample Substances 0.000 description 1
- 239000010802 sludge Substances 0.000 description 1
- 238000012876 topography Methods 0.000 description 1
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/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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
- B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
- B62D57/032—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Manipulator (AREA)
Abstract
本发明设计一种基于六次多项式的六足机器人足端轨迹规划方法,针对六足机器人爬行特性,设计提出一种包括足端垂直与地面抬起及下落阶段、抛物线摆动阶段、平稳支撑阶段的足端轨迹曲线;并且各阶段足端轨迹曲线在机体坐标系下,足端位姿、速度、加速度时刻连续,从而保证在关节空间坐标系下,各个关节电机角度、角速度、角加速度时刻连续,使得机器人爬行过程中步态始终保持稳定、连续。本方法仅需使用者给出爬行速度、爬行周期、足底抬起高度信息,就可得到精确平滑的足底轨迹曲线减少了机器人产生侧滑的可能性,增加了机体稳定性,并且在凹凸地面处理上,程序实现较为方便。
Description
技术领域
本发明属于机器人足端轨迹规划领域,特别涉及一种基于六次多项式的六足机器人足端轨迹规划方法。
背景技术
六足机器人在结构上具有较多冗余自由度,能够适应较为复杂地形,在路况复杂的野外行走,完成履带式或轮式所不能完成的非结构性环境中的运输作业任务。在海底环境下这一点尤为明显,海底洋流、视野浑浊、通讯受限、海底地形凹凸不平、淤泥沉积等因素,使得传统履带式或轮式机器人难以胜任水下作业任务。因此对六足机器人的研究具有广阔的应用前景。
在六足机器人进行工作方法的研究中,首先根据机器人机械结构进行运动学建模,得到机械腿的逆运动学解;之后对其进行运动轨迹进行规划,得到各关节随时间变化曲线;最后控制电机旋转完成工作任务。其中对机械腿的轨迹规划是至关重要的一步,它直接影响机器人爬行的方式,影响爬行过程中的机体的稳定性、关节电机的受力情况、腿臂动作的整体能耗,进一步限制机器人的工作性能及所能适应的环境。
然而在现有技术中,六足机器人爬行过程中的轨迹规划方法都是针对特定的腿臂机械结构,无法做到通法通解,并且编程复杂,在腿臂机械结构或作业环境发生改变时,很难快速准确的更改相应算法参数。例如,当六足机器人在爬行过程中遇到地面凹陷或者凸起时,按照现有技术的轨迹规划方法,很难快速准确的更改相应算法参数,使其自主适应腿臂机械结构或作业环境发生的改变。
综上所述,对六足机器人足端进行运动轨迹规划,使六足机器人既能满足爬行任务要求,能在爬行中遇到凹凸不平路面时保持机体平稳,有着重要的实践意义。
发明内容
本发明解决的技术问题是:为了解决现有技术中六足机器人运动轨迹规划方法无法在凹凸不平路面时保持机体平稳且可能会对腿部足端进行损坏的缺陷,本发明设计一种基于六次多项式的六足机器人足端轨迹规划方法。
本发明的技术方案是:一种基于六次多项式的六足机器人足端轨迹规划方法,包括以下步骤:
步骤1:在机体坐标系下,将六足机器人单腿足端的运动轨迹分为:足端垂直与地面抬起阶段、抛物线摆动阶段、足端垂直与地面下落阶段和平稳支撑阶段四个阶段,其中足端垂直与地面抬起阶段和足端垂直与地面下落阶段的运动轨迹控制方法相同,同时定义AB段为足端垂直与地面抬起阶段,BCD段为抛物线摆动阶段,C为抛物线最高点;DE阶段为足端垂直与地面下落阶段,EA阶段为平稳支撑阶段;
步骤2:采用六次多项式,建立几个阶段的轨迹曲线,包括以下步骤:
步骤2.3:根据步骤2.1和步骤2.2的多项式得到足端在某一时刻的某一方向的位置、速度及加速度的约束条件:
进一步得到Ai和Bi矩阵:
Bi=[Ei(ti)…Vi(ti)…ai(ti)]T
步骤2.4:确定A、B、C、D、E五个点具体参数,包括以下内容:
速度参数表达式:
加速度参数表达式:
时间参数表达式:
其中,S为步幅,T为爬行周期,X0为初始侧向位置,Z0为触底垂向位置,H_max为最大抬起高度,H_tir为垂直抬起高度,T_tir为垂直抬起时间,VBz为B点z轴方向速度,VCy为C点y轴方向速度,aBz为B点z轴方向加速度,aCy为C点y轴方向加速度,aCz为C点z轴方向加速度,aDz为D点z轴方向加速度;
步骤2.5:将步骤2.4中的各个表达式代入Ai和Bi矩阵,得到各个阶段的变化曲线的参数矩阵,其中:
足端垂直与地面抬起阶段和足端垂直与地面下落阶段的z轴变化曲线的参数矩阵为:
B1=[Z0 H_tir H_max Z0 0 0 0]T
抛物线摆动阶段y轴变化曲线的参数矩阵:
抛物线摆动阶段z轴变化曲线:
抛物线摆动阶段z轴变化曲线的参数矩阵与足端垂直与地面抬起阶段和足端垂直与地面下落阶段的z轴变化曲线的参数矩阵相同。
平稳支撑阶段y轴变化曲线的参数矩阵:
步骤3:通过步骤2得到ABCDE五个点的变化曲线的参数矩阵,根据公式ci'=Ai'Bi计算ci',最终得到六足机器人足端的运动轨迹。
发明效果
本发明的技术效果在于:
(1)提供了一种较为通用的六足机器人足端轨迹规划算法,仅需使用者给出爬行速度、爬行周期、足底抬起高度信息,就可得到精确平滑的足底轨迹曲线。
(2)将运动过程分为四个阶段,利于分时段改变算法参数,提高算法灵活性,使其适应多种地形。
(3)由于垂直落地的存在,减少了机器人产生侧滑的可能性,增加了机体稳定性,并且在凹凸地面处理上,程序实现较为方便。
(4)以六次方程作为轨迹曲线,减少了足底坐标运算的复杂度,提高了工程实现的实时性,且易于根据腿臂机械结构和作业环境的改变而修改。
附图说明
图1为本发明提出的机体坐标系下单腿足端空间运动轨迹示意图
图2为单纯抛物线突起地面足端空间运动轨迹示意图
图3为单纯抛物线凹陷地面足端空间运动轨迹示意图
具体实施方式
在本发明的描述中,需要理解的是,术语“中心”、“纵向”、“横向”、“长度”、“宽度”、“厚度”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”、“顺时针”、“逆时针”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。
参见图1-图3,本发明目的是提供一种,满足爬行任务要求,包括爬行过程中机体平稳、爬行速度、平稳踏过凹凸不平路面等;又满足工程实现的通用六足机器人轨迹规划算法。
如图1所示为机体坐标系O-XYZ下,一个周期内单腿足端空间运动轨迹示意图。前进爬行一步动作过程分为足端垂直与地面抬起阶段、抛物线摆动阶段、足端垂直与地面下落阶段、平稳支撑阶段。各个过程设计不同的六次方程,由同一计时器按照同一周期进行曲线插补,解算出的笛卡尔系下坐标再由运动学逆解解算出具体各关节电机角度,进而完成爬行动作。具体过程介绍如下:
第一步:足端垂直与地面抬起、下落阶段
若摆动相采用单纯抛物线方式,当遇到地面突起或地面凹陷,如图2、图3所示,在大地坐标系O’-X’Y’Z’下就会出现Y轴方向的偏移dY和相对于地面的夹角。即在足底产生水平于Y轴的力,造成机体不稳且损伤足底力觉传感器;又对编程实现造成困难。
此阶段为实现平稳踏过凹凸不平路面,提供条件。在腿臂下落过程中,根据足端力觉传感器可实时判断是否提前落地(凸出地面,规划z轴方向停止运动,记录此时z轴方向坐标z_stop,y轴方向继续运动,进入支撑阶段,保证支撑过程继续平稳进行;之后进入垂直抬起阶段,z轴方向坐标继续保持在z_stop,直到由垂直抬起阶段的六次方程计算出的z轴方向坐标大于等于z_stop,继续执行六次方程规划的曲线)或未能落地(凹陷地面,规划y轴方向停止运动,记录此时计时器时刻t_hang,z轴方向继续向下探底,直到足端完全触地,并保持在此z轴方向坐标,进入支撑阶段,y轴方向继续运动,之后进入垂直抬起阶段;垂直抬起至规划的地面高度,继续执行六次方程规划的曲线)。
第二步:抛物线摆动阶段
此阶段为腿臂向机体前方(y轴正方向)摆动,足端在平行与ZOY的平面内做抛物线运动,该腿在机体坐标系下的z轴方向、y轴方向坐标同时发生变化。
在此阶段六次方程规划中,确定了足底的最大抬起高度、跨越的长度、运动的时间,从而确定了爬行的速度。
第三步:平稳支撑阶段
此阶段为腿臂向机体后方(y轴后方向)移动,将机体向前推动,足端在平行与y轴线段上做先加速后减速直线运动,该腿在机体坐标系下仅在z轴y轴方向坐标发生变化。
各阶段运动轨迹算法:
各阶段足端的运动轨迹,即在机体坐标系下,某一时刻足端经过某一规定的点,并且在处于这一规定点时,满足规定的速度和加速度约束条件。
本发明采用六次多项式作为轨迹曲线,数学表达为:
则足端速度的多项式表达为:
足端加速度的多项式表达为:
其中E(t)表示足端点E在t时刻的位置矩阵,E(t)=[xE(t) yE(t) zE(t)]T;v(t)表示足端点E在t时刻的速度矩阵,v(t)=[vxE(t) vyE(t) vzE(t)]T;a(t)表示足端点E在t时刻的位置矩阵,a(t)=[axE(t) ayE(t) azE(t)]T;ci表示时间t的多项式系数矩阵,ci=[cix ciyciz]T。
各方向分量展开式为:
由此得到某一时刻某一方向的三个对应的约束条件。对于六次多项而言,仅需确定七个非线性相关的方程,即可确定唯一的一组:
ci'=[c0' c1' c2' c3' c4' c5' c6']T (5)
整理为矩阵得到:
Aici'=Bi (6)
ci'=Ai'Bi (7)
其中:
Bi=[Ei(ti)…Vi(ti)…ai(ti)]T (8)
根据预先设计的轨迹规划示意,首先,确定轨迹规划的各项参数,步幅(S)、爬行周期(T)、初始侧向位置(X0)、触地垂向位置(Z0)、最大抬起高度(H_max)、垂直抬起高度(H_tir)、垂直抬起时间(T_tir)。其次,确定在各阶段各关键位置的坐标,以及相对应的时刻。在本发明中,需确定起始点A(t0)、垂直抬起终点B(t1)、抬起顶点C(t2)、垂直下落起点D(t3)、垂直下落终点E(t4),五个点的时间、位置、速度及加速度。
其中:
将确定的参数带入六次多项式得到各阶段具体Ai、Bi矩阵分别如下:
垂直抬起、抛物线摆动、垂直落下z轴变化曲线:
B1=[Z0 H_tir H_max Z0 0 0 0]T (14)
抛物线摆动y轴变化曲线:
平稳支撑y轴变化曲线:
Claims (1)
1.一种基于六次多项式的六足机器人足端轨迹规划方法,其特征在于,包括以下步骤:
步骤1:在机体坐标系下,将六足机器人单腿足端的运动轨迹分为:足端垂直与地面抬起阶段、抛物线摆动阶段、足端垂直与地面下落阶段和平稳支撑阶段四个阶段,其中足端垂直与地面抬起阶段和足端垂直与地面下落阶段的运动轨迹控制方法相同,同时定义AB段为足端垂直与地面抬起阶段,BCD段为抛物线摆动阶段,C为抛物线最高点;DE阶段为足端垂直与地面下落阶段,EA阶段为平稳支撑阶段;
步骤2:采用六次多项式,建立几个阶段的轨迹曲线,包括以下步骤:
步骤2.3:根据步骤2.1和步骤2.2的多项式得到足端在某一时刻的某一方向的位置、速度及加速度的约束条件:
进一步得到Ai和Bi矩阵:
Bi=[Ei(ti) … Vi(ti) … ai(ti)]T
步骤2.4:确定A、B、C、D、E五个点具体参数,包括以下内容:
速度参数表达式:
加速度参数表达式:
时间参数表达式:
其中,S为步幅,T为爬行周期,X0为初始侧向位置,Z0为触底垂向位置,H_max为最大抬起高度,H_tir为垂直抬起高度,T_tir为垂直抬起时间,VBz为B点z轴方向速度,VCy为C点y轴方向速度,aBz为B点z轴方向加速度,aCy为C点y轴方向加速度,aCz为C点z轴方向加速度,aDz为D点z轴方向加速度;
步骤2.5:将步骤2.4中的各个表达式代入Ai和Bi矩阵,得到各个阶段的变化曲线的参数矩阵,其中:
足端垂直与地面抬起阶段和足端垂直与地面下落阶段的z轴变化曲线的参数矩阵为:
B1=[Z0 H_tir H_max Z0 0 0 0]T
抛物线摆动阶段y轴变化曲线的参数矩阵:
抛物线摆动阶段z轴变化曲线:
抛物线摆动阶段z轴变化曲线的参数矩阵与足端垂直与地面抬起阶段和足端垂直与地面下落阶段的z轴变化曲线的参数矩阵相同。
平稳支撑阶段y轴变化曲线的参数矩阵:
步骤3:通过步骤2得到ABCDE五个点的变化曲线的参数矩阵,根据公式ci'=Ai'Bi计算ci',最终得到六足机器人足端的运动轨迹。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110329510.3A CN113084799B (zh) | 2021-03-28 | 2021-03-28 | 一种基于六次多项式的六足机器人足端轨迹规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110329510.3A CN113084799B (zh) | 2021-03-28 | 2021-03-28 | 一种基于六次多项式的六足机器人足端轨迹规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113084799A true CN113084799A (zh) | 2021-07-09 |
CN113084799B CN113084799B (zh) | 2022-07-26 |
Family
ID=76670461
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110329510.3A Expired - Fee Related CN113084799B (zh) | 2021-03-28 | 2021-03-28 | 一种基于六次多项式的六足机器人足端轨迹规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113084799B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104192221A (zh) * | 2014-09-26 | 2014-12-10 | 哈尔滨工业大学 | 一种电驱动六足机器人运动控制***及方法 |
WO2018133439A1 (zh) * | 2017-01-19 | 2018-07-26 | 北京工业大学 | 一种考虑末端运动误差的六自由度机器人轨迹规划方法 |
CN108592920A (zh) * | 2018-04-28 | 2018-09-28 | 上海木木机器人技术有限公司 | 一种机器人的路径规划方法及*** |
CN109202901A (zh) * | 2018-08-29 | 2019-01-15 | 厦门理工学院 | 一种双足机器人爬楼梯步态规划方法、装置及机器人 |
CN109807901A (zh) * | 2019-03-30 | 2019-05-28 | 华南理工大学 | 一种六足机器人及其足端轨迹的规划方法 |
CN109960880A (zh) * | 2019-03-26 | 2019-07-02 | 上海交通大学 | 一种基于机器学习的工业机器人避障路径规划方法 |
CN110371213A (zh) * | 2019-07-12 | 2019-10-25 | 沈阳城市学院 | 一种双足机器人步行规划和控制方法 |
CN112405519A (zh) * | 2019-08-23 | 2021-02-26 | 贵州大学 | 上下料机器人运动轨迹规划方法 |
-
2021
- 2021-03-28 CN CN202110329510.3A patent/CN113084799B/zh not_active Expired - Fee Related
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104192221A (zh) * | 2014-09-26 | 2014-12-10 | 哈尔滨工业大学 | 一种电驱动六足机器人运动控制***及方法 |
WO2018133439A1 (zh) * | 2017-01-19 | 2018-07-26 | 北京工业大学 | 一种考虑末端运动误差的六自由度机器人轨迹规划方法 |
CN108592920A (zh) * | 2018-04-28 | 2018-09-28 | 上海木木机器人技术有限公司 | 一种机器人的路径规划方法及*** |
CN109202901A (zh) * | 2018-08-29 | 2019-01-15 | 厦门理工学院 | 一种双足机器人爬楼梯步态规划方法、装置及机器人 |
CN109960880A (zh) * | 2019-03-26 | 2019-07-02 | 上海交通大学 | 一种基于机器学习的工业机器人避障路径规划方法 |
CN109807901A (zh) * | 2019-03-30 | 2019-05-28 | 华南理工大学 | 一种六足机器人及其足端轨迹的规划方法 |
CN110371213A (zh) * | 2019-07-12 | 2019-10-25 | 沈阳城市学院 | 一种双足机器人步行规划和控制方法 |
CN112405519A (zh) * | 2019-08-23 | 2021-02-26 | 贵州大学 | 上下料机器人运动轨迹规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113084799B (zh) | 2022-07-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110315543B (zh) | 一种双足机器人步态生成与优化方法 | |
CN108333931B (zh) | 一种面向崎岖地形的四足机器人双层结构步态规划方法 | |
US7805218B2 (en) | Robot device and control method of robot device | |
US7053577B2 (en) | Robot and motion control method of robot | |
US7400939B2 (en) | Robot device, motion control device for robot device and motion control method | |
WO2017092463A1 (zh) | 一种双足机器人的步态控制方法和装置 | |
JPWO2003011535A1 (ja) | 脚式移動ロボット及びその動作制御方法 | |
US20080147237A1 (en) | Gait Generator for Mobile Robot | |
Buschmann et al. | Experiments in fast biped walking | |
CN108724191A (zh) | 一种机器人运动轨迹控制方法 | |
CN115793683A (zh) | 一种重心控制方法、调整机构及足式机器人 | |
CN112744306A (zh) | 一种基于运动学的四足爬壁机器人转身步态控制方法 | |
CN106842959A (zh) | 一种Nao机器人步态规划遗传算法 | |
CN113830197B (zh) | 一种应用于双足机器人动态行走的平衡控制方法 | |
JP2004142095A (ja) | ロボット装置及びロボット装置の制御方法 | |
CN113843799A (zh) | 一种四足机器人姿态复位控制方法、装置及存储介质 | |
KR100889481B1 (ko) | 이족 로봇의 계단 보행 방법 | |
CN113084799B (zh) | 一种基于六次多项式的六足机器人足端轨迹规划方法 | |
JP5198035B2 (ja) | 脚式ロボット及びその制御方法 | |
JP4905041B2 (ja) | ロボット制御装置 | |
WO2022153843A1 (ja) | 移動装置、および移動装置制御方法 | |
CN108717267B (zh) | 一种六足机器人中枢模式逆向控制方法 | |
Kim et al. | A model predictive capture point control framework for robust humanoid balancing via ankle, hip, and stepping strategies | |
JP2010253655A (ja) | 脚式ロボットとその制御方法 | |
Yu et al. | Gait planning for biped robot based on variable center-of-mass height hybrid strategy |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20220726 |
|
CF01 | Termination of patent right due to non-payment of annual fee |