CN111913490B - 基于落足调整的四足机器人动步态稳定控制方法及系统 - Google Patents
基于落足调整的四足机器人动步态稳定控制方法及系统 Download PDFInfo
- Publication number
- CN111913490B CN111913490B CN202010831977.3A CN202010831977A CN111913490B CN 111913490 B CN111913490 B CN 111913490B CN 202010831977 A CN202010831977 A CN 202010831977A CN 111913490 B CN111913490 B CN 111913490B
- Authority
- CN
- China
- Prior art keywords
- foot
- robot
- trunk
- leg
- coordinate system
- 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 58
- 230000005021 gait Effects 0.000 title claims abstract description 50
- 210000002414 leg Anatomy 0.000 claims abstract description 92
- 210000002683 foot Anatomy 0.000 claims abstract description 49
- 230000005484 gravity Effects 0.000 claims abstract description 40
- 210000004394 hip joint Anatomy 0.000 claims abstract description 36
- 206010034701 Peroneal nerve palsy Diseases 0.000 claims abstract description 27
- 238000005096 rolling process Methods 0.000 claims abstract description 15
- 210000001364 upper extremity Anatomy 0.000 claims description 23
- 230000015654 memory Effects 0.000 claims description 22
- 238000004590 computer program Methods 0.000 claims description 11
- 210000002310 elbow joint Anatomy 0.000 claims description 10
- 238000004364 calculation method Methods 0.000 claims description 9
- 210000003857 wrist joint Anatomy 0.000 claims description 8
- 238000013461 design Methods 0.000 claims description 7
- 230000007246 mechanism Effects 0.000 claims description 4
- 230000000087 stabilizing effect Effects 0.000 claims description 3
- 239000011800 void material Substances 0.000 claims description 2
- 230000008569 process Effects 0.000 description 16
- 230000006870 function Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 210000000544 articulatio talocruralis Anatomy 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000004888 barrier function Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000005764 inhibitory process Effects 0.000 description 1
- 235000001968 nicotinic acid Nutrition 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 239000004576 sand Substances 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 239000004575 stone Substances 0.000 description 1
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
技术领域
本申请涉及四足机器人稳定控制技术领域,特别是涉及基于落足调整的四足机器人动步态稳定控制方法及系统。
背景技术
本部分的陈述仅仅是提到了与本申请相关的背景技术,并不必然构成现有技术。
近年来,随着社会不断进步和科学技术的不断发展,机器人在现代工业领域应用已经非常广泛,而人们对机器人各方面的功能需求也不断提高。为满足社会的需求,在产业界和学术界,智能机器人的研究都是一大热点,其中包括的移动机器人是近年来研究的重要领域。
当前移动机器人逐渐在人们的生活中成为重要的角色,移动机器人又可分为轮式、履带式和腿足式机器人,轮式和履带式机器人在崎岖度大和复杂多变的地形环境的引用受到很大的限制,比如在砂石地面、泥土地面或断裂的地面等都会造成机器人通行障碍。仿生学角度看,腿足式动物的运动对于地面的要求低,只有点接触地面,而且腿足式动物多自由度的腿足具有更好的灵活性,对于复杂的地形拥有更强的适应能力,所以腿足式机器人具有更广阔的发展前景。
目前腿足式机器人由于控制的复杂性并没有被广泛应用,仅实现在人为规划轨迹的运动,并且对于复杂的多变环境没有很好的适应能力,在四足机器人运动过程中,仅仅依靠提前规划的运动不能在环境中稳定运动,这种情况会对四足机器人的运动产生扰动,能以维持机体重心的稳定。
腿足式机器人的平衡问题是机器人在实际环境中应对复杂地面环境和抗干扰能力的关键因素。
发明内容
为了解决现有技术的不足,本申请提供了基于落足调整的四足机器人动步态稳定控制方法及系统;
第一方面,本申请提供了基于落足调整的四足机器人动步态稳定控制方法;
基于落足调整的四足机器人动步态稳定控制方法,包括:
对四足机器人建立基于躯干的移动坐标系和基于髋关节的局部坐标系;所述四足机器人的腿足均具有三个自由度;
在基于躯干的移动坐标系和基于髋关节的局部坐标系下,通过建立的四足机器人模型,推导出机器人运动学方程,进而设计机器人初始步态;
采集四足机器人的躯干俯仰角度和翻滚角度,从而得到四足机器人的当前躯干姿态;
将四足机器人的当前躯干姿态与初始步态进行比较,计算出四足机器人的最佳落足点;根据四足机器人的最佳落足点,保持四足机器人稳定运动;
通过调整四足机器人对角腿的落足时间差,实现四足机器人重心位置的调整,进而实现四足机器人重心自平衡。
第二方面,本申请提供了基于落足调整的四足机器人动步态稳定控制系统;
基于落足调整的四足机器人动步态稳定控制系统,包括:
坐标系建立模块,其被配置为:对四足机器人建立基于躯干的移动坐标系和基于髋关节的局部坐标系;所述四足机器人的腿足均具有三个自由度;
初始步态设计模块,其被配置为:在基于躯干的移动坐标系和基于髋关节的局部坐标系下,通过建立的四足机器人模型,推导出机器人运动学方程,进而设计机器人初始步态;
当前躯干姿态获取模块,其被配置为:采集四足机器人的躯干俯仰角度和翻滚角度,从而得到四足机器人的当前躯干姿态;
最佳落足点计算模块,其被配置为:将四足机器人的当前躯干姿态与初始步态进行比较,计算出四足机器人的最佳落足点;根据四足机器人的最佳落足点,保持四足机器人稳定运动;
重心自平衡模块,其被配置为:通过调整四足机器人对角腿的落足时间差,实现四足机器人重心位置的调整,进而实现四足机器人重心自平衡。
第三方面,本申请还提供了一种电子设备,包括:一个或多个处理器、一个或多个存储器、以及一个或多个计算机程序;其中,处理器与存储器连接,上述一个或多个计算机程序被存储在存储器中,当电子设备运行时,该处理器执行该存储器存储的一个或多个计算机程序,以使电子设备执行上述第一方面所述的方法。
第四方面,本申请还提供了一种计算机可读存储介质,用于存储计算机指令,所述计算机指令被处理器执行时,完成第一方面所述的方法。
第五方面,本申请还提供了一种计算机程序(产品),包括计算机程序,所述计算机程序当在一个或多个处理器上运行的时候用于实现前述第一方面任意一项的方法。
与现有技术相比,本申请的有益效果是:
本申请在类似拓扑结构的移动平台上都可以实现稳定性控制。
本申请利用四足机器人运动目标参数和姿态反馈来规划足端轨迹,在保持运动的过程中,机器人通过调整摆动相落足位置来实现稳定运动下的抗干扰抑制,防止机器人运动出现扰动等情况。
本申请利用弹簧单利摆模型计算步态调整姿态,通过调整机器人摆动相落足位置,提高四足机器人在复杂地形和扰动下的适应能力,维持四足机器人前后及左右平衡,保证四足机器人在维持正常运动目标下能主动对外界侧向冲击、崎岖地形等作出调整维持稳定运动。
附图说明
构成本申请的一部分的说明书附图用来提供对本申请的进一步理解,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。
图1是本申请实施例一的四足机器人的坐标定义以及俯仰角度和翻滚角度说明示意图;
图2是本申请实施例一的四足机器人等效弹簧负载倒立摆模型示意图;
图3(a)-图3(h)是本申请实施例一的平坦地面行走示意图;
图4(a)-图4(d)是本申请实施例一的计算重心估计情况示意图;
图5(a)-图5(f)是本申请实施例一的侧向冲击与恢复仿真截图;
图6(a)-图6(b)是本申请实施例一的四足机器人重心自适应姿态角的变化曲线。
具体实施方式
应该指出,以下详细说明都是示例性的,旨在对本申请提供进一步的说明。除非另有指明,本文使用的所有技术和科学术语具有与本申请所属技术领域的普通技术人员通常理解的相同含义。
需要注意的是,这里所使用的术语仅是为了描述具体实施方式,而非意图限制根据本申请的示例性实施方式。如在这里所使用的,除非上下文另外明确指出,否则单数形式也意图包括复数形式,此外,还应当理解的是,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
在本申请本实施例中,“和/或”仅仅是一种描述关联对象的关联关系,表示可以存在三种关系。例如,A和/或B,可以表示:单独存在A,同时存在A和B,单独存在B这三种情况。另外,在本申请的描述中,“多个”是指两个或多于两个。
另外,为了便于清楚描述本申请实施例的技术方案,在本申请实施例中,采用了“第一”、“第二”等字样对功能和作用基本相同的相同项或相似项进行区分。本领域技术人员可以理解“第一”、“第二”字样并不对数量和执行次序进行限定,并且“第一”、“第二”等字样也并不限定一定不同。
在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。
实施例一
本实施例提供了基于落足调整的四足机器人动步态稳定控制方法;
基于落足调整的四足机器人动步态稳定控制方法,包括:
S101:对四足机器人建立基于躯干的移动坐标系和基于髋关节的局部坐标系;所述四足机器人的腿足均具有三个自由度;
S102:在基于躯干的移动坐标系和基于髋关节的局部坐标系下,通过建立的四足机器人模型,推导出机器人运动学方程,进而设计机器人初始步态;
S103:采集四足机器人的躯干俯仰角度和翻滚角度,从而得到四足机器人的当前躯干姿态;
S104:将四足机器人的当前躯干姿态与初始步态进行比较,计算出四足机器人的最佳落足点;根据四足机器人的最佳落足点,保持四足机器人稳定运动;
S105:通过调整四足机器人对角腿的落足时间差,实现四足机器人重心位置的调整,进而实现四足机器人重心自平衡。
作为一个或多个实施例,如图1所示,所述四足机器人,包括:躯干和与躯干连接的四条腿足机构,每条腿足机构均包括髋关节、肘关节和腕关节;所述躯干包括四个角,每个角均通过髋关节与第一直杆的上端连接,第一直杆的下端与肘关节连接,肘关节与第二直杆的上端连接,第二直杆的下端与腕关节连接,腕关节与第三直杆的上端连接,第三直杆的下端为四足机器人的足端。
作为一个或多个实施例,所述建立基于躯干的移动坐标系,是指:四足机器人直行前进方向为X轴,四足机器人直行前进的左侧方向为Y轴,四足机器人垂直向上方向为Z轴。所述建立基于躯干的移动坐标系使用D-H方法建立。
作为一个或多个实施例,所述基于髋关节的局部坐标系,是指:髋关节的垂直向下方向为X轴,髋关节的左侧方向(四足机器人直行前进方向的左侧方向)为Y轴,髋关节的正前方(四足机器人直行前进方向)为Z轴。所述基于髋关节的局部坐标系使用D-H方法建立。
作为一个或多个实施例,所述四足机器人的腿足均具有三个自由度,其中三个自由度,分别是指:髋关节自由度、肘关节自由度和腕关节自由度。
作为一个或多个实施例,所述在基于躯干的移动坐标系和基于髋关节的局部坐标系下,通过建立的四足机器人模型,推导出机器人运动学方程,进而设计机器人初始步态;具体机器人运动学方程,是指:
正向运动学方程:
其中,ci,23=cos(θi,2+θi,3),si,23=sin(θi,2+θi,3)。
得到各足末端坐标对于腿基坐标系的位置如下:
其中,θi,1、θi,2、θi,3分别表示髋关节、肘关节和踝关节转角,L1、L2和L3表示腿部杆件长度。
逆向运动学方程:
其中,θi,1、θi,2、θi,3分别表示髋关节、肘关节和踝关节转角,L1、L2和L3表示腿部杆件长度。
机器人的初始步态,是指:四足机器人的支撑相和摆动相。
支撑相的足端计算公式:
z(t)=0
摆动相的足端计算公式:
其中,x(t)和z(t)分别表示机器人足端沿x方向移动距离和时间的关系函数和沿z方向移动距离和时间的关系函数,参数S和H分别为四足机器人行走过程中的摆动幅度和抬腿高度,t是步态轨迹的采样时间,T是步态运动周期。
应理解的,采集四足机器人的躯干俯仰角度和翻滚角度,从而得到四足机器人的当前躯干姿态;其中,俯仰角度和翻滚角度是反应机器人当前躯干的姿态的两个直接指标。
作为一个或多个实施例,S104中将四足机器人的当前躯干姿态与初始步态进行比较,计算出四足机器人的最佳落足点;具体步骤包括:
其中,躯干翻滚角为θroll,俯仰角为θpitch,机器人长为L=2L′,宽为W=2W′,H是机器人质心的高度,1和4表示左前腿和右后腿,h′表示1腿高度,h″表示4腿高度,l′和l″表示1、4足端前后移动距离。
通过机器人足端的摆动相控制z方向上的抬腿高度以及摆动过程中x方向落足点的控制,四足机器人动步态规划过程中,y方向上的位置不变;
通过摆动相减少足端对地面的冲击,控制机器人躯干的平衡,包括调整z方向上的高度,调整x方向上的距离:
支撑相的足端计算公式:
z(t)=0
摆动相的足端计算公式:
其中,x(t)和z(t)分别表示机器人足端沿x方向移动距离和时间的关系函数和沿z方向移动距离和时间的关系函数,参数S和H分别为四足机器人行走过程中的摆动幅度和抬腿高度,t是步态轨迹的采样时间,T是步态运动周期。
将采集到的当前躯干姿态信息估测当前机器人的姿态,并通过对摆动腿的调整,预测最佳落足点的位置。
作为一个或多个实施例,根据四足机器人的最佳落足点,保持四足机器人稳定运动;具体步骤包括:
根据四足机器人的最佳落足点,对摆动腿进行调整,使对角腿足端同时落地,通过采集到的姿态调整对角腿的高度顺应躯干姿态,使四条腿的足端在一瞬间同时落在同一个平面上,减少落腿受到地面的冲击,保持四足机器人的稳定运动。
如图3(a)-图3(h)所示。
应理解的,所述预测最佳落足点,如表1:
表1足端预测坐标点
其中:i为1、2、3、4,分别表示左前腿、右前腿、左后腿和右后腿;
x0i、y0i、z0i为第i条腿足端起始x、y、z轴坐标;
xi、yi、zi为第i条腿足端x、y、z轴坐标;
作为一个或多个实施例,S105:通过调整四足机器人对角腿的落足时间差,实现四足机器人重心位置的调整,进而实现四足机器人重心自平衡;具体步骤包括:
S1051:在一个周期中,当左前腿和右后腿处于摆动相时,得到左前腿与右后腿的触地时间差,当右前腿和左后腿处于摆动相时,得到右前腿和左后腿的触地时间差;
S1052:根据左前腿与右后腿的触地时间差,计算出四足机器人躯干中心的投影点在四足机器人躯干前进方向的中心线方向上距离刚落地左前腿与右后腿的对角线的第一距离;
根据右前腿和左后腿的触地时间差,计算出四足机器人躯干的中心的投影点在四足机器人躯干前进方向的中心线方向上距离刚落地右前腿和左后腿的对角线的第二距离;
根据调整前四足机器人足端的初始位置、所述第一距离和所述第二距离,计算期望的足端位置;
S1053:根据期望的足端位置,姿态反馈的翻滚角和俯仰角的数据信息,调整摆动腿的落地姿态,使落足腿的足端在一瞬间同时落地,减小腿部受力;
S1054:重复S1051-S1053,直至四足机器人的腾空率小于设定阈值。
应理解的,由于前期重心的位置不确定,所以机器人再在运动过程中一条腿先落地,导致先落地的腿受到地面的反作用力较大,为减小腿部受到的反作用力,运用上述的姿态反馈策略,使机身质心平稳调整。
重心估计方法:
重心分布的四种情况如图4(a)-图4(d):
1、重心的投影点在落脚腿2、3对角线前和重心的投影点在腿2、3连线后
机器人重心投影在腿2、3对角线前时,求出重心在中心线上离2、3对角线的距离d2:
2、重心的投影点在腿1、4连线前和重心的投影点在腿1、4连线后
机器人重心投影在腿1、4对角线前时,求出重心在中心线上离1、4对角线的距离d1:
示例性的,步态调整策略设计如下:
(1)在一个周期中,当腿1、4处于摆动相时,可得到腿1、4触地的时间差Δt14,然后腿2、3处于摆动相时,可得到腿2、3触地的时间差Δt23;
(2)根据触地时间差求解出重心的投影点在中心线方向上距离刚落地对角线的距离d1或d2。
假设调整前初始位置为Pi=(xi,y0),则期望的足端位置为:
其中,i=1、2、3、4,d1和d2根据重心的位置来确定,Pi’=(xi’,y0)为期望位置,由于y轴没有位移,期望位置y轴坐标为y0。
(3)解算出四足期望位置之后,根据姿态反馈的数据信息调整摆动腿的落地姿态,减小腿部受力,设期望的三维坐标Qi’=(xie,y0,zie),各坐标的期望值为:
其中,x01’和z01’分别表示姿态调节x、z的坐标。
(4)重复步骤(1),直到四足机器人足端的腾空率大于ε。
ε是可接受的阈值,当四足机器人足端的腾空率大于该阈值,意味着四足机器人运动时,对脚落地的时间差值已经很小,机身的运动姿态可以满足要求。
对所述四足机器人的每个足端相对于髋关节的步态轨迹,维持躯干平衡修正机器人摆动相x和z方向落足位置,减小足端对地面的冲击力,稳定机器人运动。
本申请基于落足调整的四足机器人动步态稳定平衡控制,该方法保证四足机器人在维持正常运动目标下能够主动对稳定行走、侧向冲击、崎岖地形等作出调整位置稳定行走。
对四足机器人的运动状态进行描述。通过对四足机器人足端轨迹进行规划,使机器人动步态运动,通过IMU传感器对四足机器人在运动过程中躯干俯仰角和翻滚角信息进行采集。采集的频率为100hz。
将传感器采集到的当前四足机器人躯干的俯仰角和翻滚角的数据,并通过弹簧负载倒立摆模型(如图2)进行计算折算出四足机器人的落足点步态,调整四足机器人在坐标系的落足点来维持机器人躯干的翻滚角和俯仰角的稳定。
在四足机器人运动过程中,通过采集到的姿态信息,通过对四足机器人摆动相的足端位置调整,使四足机器人对角腿尽量同时落地,减小机器人足端对地面的冲击,造成四足机器人运动过程中躯干的不稳定。
通过时间状态机获得t时间,由时间决定每条腿处于支撑相还是摆动相,然后每条腿上按照上述公式所计算出来的轨迹运动,足端落足点的实现通过求解腿部拓扑结构的逆运动学公式,实现每个关节的角度控制。
本申请是通过四足机器人使用的trot步态,每一时刻对角腿都是出于相同的状态,两组对角腿交替进行支撑相运动和摆动相运动。
对所述四足机器人的每个足端相对于髋关节坐标系的步态轨迹,维持躯干平衡的是x平面的落足点,z方向上的轨迹维持机器人抬腿高度和躯干高度。
如图5(a)-图5(f)所示四足机器人在受到侧向冲击力的情况下,机器人能够迅速恢复平稳运动状态。
如图6(a)-图6(b)所示四足机器人初始重心未调整,在运动过程中机器人重心逐渐变化,使机器人能够稳定运动。
本申请提出一种基于落足调整的四足机器人动步态稳定平衡控制方法,对四足机器人建立基于躯干的移动坐标系和基于髋关节的局部坐标系,规划四足机器人对角步态的设计和实现,在四足机器人运动过程中,采集机器人运动过程中的俯仰角和翻滚角数据,从而得到四足机器人的当前躯干姿态;将四足机器人的当前姿态通过弹簧倒立摆模型的计算和对足端的位置预测,调整机器人落足点从而减少足端对地面的冲击,维持四足机器人躯干平衡。该方法在平面行走、侧向抗冲击等作出调整稳定行走,减小机器人运动过程中的扰动,使机器人平稳运动。
实施例二
本实施例提供了基于落足调整的四足机器人动步态稳定控制系统;
基于落足调整的四足机器人动步态稳定控制系统,包括:
坐标系建立模块,其被配置为:对四足机器人建立基于躯干的移动坐标系和基于髋关节的局部坐标系;所述四足机器人的腿足均具有三个自由度;
初始步态设计模块,其被配置为:在基于躯干的移动坐标系和基于髋关节的局部坐标系下,通过建立的四足机器人模型,推导出机器人运动学方程,进而设计机器人初始步态;
当前躯干姿态获取模块,其被配置为:采集四足机器人的躯干俯仰角度和翻滚角度,从而得到四足机器人的当前躯干姿态;
最佳落足点计算模块,其被配置为:将四足机器人的当前躯干姿态与初始步态进行比较,计算出四足机器人的最佳落足点;根据四足机器人的最佳落足点,保持四足机器人稳定运动;
重心自平衡模块,其被配置为:通过调整四足机器人对角腿的落足时间差,实现四足机器人重心位置的调整,进而实现四足机器人重心自平衡。
此处需要说明的是,上述坐标系建立模块、初始步态设计模块、当前躯干姿态获取模块、最佳落足点计算模块和重心自平衡模块对应于实施例一中的步骤S101至S105,上述模块与对应的步骤所实现的示例和应用场景相同,但不限于上述实施例一所公开的内容。需要说明的是,上述模块作为系统的一部分可以在诸如一组计算机可执行指令的计算机系统中执行。
上述实施例中对各个实施例的描述各有侧重,某个实施例中没有详述的部分可以参见其他实施例的相关描述。
所提出的系统,可以通过其他的方式实现。例如,以上所描述的系统实施例仅仅是示意性的,例如上述模块的划分,仅仅为一种逻辑功能划分,实际实现时,可以有另外的划分方式,例如多个模块可以结合或者可以集成到另外一个系统,或一些特征可以忽略,或不执行。
实施例三
本实施例还提供了一种电子设备,包括:一个或多个处理器、一个或多个存储器、以及一个或多个计算机程序;其中,处理器与存储器连接,上述一个或多个计算机程序被存储在存储器中,当电子设备运行时,该处理器执行该存储器存储的一个或多个计算机程序,以使电子设备执行上述实施例一所述的方法。
应理解,本实施例中,处理器可以是中央处理单元CPU,处理器还可以是其他通用处理器、数字信号处理器DSP、专用集成电路ASIC,现成可编程门阵列FPGA或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。
存储器可以包括只读存储器和随机存取存储器,并向处理器提供指令和数据、存储器的一部分还可以包括非易失性随机存储器。例如,存储器还可以存储设备类型的信息。
在实现过程中,上述方法的各步骤可以通过处理器中的硬件的集成逻辑电路或者软件形式的指令完成。
实施例一中的方法可以直接体现为硬件处理器执行完成,或者用处理器中的硬件及软件模块组合执行完成。软件模块可以位于随机存储器、闪存、只读存储器、可编程只读存储器或者电可擦写可编程存储器、寄存器等本领域成熟的存储介质中。该存储介质位于存储器,处理器读取存储器中的信息,结合其硬件完成上述方法的步骤。为避免重复,这里不再详细描述。
本领域普通技术人员可以意识到,结合本实施例描述的各示例的单元即算法步骤,能够以电子硬件或者计算机软件和电子硬件的结合来实现。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本申请的范围。
实施例四
本实施例还提供了一种计算机可读存储介质,用于存储计算机指令,所述计算机指令被处理器执行时,完成实施例一所述的方法。
以上所述仅为本申请的优选实施例而已,并不用于限制本申请,对于本领域的技术人员来说,本申请可以有各种更改和变化。凡在本申请的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本申请的保护范围之内。
Claims (10)
1.基于落足调整的四足机器人动步态稳定控制方法,其特征是,包括:
对四足机器人建立基于躯干的移动坐标系和基于髋关节的局部坐标系;所述四足机器人的腿足均具有三个自由度;
在基于躯干的移动坐标系和基于髋关节的局部坐标系下,通过建立的四足机器人模型,推导出机器人运动学方程,进而设计机器人初始步态;
采集四足机器人的躯干俯仰角度和翻滚角度,从而得到四足机器人的当前躯干姿态;
将四足机器人的当前躯干姿态与初始步态进行比较,计算出四足机器人的最佳落足点;根据四足机器人的最佳落足点,保持四足机器人稳定运动;
通过调整四足机器人对角腿的落足时间差,实现四足机器人重心位置的调整,进而实现四足机器人重心自平衡。
2.如权利要求1所述的方法,其特征是,所述四足机器人,包括:躯干和与躯干连接的四条腿足机构,每条腿足机构均包括髋关节、肘关节和腕关节;所述躯干包括四个角,每个角均通过髋关节与第一直杆的上端连接,第一直杆的下端与肘关节连接,肘关节与第二直杆的上端连接,第二直杆的下端与腕关节连接,腕关节与第三直杆的上端连接,第三直杆的下端为四足机器人的足端。
3.如权利要求1所述的方法,其特征是,所述建立基于躯干的移动坐标系,是指:四足机器人直行前进方向为X轴,四足机器人直行前进的左侧方向为Y轴,四足机器人垂直向上方向为Z轴;所述建立基于躯干的移动坐标系使用D-H方法建立;
或者,
所述基于髋关节的局部坐标系,是指:髋关节的垂直向下方向为X轴,髋关节的左侧方向为Y轴,髋关节的正前方为Z轴;所述基于髋关节的局部坐标系使用D-H方法建立。
4.如权利要求1所述的方法,其特征是,所述四足机器人的腿足均具有三个自由度,其中三个自由度,分别是指:髋关节自由度、肘关节自由度和腕关节自由度。
5.如权利要求1所述的方法,其特征是,根据四足机器人的最佳落足点,保持四足机器人稳定运动;具体步骤包括:
根据四足机器人的最佳落足点,对摆动腿进行调整,使对角腿足端同时落地,通过采集到的姿态调整对角腿的高度顺应躯干姿态,使四条腿的足端在一瞬间同时落在同一个平面上,减少落腿受到地面的冲击,保持四足机器人的稳定运动。
6.如权利要求1所述的方法,其特征是,通过调整四足机器人对角腿的落足时间差,实现四足机器人重心位置的调整,进而实现四足机器人重心自平衡;具体步骤包括:
(1):在一个周期中,当左前腿和右后腿处于摆动相时,得到左前腿与右后腿的触地时间差,当右前腿和左后腿处于摆动相时,得到右前腿和左后腿的触地时间差;
(2):根据左前腿与右后腿的触地时间差,计算出四足机器人躯干中心的投影点在四足机器人躯干前进方向的中心线方向上距离刚落地左前腿与右后腿的对角线的第一距离;
根据右前腿和左后腿的触地时间差,计算出四足机器人躯干的中心的投影点在四足机器人躯干前进方向的中心线方向上距离刚落地右前腿和左后腿的对角线的第二距离;
根据调整前四足机器人足端的初始位置、所述第一距离和所述第二距离,计算期望的足端位置;
(3):根据期望的足端位置,姿态反馈的翻滚角和俯仰角的数据信息,调整摆动腿的落地姿态,使落足腿的足端在一瞬间同时落地,减小腿部受力;
(4):重复(1)-(3),直至四足机器人的腾空率小于设定阈值。
7.如权利要求1所述的方法,其特征是,
四足机器人的最佳落足点为:
左前腿足端的坐标为:(x01-δz1sin(θpitch),y01,z01+δ(W'sin(θroll)+L'sin(θpitch)));
右前腿足端的坐标为:(x02-γz02sin(θpitch),y02,z02+γ(W'sin(θroll)-L'sin(θpitch)));
左后腿足端的坐标为:(x03+γz03sin(θpitch),y03,z03-γ(W'sin(θroll)+L'sin(θpitch)));
左后腿足端的坐标为:(x04+δz04sin(θpitch),y04,z04-δ(W'sin(θroll)-L'sin(θpitch)));
其中:1、2、3、4,分别表示左前腿、右前腿、左后腿和右后腿;x0i、y0i、z0i为第i条腿足端起始x、y、z轴坐标;xi、yi、zi为第i条腿足端x、y、z轴坐标。
8.基于落足调整的四足机器人动步态稳定控制系统,其特征是,包括:
坐标系建立模块,其被配置为:对四足机器人建立基于躯干的移动坐标系和基于髋关节的局部坐标系;所述四足机器人的腿足均具有三个自由度;
初始步态设计模块,其被配置为:在基于躯干的移动坐标系和基于髋关节的局部坐标系下,通过建立的四足机器人模型,推导出机器人运动学方程,进而设计机器人初始步态;
当前躯干姿态获取模块,其被配置为:采集四足机器人的躯干俯仰角度和翻滚角度,从而得到四足机器人的当前躯干姿态;
最佳落足点计算模块,其被配置为:将四足机器人的当前躯干姿态与初始步态进行比较,计算出四足机器人的最佳落足点;根据四足机器人的最佳落足点,保持四足机器人稳定运动;
重心自平衡模块,其被配置为:通过调整四足机器人对角腿的落足时间差,实现四足机器人重心位置的调整,进而实现四足机器人重心自平衡。
9.一种电子设备,其特征是,包括:一个或多个处理器、一个或多个存储器、以及一个或多个计算机程序;其中,处理器与存储器连接,上述一个或多个计算机程序被存储在存储器中,当电子设备运行时,该处理器执行该存储器存储的一个或多个计算机程序,以使电子设备执行上述权利要求1-7任一项所述的方法。
10.一种计算机可读存储介质,其特征是,用于存储计算机指令,所述计算机指令被处理器执行时,完成权利要求1-7任一项所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010831977.3A CN111913490B (zh) | 2020-08-18 | 2020-08-18 | 基于落足调整的四足机器人动步态稳定控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010831977.3A CN111913490B (zh) | 2020-08-18 | 2020-08-18 | 基于落足调整的四足机器人动步态稳定控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111913490A CN111913490A (zh) | 2020-11-10 |
CN111913490B true CN111913490B (zh) | 2023-11-14 |
Family
ID=73278349
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010831977.3A Active CN111913490B (zh) | 2020-08-18 | 2020-08-18 | 基于落足调整的四足机器人动步态稳定控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111913490B (zh) |
Families Citing this family (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112327869B (zh) * | 2020-11-19 | 2021-09-24 | 山东大学 | 基于关节速度规划的四足机器人对角步态运动控制方法 |
CN112327899B (zh) * | 2020-11-19 | 2021-10-01 | 山东大学 | 一种可变构型的四足机器人运动控制方法及系统 |
CN112859840B (zh) * | 2020-12-31 | 2022-06-24 | 国网智能科技股份有限公司 | 一种变电站足式巡检机器人路径规划方法及系统 |
CN112693541B (zh) * | 2020-12-31 | 2022-02-22 | 国网智能科技股份有限公司 | 一种变电站足式机器人、巡检系统及方法 |
CN112965508B (zh) * | 2021-02-03 | 2022-02-15 | 北京理工大学 | 多信息反馈的电动并联轮足机器人行走控制方法和系统 |
CN112987769B (zh) * | 2021-02-22 | 2022-07-05 | 武汉科技大学 | 四足机器人在变刚度地形稳定过渡的腿部主动调节方法 |
CN115188063A (zh) * | 2021-04-06 | 2022-10-14 | 广州视源电子科技股份有限公司 | 基于跑步机的跑姿分析方法、装置、跑步机及存储介质 |
CN113485405A (zh) * | 2021-08-05 | 2021-10-08 | Oppo广东移动通信有限公司 | 姿态获取方法、机器人和可读存储介质 |
CN113815016B (zh) * | 2021-09-30 | 2024-04-19 | 山东大学 | 一种可自动变形的腿足机器人足爪及其工作方法 |
CN114460841A (zh) * | 2021-12-15 | 2022-05-10 | 浙江大学杭州国际科创中心 | 一种足式机器人多步态控制器生成方法及计算机可读储存介质 |
CN114454983B (zh) * | 2022-03-02 | 2023-04-14 | 北京理工大学 | 一种四足机器人转弯控制方法及系统 |
WO2023206498A1 (zh) * | 2022-04-29 | 2023-11-02 | 北京小米机器人技术有限公司 | 足式机器人控制方法、装置、介质及足式机器人 |
CN114889725B (zh) * | 2022-05-17 | 2023-03-28 | 中国科学院自动化研究所 | 四足机器人的平稳支撑方法及装置 |
CN115092283B (zh) * | 2022-07-25 | 2023-08-01 | 中山大学 | 基于带有前庭反馈的梯度cpg的机器人控制方法 |
CN116985113A (zh) * | 2022-07-25 | 2023-11-03 | 腾讯科技(深圳)有限公司 | 控制足式机器人的方法和装置及足式机器人 |
CN115407791B (zh) * | 2022-08-19 | 2023-12-12 | 沈阳工业大学 | 一种考虑重心偏移影响的步行训练机器人轨迹跟踪方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017181976A1 (zh) * | 2016-04-21 | 2017-10-26 | 孙天齐 | 提高六足机器人行走稳定性的步态规划方法 |
CN107807655A (zh) * | 2017-10-27 | 2018-03-16 | 山东大学 | 基于三维空间中步态调整的四足机器人平衡稳定控制方法 |
CN109407542A (zh) * | 2017-08-15 | 2019-03-01 | 天津市大然科技有限公司 | 一种腰部扭动参与下的四足机器人对角步态设计方法 |
CN110328670A (zh) * | 2019-08-27 | 2019-10-15 | 山东科技大学 | 基于地形模糊自适应的四足机器人静步态规划方法 |
CN111483532A (zh) * | 2020-06-02 | 2020-08-04 | 山东大学 | 一种静步态上楼梯的四足机器人运动控制方法 |
-
2020
- 2020-08-18 CN CN202010831977.3A patent/CN111913490B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017181976A1 (zh) * | 2016-04-21 | 2017-10-26 | 孙天齐 | 提高六足机器人行走稳定性的步态规划方法 |
CN109407542A (zh) * | 2017-08-15 | 2019-03-01 | 天津市大然科技有限公司 | 一种腰部扭动参与下的四足机器人对角步态设计方法 |
CN107807655A (zh) * | 2017-10-27 | 2018-03-16 | 山东大学 | 基于三维空间中步态调整的四足机器人平衡稳定控制方法 |
CN110328670A (zh) * | 2019-08-27 | 2019-10-15 | 山东科技大学 | 基于地形模糊自适应的四足机器人静步态规划方法 |
CN111483532A (zh) * | 2020-06-02 | 2020-08-04 | 山东大学 | 一种静步态上楼梯的四足机器人运动控制方法 |
Non-Patent Citations (3)
Title |
---|
基于虚拟模型的四足机器人对角小跑步态控制方法;张国腾;荣学文;李贻斌;柴汇;李彬;;机器人(第01期);全文 * |
由2自由度并联髋关节构成的脊柱式四足步行机器人步态规划和稳定性分析;桑董辉;陈原;高军;;兵工学报(第06期);全文 * |
面向复杂地形的四足机器人步态生成方法;陈雅辉;谭跃刚;李彰;;计算机测量与控制(第07期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN111913490A (zh) | 2020-11-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111913490B (zh) | 基于落足调整的四足机器人动步态稳定控制方法及系统 | |
US11654569B2 (en) | Handling gait disturbances with asynchronous timing | |
US20210171135A1 (en) | Slip Detection for Robotic Locomotion | |
CN111483532B (zh) | 一种静步态上楼梯的四足机器人运动控制方法 | |
CN110842921B (zh) | 四足机器人大坡度地形或高障碍物攀爬跨越的步态规划方法 | |
CN107807655B (zh) | 基于三维空间中步态调整的四足机器人平衡稳定控制方法 | |
US9969087B1 (en) | Leg collision avoidance in a robotic device | |
CN111605642B (zh) | 六足机器人的自由容错步态规划方法、装置及存储介质 | |
US7805218B2 (en) | Robot device and control method of robot device | |
CN105242677B (zh) | 四足机器人双足支撑相位力位混合控制方法 | |
CN111070201B (zh) | 四足机器人在负载突变下基于zmp理论的反应式鲁棒控制方法 | |
US9964956B2 (en) | Operating environment information generating device for mobile robot | |
CN111377004A (zh) | 一种双足机器人步态控制方法以及双足机器人 | |
JP2013141715A (ja) | 脚式移動ロボットの脚体運動軌道生成装置。 | |
CN108931988B (zh) | 一种基于中枢模式发生器的四足机器人的步态规划方法、中枢模式发生器及机器人 | |
CN108089583B (zh) | 一种多足机器人运动过渡的方法和装置 | |
US20070267994A1 (en) | Legged Robot, Method for Controlling Legged Robot, and Device and Method for Generating Gait Data | |
CN114995479A (zh) | 一种基于强化学习的四足机器人虚拟模型控制器的参数控制方法 | |
CN112847371B (zh) | 一种仿人机器人动态跨越连续障碍物的运动规划方法 | |
CN104709374A (zh) | 一种防止足式机器人左右倾斜的方法 | |
Zheng et al. | Humanoid robots walking on grass, sands and rocks | |
CN114454983B (zh) | 一种四足机器人转弯控制方法及系统 | |
CN113985864A (zh) | 一种动态行走的四足探测机器人及控制方法 | |
Kim et al. | Continuous cyclic stepping on 3d point-foot biped robots via constant time to velocity reversal | |
Guo et al. | Practical techniques research on climbing the steep slope of quadruped robots |
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 |