CN106773680B - 降低液压机器人流量的足端轨迹优化方法 - Google Patents
降低液压机器人流量的足端轨迹优化方法 Download PDFInfo
- Publication number
- CN106773680B CN106773680B CN201611088178.1A CN201611088178A CN106773680B CN 106773680 B CN106773680 B CN 106773680B CN 201611088178 A CN201611088178 A CN 201611088178A CN 106773680 B CN106773680 B CN 106773680B
- Authority
- CN
- China
- Prior art keywords
- foot end
- hydraulic
- robot
- flow
- nonlinear transformation
- 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 30
- 238000005457 optimization Methods 0.000 title claims abstract description 30
- 230000009466 transformation Effects 0.000 claims abstract description 41
- 238000012937 correction Methods 0.000 claims abstract description 8
- 230000005021 gait Effects 0.000 claims abstract description 8
- 238000006073 displacement reaction Methods 0.000 claims description 8
- 230000008569 process Effects 0.000 claims description 7
- 230000004044 response Effects 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 5
- 238000012886 linear function Methods 0.000 claims description 3
- 238000013461 design Methods 0.000 abstract description 2
- 210000001364 upper extremity Anatomy 0.000 description 9
- 210000002414 leg Anatomy 0.000 description 7
- 230000008859 change Effects 0.000 description 5
- 238000004458 analytical method Methods 0.000 description 2
- 239000002131 composite material Substances 0.000 description 2
- 230000007423 decrease Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 210000000689 upper leg Anatomy 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 125000004432 carbon atom Chemical group C* 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 229910052739 hydrogen Inorganic materials 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种降低液压机器人流量的足端轨迹优化方法,属于机器人设计与控制领域。首先,确定液压机器人的足端轨迹,并分析足端轨迹各运动分量方向上的位移‑时间、速度‑时间、腿部及系统流量‑时间,得出关系曲线;其次,构造非线性变换函数;最后,用非线性变换函数对液压机器人足端轨迹各运动分量进行非线性变换并修正,得到流量优化后的足端轨迹。发明优化方法的本质是对液压机器人摆动相的摆腿速度进行优化,其对支撑相无需作任何变换,不论机器人采用那种足端轨迹行走,对任何尚待优化的液压系统皆可采用该方法对其足端轨迹进行变换,达到优化系统流量的目的,其适用范围广,不受液压机器人足端轨迹限制,不影响步态参数。
Description
技术领域
本发明涉及一种机器人足端轨迹优化方法,具体讲是一种降低液压机器人流量的足端轨迹优化方法,属于机器人设计与控制领域。
背景技术
液压机器人具有较高的运动速度、较大的负载能力和超强的机动性能,在军事、搜救、探测等领域有巨大的发展潜力和广阔的应用前景。液压机器人的动力系统通常是由汽油机和柱塞泵组成的独立单泵源,由于受重量和体积的限制,动力系统功率受到限制,这严重制约了机器人的运动性能和负载能力。其次,液压足式机器人通常采用单泵源多执行器液压系统,这种液压系统能效较低,采用这种系统的挖掘机的能效仅为40%,与挖掘机相比,液压机器人的执行器更多,动态性能要求更高,各执行器瞬时速度和力的差异性更大,其液压系统能效会更低,减小动力系统重量与体积或提高功率效率对提高液压机器人运动性能与负载能力具有十分重要的意义,流量作为影响液压系统功率的重要参数,其优化问题是提高液压机器人运动性能的关键技术之一。
目前液压机器人的研究重点主要体现在两个方面:硬件优化和步态规划。硬件优化由于受技术影响,在实际应用中受到了限制。步态规划的相关研究主要体现为对足端轨迹参数进行优化,通过改变足端轨迹参数固然可以降低液压机器人的系统流量,但是,足端轨迹参数改变的同时也会影响机器人运动性能。例如,降低抬腿高度会降低机器人的越障性能,步长和步频的改变可能会降低机器人的行走速度。
发明内容
本发明所要解决的技术问题在于克服现有技术缺陷,提供一种不受足端轨迹限制,对机器人运动性能无影响的降低液压机器人流量的足端轨迹优化方法。
为了解决上述技术问题,本发明提供的降低液压机器人流量的足端轨迹优化方法,包括以下步骤:
1)、确定液压机器人的足端轨迹u=[Px(t)Py(t)Pz(t)]T,并分析足端轨迹各运动分量方向上的位移-时间、速度-时间、腿部及系统流量-时间,得出关系曲线;所述Px、Py、Pz为液压机器人的足端坐标,t为行走过程的任意时刻;
2)、构造非线性变换函数f(t);
3)、用步骤2)得到的非线性变换函数f(t)对步骤1)液压机器人足端轨迹各运动分量进行非线性变换,并修正非线性变换函数的相关参数,得到流量优化后的足端轨迹u=[Px[f(t)]Py[f(t)]Pz[f(t)]]T。
本发明中,所述步骤1)中:
式中,Px为液压机器人的足端相对足端起始位置在前进方向的位移,Pz为液压机器人的足端相对足端起始位置在竖直方向的位移;S为液压机器人行走的步长,H为液压机器人行走的抬腿高度,Tsw为摆动相时间,T为步态周期,t为行走过程的任意时刻。
本发明中,所述步骤2)的具体过程如下:
确定非线性变换函数的定义域为[0,0.4],构造非线性变换函数:
上述非线性变换函数中,当t∈[tmin,tmax]时,f(t)∈[tmin,tmax];当t1≥t2时,都有f(t1)≥f(t2);t1、t2为t的不同时刻,t1>t2表示t1时刻在t2时刻之后;非线性变换函数在定义域内要求可导,如果非线性变换前的足端轨迹Px或Pz在t1和t2处的导数值不为零,则要求非线性函数f(t)在t1和t2处的导数值为1。
本发明中,所述a=0.1或0.01。
本发明中,所述步骤3)中修正非线性变换函数的相关参数的依据是使机器人液压系统流量减小的同时,保证修正后理论计算得到的液压缸响应速度小于修正前理论计算得到的液压缸响应速度。
本发明的有益效果在于:(1)、本发明优化方法的本质是对液压机器人摆动相的摆腿速度进行优化,其对支撑相无需作任何变换,不论机器人采用那种足端轨迹行走,对任何尚待优化的液压系统皆可采用该方法对其足端轨迹进行变换,达到优化系统流量的目的,其适用范围广,不受液压机器人足端轨迹限制,不影响步态参数;(2)、本发明可选择进行局部优化,且无需改造硬件平台,可以兼顾机器人实际情况(如响应频率,响应速度等)灵活选择合适的优化参数,其运算量小,并且无需对硬件作任何改造,更易于在实际系统中实现。
附图说明
图1为本发明中液压四足机器人机构模型示意图;
图2为复合摆线足端轨迹;
图3为非线性变换函数中参数a=0.1和a=0.01时的函数图像;
图4为非线性变换对流量的优化效果对比图;其中,(a)为优化前的数据,(b)为非线性变换函数中参数a=0.1时的数据,(c)为非线性变换函数中参数a=0.01时的数据;(a)、(b)、(c)中按从上至下的顺序,依次为足端轨迹位移-时间曲线、足端轨迹速度-时间曲线、右前腿及其各液压缸流量-时间曲线、机器人系统流量-时间曲线;图中,x和z分别图1中的x和z轴方向,RF代表右前腿的总流量,RF C2代表驱动大腿绕机身前后摆动的液压缸流量,RF C3代表驱动小腿绕大腿前后摆动的液压缸流量;
图5为液压四足机器人优化前后的系统流量对比图。
具体实施方式
为了更好的理解本发明,下面以液压四足机器人为载体,用复合摆线足端轨迹为优化实例,对本发明的技术方案作进一步详细说明。
本发明的降低液压机器人流量的足端轨迹优化方法的具体步骤如下:
步骤1:为液压四足机器人选择符合运动学要求的足端轨迹u=[Px(t)Py(t)Pz(t)]T:
如图1所示,液压四足机器人在非理想路面行走或者在不稳定状态时,经常需要实时调整足端位置(Px、Py、Pz),进而逐步恢复机体稳定。然而在理想路面直线行走时,只需改变足端在x轴和z轴方向上的位置,即(Px、Pz),并结合适当的步态规划,液压四足机器人即能实现直线行走。为使模型易于分析,可忽略液压四足机器人足端在y轴方向上的运动,即保持Py为常值,因而四足机器人足端轨迹的分析被简化为二维平面的问题,足端轨迹便可仅用Px和Py来表达。上式中Px、Py、Pz为示附图1中X、Y、Z坐标轴所指方向的位移,Px为液压四足机器人的足端相对足端起始位置在前进方向的位移,Pz为液压四足机器人的足端相对足端起始位置在竖直方向的位移;S为液压四足机器人行走的步长,H分别为液压四足机器人行走的抬腿高度,Tsw为摆动相时间,T为步态周期,t为行走过程的任意时刻,确定S、H、T和Tsw四个参数(本实施例中取值为S=150mm,H=100mm,T=1s,Tsw=0.4s)便可确定液压四足机器人的足端轨迹,其函数图像如图2所示。根据足端轨迹及液压四足机器人的腿部尺寸,可以找出流量最大时对应的时刻以及该时刻足端轨迹的位移和速度,从而找到足端轨迹的速度调整趋势。分析足端轨迹各运动分量方向上的位移-时间、速度-时间、腿部及系统流量-时间,画出上述关系曲线,如图4(a)所示。
由于右前腿及其各液压缸在摆动相(0≤t≤0.4)中所需流量较大,支撑相(0.4≤t≤1)所需流量较小,所以流量优化主要应该针对摆动相;对比图4(a)中足端轨迹速度-时间曲线和前腿及其各液压缸流量-时间曲线容易发现,右前腿及其各液压缸的流量变化与足端轨迹在z方向的速度变化趋势较为相似;并且,在一个周期中两个流量峰值与足端轨迹在z方向的速度峰值出现的时刻基本一致,这说明右前腿及其各液压缸的流量变化主要受足端轨迹在z方向的速度影响。据此,为达到降低最大流量的目的,应该适当减小足端轨迹的z方向上的第二个速度峰值,即降低足端由轨迹最高点向下运动至地面过程中的最大速度。
步骤2:构造合适的非线性变换函数f(t)。本实施例中以指数函数为例来说明如何用非线性优化方法优化流量。
根据步骤1的分析,首先确定非线性变换函数的定义域为[0,0.4]。
其次,要适当减小足端轨迹在z方向上的第二个速度峰值,应该适当减少足端从离地抬腿至最高位置的时间而增加足端从最高点下降至地面的时间,根据上述条件,将指数函数按上述要求截取、翻转和缩放平移后便构造一个非线性变换函数如下:
上式中,f(t)是变量t的函数,a为参数。
上式中,当t∈[tmin,tmax]时,f(t)∈[tmin,tmax]。即非线性函数f(t)的定义域和值域相同,这保证了非线性变换前后足端轨迹时域范围不发生改变。
上式中,当t1≥t2时,都有f(t1)≥f(t2);t1>t2分别代表步骤1足端轨迹表达式中t的不同时刻,t1>t2表示t1时刻在t2时刻之后。。即非线性函数f(t)在定义域内单调非减,这保证了非线性变换前后足端轨迹上的点在时序上不发生改变;
上述非线性变换函数在定义域内要求可导,如果非线性变换前的足端轨迹Px或Pz在t1和t2处的导数值不为零,则还要求非线性函数f(t)在t1和t2处的导数值为1。这保证了非线性变换前后足端轨迹在临界点处的速度连续。
参数a=0.1和a=0.01时,f(t)的函数图像如图3所示,可以看出,同一时刻f(t)的取值随a减小而减小,所以a的取值决定非线性变换对足端轨迹速度的调整幅度,通过比a取不同值时所对应的机器人系统流量,从中选择出最优流量所对应的a值。
步骤3:用步骤2得构造非线性变换函数对液压四足机器人的足端轨迹进行非线性变换,并通过调整非线性变换函数的相关参数(即本实施例中的a),得到流量优化后的足端轨迹。具体到本例,将步骤2得到的非线性函数代入步骤1的原足端轨迹,便可得到非线性变换后的足端轨迹如下u=[Px[f(t)]Py[f(t)]Pz[f(t)]]T:
需要说明的是,本实施例中为了消除足端轨迹其他参数(抬腿高度、步频、步长等)对流量的影响,应对足端轨迹各分量进行相同的变换,以保证非线性变换前后足端轨迹的空间形状不发生变化。液压四足机器人在实际行走过程中对摆动相的空间轨迹并没有严格的要求,只需对足端轨迹的某一分量进行非线性优化即可。
在对非线性变换函数的相关参数进行修正时,其修正依据是使液压四足机器人液压系统流量减小,但同时要保证修正后理论计算得到的液压缸响应速度小于修正前的液压缸响应速度。
当非线性函数中参数a的取值分别为0.1、0.01时,与之对应的足端轨迹各分量的足端轨迹位移-时间曲线、足端轨迹速度-时间曲线、右前腿及其各液压缸流量-时间曲线、机器人系统流量-时间曲线如图4(b)、(c)所示。从图4各组结果对比可以清楚地看出,当参数a的值取0.01时系统流量较小,因此选为优化结果。
如图5所示,液压四足机器人采用复合摆线行走时,采用本发明提出的优化方法,对比优化前后的系统流量可以看出本发明提出的优化方法可以有效降低液压机器人系统流量,实现本发明目的。
以上所述为本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下还可以做出若干改进,这些改进也应视为本发明的保护范围。
Claims (4)
1.一种降低液压机器人流量的足端轨迹优化方法,其特征在于包括以下步骤:
1)、确定液压机器人的足端轨迹u=[Px(t) Py(t) Pz(t)]T,并分析足端轨迹各运动分量方向上的位移-时间、速度-时间、腿部及系统流量-时间,得出关系曲线;所述Px、Py、Pz为液压机器人的足端坐标,t为行走过程的任意时刻;
式中,Px为液压机器人的足端相对足端起始位置在前进方向的位移,Pz为液压机器人的足端相对足端起始位置在竖直方向的位移;S为液压机器人行走的步长,H为液压机器人行走的抬腿高度,Tsw为摆动相时间,T为步态周期,t为行走过程的任意时刻;
2)、构造非线性变换函数f(t);
3)、用步骤2)得到的非线性变换函数f(t)对步骤1)液压机器人足端轨迹各运动分量进行非线性变换并修正,得到流量优化后的足端轨迹u=[Px[f(t)] Py[f(t)] Pz[f(t)]]T。
3.根据权利要求2所述的降低液压机器人流量的足端轨迹优化方法,其特征在于所述:a=0.1或0.01。
4.根据权利要求3所述的降低液压机器人流量的足端轨迹优化方法,其特征在于所述步骤3)中修正非线性变换函数的相关参数的依据是使机器人液压系统流量减小的同时,保证修正后理论计算得到的液压缸响应速度小于修正前理论计算得到的液压缸响应速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611088178.1A CN106773680B (zh) | 2016-12-01 | 2016-12-01 | 降低液压机器人流量的足端轨迹优化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611088178.1A CN106773680B (zh) | 2016-12-01 | 2016-12-01 | 降低液压机器人流量的足端轨迹优化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106773680A CN106773680A (zh) | 2017-05-31 |
CN106773680B true CN106773680B (zh) | 2020-01-21 |
Family
ID=58915174
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611088178.1A Active CN106773680B (zh) | 2016-12-01 | 2016-12-01 | 降低液压机器人流量的足端轨迹优化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106773680B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112035965B (zh) * | 2020-05-28 | 2023-04-07 | 西南石油大学 | 一种足式机器人腿部机构尺寸优化方法 |
CN114888802B (zh) * | 2022-05-16 | 2023-08-08 | 军事科学院系统工程研究院卫勤保障技术研究所 | 一种用于并联机器人恒平控制的数据处理方法及装置 |
CN115981346B (zh) * | 2023-03-20 | 2024-06-07 | 深圳鹏行智能研究有限公司 | 机器人控制方法以及机器人 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103279113A (zh) * | 2013-06-27 | 2013-09-04 | 山东大学 | 一种分布式液压四足机器人控制系统及控制方法 |
CN103941582A (zh) * | 2014-03-25 | 2014-07-23 | 中国人民解放军国防科学技术大学 | 液压驱动型仿生单腿双环控制方法 |
CN104527830A (zh) * | 2014-11-12 | 2015-04-22 | 哈尔滨工业大学 | 降低液压驱动六足机器人功率和流量消耗的运动规划方法 |
-
2016
- 2016-12-01 CN CN201611088178.1A patent/CN106773680B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103279113A (zh) * | 2013-06-27 | 2013-09-04 | 山东大学 | 一种分布式液压四足机器人控制系统及控制方法 |
CN103941582A (zh) * | 2014-03-25 | 2014-07-23 | 中国人民解放军国防科学技术大学 | 液压驱动型仿生单腿双环控制方法 |
CN104527830A (zh) * | 2014-11-12 | 2015-04-22 | 哈尔滨工业大学 | 降低液压驱动六足机器人功率和流量消耗的运动规划方法 |
Non-Patent Citations (5)
Title |
---|
四足仿生机器人液压驱动单元轨迹灵敏度分析;孔祥东等;《机械工程学报》;20130731;第49卷(第14期);第170-175页 * |
四足机器人运动控制技术研究与实现;那奇;《信息科技辑》;20160315;第I140-92页 * |
基于ADAMS的液压驱动四足机器人步态规划与仿真;庄明等;《机械设计与制造》;20120731;第100-102页 * |
液压四足机器人的步态规划研究;杨超峰;《信息科技辑》;20150715;第I140-286页 * |
电液驱动六足机器人三维空间力学分析;程乾等;《机械传动》;20150131;第39卷(第1期);第43-47页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106773680A (zh) | 2017-05-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106773680B (zh) | 降低液压机器人流量的足端轨迹优化方法 | |
CN107045552B (zh) | 一种基于正弦对角步态与快速查表法的四足机器人运动控制方法及控制装置 | |
CN111913490B (zh) | 基于落足调整的四足机器人动步态稳定控制方法及系统 | |
CN111857170B (zh) | 一种四足机器人腿部关节负载规律分析方法 | |
CN105608309B (zh) | 一种双足机器人步行规划和控制方法 | |
CN103149933B (zh) | 基于闭环控制的仿人机器人全向行走方法 | |
Feng et al. | Parameters identification and trajectory control for a hydraulic system | |
WO2015109976A1 (zh) | 一种混凝土泵车及臂架控制方法与控制装置 | |
CN103197562A (zh) | 转台伺服系统神经网络控制方法 | |
CN113830197B (zh) | 一种应用于双足机器人动态行走的平衡控制方法 | |
CN102323818A (zh) | 一种仿人机器人斜坡步行模式的在线生成的方法 | |
CN111891249B (zh) | 一种液压六足机器人及基于质心起伏的行走步态控制方法 | |
Dong et al. | On-line gait adjustment for humanoid robot robust walking based on divergence component of motion | |
Lipeng et al. | Research on gait switching control of quadruped robot based on dynamic and static combination | |
CN108614421B (zh) | 一种基于中枢模式发生器的四足机器人运动控制方法 | |
CN112256028B (zh) | 一种双足机器人柔顺步态控制方法、系统、设备及介质 | |
CN104570732A (zh) | 一种仿人机器人步行模式的在线生成方法 | |
Naksuk et al. | Humanoid trajectory generation: an iterative approach based on movement and angular momentum criteria | |
CN203064736U (zh) | 大型工件滑移运输的行进方向调整装置 | |
Du et al. | Energy consumption analysis in multi-legged robots based on gait planning | |
Li et al. | A Method of Foot Trajectory Generation for Quadruped Robots in Swing Phase to Optimize the Joint Torque | |
CN112925205B (zh) | 一种双足机器人步态模式生成的布网优化方法 | |
CN116339364A (zh) | 一种双足机器人步态规划方法及双足机器人 | |
EP4378637A1 (en) | Motion control method and apparatus, and readable storage medium | |
CN116880291A (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 | ||
TR01 | Transfer of patent right |
Effective date of registration: 20220328 Address after: 210000 No. 5, Qilidian Road, Honglan Town, Lishui District, Nanjing, Jiangsu Province Patentee after: NANJING HAOKUN AUTOMATION TECHNOLOGY Co.,Ltd. Address before: No. 29, Qinhuai District, Qinhuai District, Nanjing, Jiangsu Patentee before: Nanjing University of Aeronautics and Astronautics |
|
TR01 | Transfer of patent right |