CN102841605B - 一种轮腿复合式移动平台步态控制方法 - Google Patents
一种轮腿复合式移动平台步态控制方法 Download PDFInfo
- Publication number
- CN102841605B CN102841605B CN201210339690.4A CN201210339690A CN102841605B CN 102841605 B CN102841605 B CN 102841605B CN 201210339690 A CN201210339690 A CN 201210339690A CN 102841605 B CN102841605 B CN 102841605B
- Authority
- CN
- China
- Prior art keywords
- gait
- leg
- foreleg
- wheeled
- wheel
- 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
Landscapes
- Motorcycle And Bicycle Frame (AREA)
Abstract
本发明公开了一种轮腿复合式移动平台步态控制方法,其步骤为:(1)初始模态:建立运动模态选择函数mode(θ1,θ2,...,θn)、单腿运动模态选择函数legmode(ε1,ε2,ε3,ε4);(2)通过传感器实时采集路况上障碍物信息,分析判断后利用运动模态选择函数mode(θ1,θ2,...,θn)、单腿运动模态选择函数legmode(ε1,ε2,ε3,ε4)选择移动平台的行走姿态;(3)由现有行走姿态切换至步骤(2)中所选择的行走姿态。本发明具有原理简单、能够提高轮腿移动平台操控性和控制精准度、增强其适应能力等优点。
Description
技术领域
本发明主要涉及到移动平台的控制领域,特指一种适用于轮腿复合式移动平台的步态控制方法。
背景技术
基于轮腿复合运动结构的移动平台(例如:轮胎复合式机器人)既能发挥轮式结构的高速机动性,又能保证腿式结构的灵活性以及良好的越障能力,还可以实现更复杂的轮腿复合的运动步态,它可以在多种地形条件和复杂环境下进行应用,因而在探测、救灾、军事侦察、扫雷排险等方面都有广阔的应用前景。
如图1所示为一种现有的轮腿复合运动平台,它包括机架2以及连接于机架2底部的前部轮腿组件5和后部轮腿组件4,机架2包括通过铰接在一起的前部身板3和后部身板1,前部身板3和后部身板1之间可以产生相对转动以改变两者的相对位置。前部轮腿组件5和后部轮腿组件4均包括大腿摆臂、车轮机构以及小腿摆臂,大腿摆臂的一端铰接于机架2上并可绕铰点摆动,大腿摆臂的另一端与小腿摆臂的一端相连形成肘部并可绕肘部摆动形成折叠,车轮机构装设于小腿摆臂中段处。小腿摆臂的底部末端设有用来完成行走的足部。
这种轮腿复合运动平台通过前、后轮腿系统的折叠与伸展,能够实现轮腿运动模式切换,令轮式运动方式与腿式运动方式相互独立,在完成状态切换之后,轮式运动机构与腿式运动机构完全区分开。在轮式运动中,腿式机构折叠与机架联接为一体;在腿式运动方式中,轮式机构位置较高,无法干扰腿式运动。但是,在上述结构的轮腿复合运动平台中,并没有一套行之有效的运动步态控制方法,使其能在各类复杂地形环境下进行运动步态的选择以及在不同运动步态之间的自由切换,这就将大大限制轮腿复合运动平台的适用范围。
发明内容
本发明要解决的技术问题就在于:针对现有技术存在的技术问题,本发明提供一种原理简单、能够提高轮腿移动平台操控性和控制精准度、增强其适应能力的轮腿复合式移动平台步态控制方法。
为解决上述技术问题,本发明采用以下技术方案:
一种轮腿复合式移动平台步态控制方法,其步骤为:
(1)初始模态:建立运动模态选择函数mode(θ1,θ2,...,θ2)、单腿运动模态选择函数legmode(ε1,ε2,ε3,ε4);
(1.1)运动模态选择函数mode(θ1,θ2,...,θn):当mode(Θ)函数值取1时,轮腿复合式移动平台选用轮式模态前进;当mode(Θ)函数值取2时,轮腿复合式移动平台选用腿式模态前进;当mode(Θ)函数值取3时,轮腿复合式移动平台选用轮腿复合模态前进;
(1.2)单腿运动模态选择函数legmode(ε1,ε2,ε3,ε4):ε1=1,2,3,4,以表示轮腿复合式移动平台左前腿将采用1,2,3,4简单步态;ε2=1,2,3,4,以表示右前腿将采用相应简单步态;ε3=1,2,3,4,以表示左后腿将采用相应简单步态;ε4=1,2,3,4,以表示右后腿将采用相应简单步态;其中,后腿步态1主要用于轮腿复合式移动平台低姿轮式高速前进,后腿步态2主要用于轮腿复合式移动平台高姿轮式避障前进,后腿步态3主要用于轮腿复合式移动平台在非结构化地形条件下轮式变结构适应性通行,后腿步态4主要用于轮腿复合式移动平台在复杂地形下腿式前进;前腿步态1主要用于轮腿复合式移动平台低姿轮式高速前进,前腿步态2主要用于轮腿复合式移动平台高姿轮式避障前进,前腿步态3主要用于轮腿复合式移动平台在非结构化地形下轮式变结构适应性通行,前腿步态4主要用于机器人在复杂地形下腿式前进;
(2)通过传感器实时采集路况上障碍物信息,分析判断后利用运动模态选择函数mode(θ1,θ2,...,θn)、单腿运动模态选择函数legmode(ε1,ε2,ε3,ε4)选择移动平台的行走姿态;
(3)由现有行走姿态切换至步骤(2)中所选择的行走姿态。
作为本发明的进一步改进:
所述步骤(1.1)中将轮式模态分为低姿轮式模态、高姿轮式模态以及适应性轮式模态,其选择由姿态选择函数wheelmode(δ1,δ2,...,δn)来实现;当wheelmode(Θ)的函数值取1时,采用低姿轮式;当wheelmode(Θ)的函数值取2时,采用高姿轮式;当wheelmode(Θ)的函数值取3时采用适应性轮式。
在所述步骤(1.2)对单腿步态建立的步骤为:
(1.2.1)先定义移动平台的坐标系,以移动平台的质心为原点,沿移动平台的纵轴指向头部方向为X轴,沿移动平台横轴指向左手边方向为Y轴,根据右手坐标准则确定Z轴;依据上述坐标系,设定姿态角αij,i=1,2,3,4;j=1,2,3,其中i为腿的标示符,1表示左前腿、2表示右前腿、3表示左后腿、4表示右后腿;j为关节标示符,1表示髋关节横向摆动角、2表示髋关节纵向摆动角、3表示膝关节纵向摆动角;
(1.2.2)设定前腿和后腿的步态:
后腿步态1:步态的姿态角约束为αij=0,i=3,4;j=1,2,3;
后腿步态2:步态的姿态角约束为αi1=0,αi2+αi3=90°,αi2∈[0°,90°],i=3,4;
后腿步态3:步态的姿态角约束为αi1∈[-30°,60°],αi2+αi3=90°],αi2∈[0°,90°],i=3,4;
后腿步态4:步态的姿态角约束为αi1∈[-30°,60°],αi2∈[-45°,90°],αi3=[0°,135°],i=3,4。
前腿步态1:步态的姿态角约束为αij=0,αi1,2;j=1,2,3;
前腿步态2:步态的姿态角约束为αi1=0,αi2+αi3=90°,αi2∈[0°,90°],i=1,2;
前腿步态3:姿态角约束为αi1∈[-30°,60°],αi2+αi3=90°,αi2∈[0°,90°],i=1,2;
前腿步态4:步态的姿态角约束为αi1∈[-30°,60°],αi2∈[-45°,90°],αi3=[0°,135°],i=1,2。
所述步骤(3)的具体切换过程为:
(3.1)低姿轮式向高姿轮式切换时,单腿简单步态切换过程是后腿步态1与前腿步态1同时切换为后腿步态2与前腿步态2,相应的角度关系为αi1,i=1,2,3,4保持不变,αi2,i=1,2,3,4同步增大到[0°,90°]之间的一个角度,同时αi3,i=1,2,3,4同步变为90°-αi2;
(3.2)低姿轮式向变形轮式切换时,单腿简单步态切换过程是后腿步态1与前腿步态1同时切换为后腿步态3与前腿步态3,与之相应的角度关系为αi1,i=1,2,3,4同步变化到[-30°,60°]之间的一个角度,αi2,i=1,2,3,4同步增大到[0°,90°]之间的一个角度,同时αi3,i=1,2,3,4同步变为90°-αi2;
(3.3)低姿轮式向腿式步态切换时,单腿简单步态切换过程是后腿步态1与前腿步态1同时切换为后腿步态4与前腿步态4,αi1,i=1,2,3,4分别在[-30°,60°]内进行角度调整,αi2,i=1,2,3,4分别在[-45°,90°]内进行调整,αi3,i=1,2,3,4分别在[0°,135°]内进行调整;
(3.4)低姿轮式向轮腿复合式运动步态切换时,根据地形条件,左、右后腿分别向后腿步态2、4,左右前腿分别向前腿步态2、4或者左、右后腿分别向后腿步态4、2,左右前腿分别向前腿步态4、2切换;
(3.5)高姿轮式向变形轮式切换时,单腿简单步态切换过程是后腿步态2与前腿步态2同时切换为后腿步态3与前腿步态3,角度关系为αi1,i=1,2,3,4同步变化到[-30°,60°]之间的一个角度,αi2,i=1,2,3,4运动范围保持不变,αi3,i=1,2,3,4同步变为90°-αi2;
(3.6)高姿轮式向腿式运动步态切换时,单腿简单步态切换过程是后腿步态2与前腿步态2同时切换为后腿步态4与前腿步态4,αi1,i=1,2,3,4分别在[-30°,60°]内进行角度调整,αi2,i=1,2,3,4分别在[-45°,90°]内进行调整,αi3,i=1,2,3,4分别在[0°,135°]内进行调整;
(3.7)高姿轮式向轮腿复合式运动步态切换时,根据地形条件,左、右后腿分别向后腿步态2、4,左右前腿分别向前腿步态2、4或者左、右后腿分别向后腿步态4、2,左右前腿分别向前腿步态4、2切换;
(3.8)变形轮式向腿式运动步态切换时,单腿简单步态切换过程是后腿步态3与前腿步态3同时切换为后腿步态4与前腿步态4,αi1,i=1,2,3,4分别在[-30°,60°]内进行角度调整,αi2,i=1,2,3,4分别在[-45°,90°]内进行调整,αi3,i=1,2,3,4分别在[0°,135°]内进行调整;
(3.9)变形轮式向轮腿复合式运动步态切换时,根据地形条件,左、右后腿分别向后腿步态2、4,左右前腿分别向前腿步态2、4或者左、右后腿分别向后腿步态4、2,左右前腿分别向前腿步态4、2切换;
(3.10)腿式向轮腿复合式运动步态切换时,根据地形条件,左、右后腿分别向后腿步态2、4,左右前腿分别向前腿步态2、4或者左、右后腿分别向后腿步态4、2,左右前腿分别向前腿步态4、2切换。
与现有技术相比,本发明的优点在于:
(1)本发明的轮腿复合式移动平台步态控制方法,原理简单、控制精度高,基于轮腿复合式移动平台的运动机理,使其实现轮式、腿式行走、自由转弯,轮式与腿式模态自由切换,满足上下楼梯、跨越障碍等功能需要,从而表现良好的环境适应能力。
(2)本发明的轮腿复合式移动平台步态控制方法,能使轮腿复合式移动平台在各类复杂地形环境下行走,通过设置复合步态以及各类复合步态间自由切换的控制方法,确保了轮腿复合式移动机器人的良好地形适应能力。
附图说明
图1是轮腿复合式移动平台的结构示意图。
图2是本发明方法的流程示意图。
图3是应用本发明方法后移动平台处于低姿轮式运动模态时的示意图。
图4是应用本发明方法后移动平台处于高姿轮式运动模态时的示意图。
图5是应用本发明方法后移动平台处于适应性轮式运动模态时的示意图。
图6是应用本发明方法后移动平台处于腿式运动模态时的示意图。
图7是应用本发明方法后移动平台处于轮腿复合式运动模态时的示意图。
图8是轮腿复合式移动平台的后腿角度示意图。
图9是轮腿复合式移动平台的前腿角度示意图。
图10是应用本发明方法后移动平台的后腿步态1示意图。
图11是应用本发明方法后移动平台的后腿步态2示意图。
图12是应用本发明方法后移动平台的后腿步态3示意图。
图13是应用本发明方法后移动平台的后腿步态4示意图。
图14是应用本发明方法后移动平台的前腿步态1示意图。
图15是应用本发明方法后移动平台的前腿步态2示意图。
图16是应用本发明方法后移动平台的前腿步态3示意图。
图17是应用本发明方法后移动平台的前腿步态4示意图。
具体实施方式
以下将结合说明书附图和具体实施例对本发明做进一步详细说明。
本发明主要是基于轮腿复合式移动平台的运动步态控制方法,参见图1为这类轮腿复合式移动平台的基本结构,通过本发明的运动步态控制方法可以充分挖掘此类移动平台的多样化功能,可以根据实际路况实现多种运动模式(包括轮式模态、腿式模态以及轮腿复合模态),加载相应的执行机构后可以执行多种类型的专业任务。
如图2所示,本发明轮腿复合式移动平台步态控制方法的具体步骤为:
(1)初始模态:建立运动模态选择函数mode(θ1,θ2,...,θn)、单腿运动模态选择函数legmode(ε1,ε2,ε3,ε4);
(1.1)建立关于轮式模态、腿式模态以及轮腿复合模态的运动模态选择函数mode(θ1,θ2,...,θn);
当mode(Θ)函数值取1时,轮腿复合式移动平台选用轮式模态前进。此轮式模态一般适用于在平坦地形条件下轮式高速前进(参见图3)、或在杂乱小障碍物地形条件下轮式高速适应性通过(参见图4)、或通过V形壕沟地形(参见图5)。
本实施例中,为了与上述三种地形条件对应,进一步将轮式模态分为低姿轮式模态、高姿轮式模态以及适应性轮式模态,其选择由姿态选择函数wheelmode(δ1,δ2,...,δn)来实现,即当wheelmode(Θ)的函数值取1时,采用低姿轮式;当wheelmode(Θ)的函数值取2时,采用高姿轮式;当wheelmode(Θ)的函数值取3时采用适应性轮式(参见图5)。
当mode(Θ)函数值取2时,轮腿复合式移动平台选用腿式模态前进,此运动模态主要用于在非结构化复杂地形如野外、或灾区等条件下顺利行进(参见图6)。
当mode(Θ)函数值取3时,轮腿复合式移动平台选用轮腿复合模态前进,此运动模态主要用于高低路或非结构化平坦地形条件下的通行(参见图7)。
上述三种运动模态(轮式、腿式、轮腿复合式)构成了轮腿复合式移动平台的运动性基础,而上述三种运动模态又以单腿的各类简单运动模态为基础。
(1.2)建立单腿运动模态选择函数legmode(ε1,ε2,ε3,ε4)。相应的,ε1=1,2,3,4,以表示左前腿将采用1,2,3,4简单步态;ε2=1,2,3,4,以表示右前腿将采用相应简单步态,ε3=1,2,3,4,以表示左后腿将采用相应简单步态;ε4=1,2,3,4,以表示右后腿将采用相应简单步态。
具体而言,单腿简单步态依据前后腿结构的不同分为两种,分别称为后腿步态和前腿步态。每条腿具有三个关节自由度,其中髋关节具有两个自由度,膝关节具有一个自由度,同时每条腿上所配备轮具有一个轮自由度。后腿轮作为主动轮,前腿轮作为主动轮或者被动轮,这可以依据对动力的需求来决定。
定义移动平台的坐标系,以移动平台的质心为原点,沿移动平台的纵轴指向头部方向为X轴,沿移动平台横轴指向左手边方向为Y轴,根据右手坐标准则确定Z轴。
为方便表述,对各个腿的关节角统一进行符号定义,定义为αij,i=1,2,3,4;j=1,2,3,其中i为腿的标示符,1表示左前腿、2表示右前腿、3表示左后腿、4表示右后腿;j为关节标示符,1表示髋关节横向摆动角、2表示髋关节纵向摆动角、3表示膝关节纵向摆动角。
即:在移动平台的后腿上,αi1,i=3,4为髋关节的横向摆动即绕X轴的摆动角度,处于垂直向下时为0°,向外侧摆动角度为正,向内侧摆动角度为负;αi2,i=3,4为髋关节的纵向摆动即绕Y轴的摆动角度,处于垂直向下时为0°,向前摆动角度为正,向后摆动角度为负;αi3,i=3,4为膝关节的纵向摆动即绕Y轴的摆动角度,处于当小腿与大腿完全闭合时为0°,张开时为正角度(参见图8)。
在移动平台的前腿上,αi1,i=1,2为髋关节的横向摆动即绕X轴的摆动角度,处于垂直向下时为0°,向外侧摆动角度为正,向内侧摆动角度为负;αi2,i=1,2为髋关节的纵向摆动即绕Y轴的摆动角度,处于垂直向下时为0°,向后摆动角度为正,向前摆动角度为负;αi3,i=1,2为膝关节的纵向摆动即绕Y轴的摆动角度,处于当小腿与大腿完全闭合时为0°,张开时为正角度(参见图9)。
本实施例中,前腿与后腿的长度相同,其中大腿长度为a,小腿长度为b,轮半径为r。相应的设障碍物的高度为h。
那么,后腿的步态包括四种:
后腿步态1:主要用于轮腿复合式移动平台低姿轮式高速前进,步态的姿态角约束为:αij=0,i=3,4;j=1,2,3(参见图10);
后腿步态2:主要用于轮腿复合式移动平台高姿轮式避障前进,步态的姿态角约束为:αi1=0,αi2+αi3=90°,αi2∈[0°,90°],i=3,4(参见图11);
后腿步态3:主要用于轮腿复合式移动平台在非结构化地形条件下轮式变结构适应性通行,步态的姿态角约束为:αi1∈[-30°,60°],αi2+αi3=90°,αi2∈[0°,90°],i=3,4(参见图12);
后腿步态4:主要用于轮腿复合式移动平台在复杂地形下腿式前进,步态的姿态角约束为:αi1∈[-30°,60°],αi2∈[-45°,90°],αi3=[0°,135°],i=3,4(参见图13)。
前腿简单步态也包括四种:
前腿步态1:主要用于轮腿复合式移动平台低姿轮式高速前进,步态的姿态角约束为:αij=0,i=1,2;j=1,2,3(参见图14);
前腿步态2:主要用于轮腿复合式移动平台高姿轮式避障前进,步态的姿态角约束为:αi1=0,αi2+αi3=90°,αi2∈[0°,90°],i=1,2(参见图15);
前腿步态3:主要用于轮腿复合式移动平台在非结构化地形下轮式变结构适应性通行,姿态角约束为:αi1∈[-30°,60°],αi2+αi3=90°,αi2∈[0°,90°],i=1,2(参见图16);
前腿步态4:主要用于机器人在复杂地形下腿式前进,步态的姿态角约束为:αi1∈[-30°,60°],αi2∈[-45°,90°],αi3=[0°,135°],i=1,2(参见图17)。
轮式、腿式、轮腿复合式运动步态,与单腿简单运动步态的对应关系以及所适用的地形条件用下表描述:
由列表可知,低姿轮式复合步态,所对应的单腿简单步态分别为后腿步态1、前腿步态1;高姿轮式复合步态,所对应的单腿简单步态分别为后腿步态2、前腿步态2;变形轮式复合步态,所对应的单腿简单步态分别为后腿步态3、前腿步态3;腿式步态,所对应的单腿简单步态分别为后腿步态4、前腿步态4;轮腿复合式步态,所对应的单腿简单步态分别为后腿步态2(左后腿)、4(右后腿),前腿步态2(左前腿)、4(右前腿)或者后腿步态4(左后腿)、2(右后腿),前腿步态4(左前腿)、2(右前腿)。
(2)通过传感器实时采集路况上障碍物信息,分析判断后利用运动模态选择函数mode(θ1,θ2,...,θn)、单腿运动模态选择函数legmode(ε1,ε2,ε3,ε4)选择移动平台的行走姿态;
(3)由现有行走姿态切换至步骤(2)中所选择的行走姿态。
复合运动步态共有五种,涉及到的步态切换一共包括种,由于此结构的运动自由度可以保证所有的切换动作具有可逆性,因此下面只详细讨论种模态切换详细过程,剩余的10种切换即为相应切换的完全逆过程。
下面描述低姿轮式向高姿轮式、变形轮式、腿式、轮腿复合式运动步态,高姿轮式向变形轮式、腿式、轮腿复合式运动步态,变形轮式向腿式、轮腿复合式运动步态以及腿式向轮腿复合式运动步态切换的详细过程。
低姿轮式向高姿轮式切换时,单腿简单步态切换过程是后腿步态1与前腿步态1同时切换为后腿步态2与前腿步态2,相应的角度关系为αi1,i=1,2,3,4保持不变,αi2,i=1,2,3,4同步增大到[0°,90°]之间的一个角度,同时αi3,i=1,2,3,4同步变为90°-αi2。
低姿轮式向变形轮式切换时,单腿简单步态切换过程是后腿步态1与前腿步态1同时切换为后腿步态3与前腿步态3,与之相应的角度关系为αi1,i=1,2,3,4同步变化到[-30°,60°]之间的一个角度,αi2,i=1,2,3,4同步增大到[0°,90°]之间的一个角度,同时αi3,i=1,2,3,4同步变为90°-αi2。
低姿轮式向腿式步态切换时,单腿简单步态切换过程是后腿步态1与前腿步态1同时切换为后腿步态4与前腿步态4,αi1,i=1,2,3,4分别在[-30°,60°]内进行角度调整,αi2,i=1,2,3,4分别在[-45°,90°]内进行调整,αi3,i=1,2,3,4分别在[0°,135°]内进行调整。
低姿轮式向轮腿复合式运动步态切换时,根据地形条件,左、右后腿分别向后腿步态2、4,左右前腿分别向前腿步态2、4或者左、右后腿分别向后腿步态4、2,左右前腿分别向前腿步态4、2切换。
高姿轮式向变形轮式切换时,单腿简单步态切换过程是后腿步态2与前腿步态2同时切换为后腿步态3与前腿步态3,角度关系为αi1,i=1,2,3,4同步变化到[-30°,60°]之间的一个角度,αi2,i=1,2,3,4运动范围保持不变,αi3,i=1,2,3,4同步变为90°-αi2。
高姿轮式向腿式运动步态切换时,单腿简单步态切换过程是后腿步态2与前腿步态2同时切换为后腿步态4与前腿步态4,αi1,i=1,2,3,4分别在[-30°,60°]内进行角度调整,αi2,i=1,2,3,4分别在[-45°,90°]内进行调整,αi3,i=1,2,3,4分别在[0°,135°]内进行调整。
高姿轮式向轮腿复合式运动步态切换时,根据地形条件,左、右后腿分别向后腿步态2、4,左右前腿分别向前腿步态2、4或者左、右后腿分别向后腿步态4、2,左右前腿分别向前腿步态4、2切换。
变形轮式向腿式运动步态切换时,单腿简单步态切换过程是后腿步态3与前腿步态3同时切换为后腿步态4与前腿步态4,αi1,i=1,2,3,4分别在[-30°,60°]内进行角度调整,αi2,i=1,2,3,4分别在[-45°,90°]内进行调整,αi3,i=1,2,3,4分别在[0°,135°]内进行调整。
变形轮式向轮腿复合式运动步态切换时,根据地形条件,左、右后腿分别向后腿步态2、4,左右前腿分别向前腿步态2、4或者左、右后腿分别向后腿步态4、2,左右前腿分别向前腿步态4、2切换。
腿式向轮腿复合式运动步态切换时,根据地形条件,左、右后腿分别向后腿步态2、4,左右前腿分别向前腿步态2、4或者左、右后腿分别向后腿步态4、2,左右前腿分别向前腿步态4、2切换。
综上所述,通过采用本发明的步态控制方法后,轮式、腿式、轮腿复合式等多种运动步态间即可以根据实际路况的需要进行自由切换,而且每种步态中又可以根据实际需要分成低姿轮式、高姿轮式、适应性轮式步态并保证它们之间也可以自由切换。
在较佳实施例中,应用本发明的方法后,移动运动平台在启动时可以先以低姿轮式或者腿式步态启动,然后通过传感器采集实际路况信息并根据实际遇到的地形条件,进行自由切换步态。
以上仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应视为本发明的保护范围。
Claims (4)
1.一种轮腿复合式移动平台步态控制方法,其特征在于,步骤为:
(1)初始模态:建立运动模态选择函数mode(θ1,θ2,...,θn)、单腿运动模态选择函数legmode(ε1,ε2,ε3,ε4);
(1.1)运动模态选择函数mode(θ1,θ2,...,θn):当mode(Θ)函数值取1时,轮腿复合式移动平台选用轮式模态前进;当mode(Θ)函数值取2时,轮腿复合式移动平台选用腿式模态前进;当mode(Θ)函数值取3时,轮腿复合式移动平台选用轮腿复合模态前进;
(1.2)单腿运动模态选择函数legmode(ε1,ε2,ε3,ε4):ε1=1,2,3,4,以表示轮腿复合式移动平台左前腿将采用1,2,3,4简单步态;ε2=1,2,3,4,以表示右前腿将采用相应简单步态;ε3=1,2,3,4,以表示左后腿将采用相应简单步态;ε4=1,2,3,4,以表示右后腿将采用相应简单步态;其中,后腿步态1主要用于轮腿复合式移动平台低姿轮式高速前进,后腿步态2主要用于轮腿复合式移动平台高姿轮式避障前进,后腿步态3主要用于轮腿复合式移动平台在非结构化地形条件下轮式变结构适应性通行,后腿步态4主要用于轮腿复合式移动平台在复杂地形下腿式前进;前腿步态1主要用于轮腿复合式移动平台低姿轮式高速前进,前腿步态2主要用于轮腿复合式移动平台高姿轮式避障前进,前腿步态3主要用于轮腿复合式移动平台在非结构化地形下轮式变结构适应性通行,前腿步态4主要用于机器人在复杂地形下腿式前进;
(2)通过传感器实时采集路况上障碍物信息,分析判断后利用运动模态选择函数mode(θ1,θ2,...,θn)、单腿运动模态选择函数legmode(ε1,ε2,ε3,ε4)选择移动平台的行走姿态;
(3)由现有行走姿态切换至步骤(2)中所选择的行走姿态。
2.根据权利要求1所述的轮腿复合式移动平台步态控制方法,其特征在于:所述步骤(1.1)中将轮式模态分为低姿轮式模态、高姿轮式模态以及适应性轮式模态,其选择由姿态选择函数wheelmode(δ1,δ2,...,δn)来实现;当wheelmode(Θ)的函数值取1时,采用低姿轮式;当wheelmode(Θ)的函数值取2时,采用高姿轮式;当wheelmode(Θ)的函数值取3时采用适应性轮式。
3.根据权利要求1所述的轮腿复合式移动平台步态控制方法,其特征在于,在所述步骤(1.2)对单腿步态建立的步骤为:
(1.2.1)先定义移动平台的坐标系,以移动平台的质心为原点,沿移动平台的纵轴指向头部方向为X轴,沿移动平台横轴指向左手边方向为Y轴,根据右手坐标准则确定Z轴;依据上述坐标系,设定姿态角αij,i=1,2,3,4;j=1,2,3,其中i为腿的标示符,1表示左前腿、2表示右前腿、3表示左后腿、4表示右后腿;j为关节标示符,1表示髋关节横向摆动角、2表示髋关节纵向摆动角、3表示膝关节纵向摆动角;
(1.2.2)设定前腿和后腿的步态:
后腿步态1:步态的姿态角约束为αij=0,i=3,4;j=1,2,3;
后腿步态2:步态的姿态角约束为αi1=0,αi2+αi3=90°,αi2∈[0°,90°],i=3,4;
后腿步态3:步态的姿态角约束为αi1∈[-30°,60°],αi2+αi3=90°,αi2∈[0°,90°],i=3,4;
后腿步态4:步态的姿态角约束为αi1∈[-30°,60°],αi2∈[-45°,90°],αi3=[0°,135°],i=3,4;
前腿步态1:步态的姿态角约束为αij=0,i=1,2;j=1,2,3;
前腿步态2:步态的姿态角约束为αi1=0,αi2+αi3=90°,αi2∈[0°,90°],i=1,2;
前腿步态3:姿态角约束为αi1∈[-30°,60°],αi2+αi3=90°,αi2∈[0°,90°],i=1,2;
前腿步态4:步态的姿态角约束为αi1∈[-30°,60°],αi2∈[-45°,90°],αi3=[0°,135°],i=1,2。
4.根据权利要求3所述的轮腿复合式移动平台步态控制方法,其特征在于,所述步骤(3)的具体切换过程为:
(3.1)低姿轮式向高姿轮式切换时,单腿简单步态切换过程是后腿步态1与前腿步态1同时切换为后腿步态2与前腿步态2,相应的角度关系为αi1,i=1,2,3,4保持不变,αi2,i=1,2,3,4同步增大到[0°,90°]之间的一个角度,同时αi3,i=1,2,3,4同步变为90°-αi2;
(3.2)低姿轮式向变结构适应性通行轮式切换时,单腿简单步态切换过程是后腿步态1与前腿步态1同时切换为后腿步态3与前腿步态3,与之相应的角度关系为αi1,i=1,2,3,4同步变化到[-30°,60°]之间的一个角度,αi2,i=1,2,3,4同步增大到[0°,90°]之间的一个角度,同时αi3,i=1,2,3,4同步变为90°-αi2;
(3.3)低姿轮式向腿式步态切换时,单腿简单步态切换过程是后腿步态1与前腿步态1同时切换为后腿步态4与前腿步态4,αi1,i=1,2,3,4分别在[-30°,60°]内进行角度调整,αi2,i=1,2,3,4分别在[-45°,90°]内进行调整,αi3,i=1,2,3,4分别在[0°,135°]内进行调整;
(3.4)低姿轮式向轮腿复合式运动步态切换时,根据地形条件,左、右后腿分别向后腿步态2、4,左右前腿分别向前腿步态2、4或者左、右后腿分别向后腿步态4、2,左右前腿分别向前腿步态4、2切换;
(3.5)高姿轮式向变结构适应性通行轮式切换时,单腿简单步态切换过程是后腿步态2与前腿步态2同时切换为后腿步态3与前腿步态3,角度关系为αi1,i=1,2,3,4同步变化到[-30°,60°]之间的一个角度,αi2,i=1,2,3,4运动范围保持不变,αi3,i=1,2,3,4同步变为90°-αi2;
(3.6)高姿轮式向腿式运动步态切换时,单腿简单步态切换过程是后腿步态2与前腿步态2同时切换为后腿步态4与前腿步态4,αi1,i=1,2,3,4分别在[-30°,60°]内进行角度调整,αi2,i=1,2,3,4分别在[-45°,90°]内进行调整,αi3,i=1,2,3,4分别在[0°,135°]内进行调整;
(3.7)高姿轮式向轮腿复合式运动步态切换时,根据地形条件,左、右后腿分别向后腿步态2、4,左右前腿分别向前腿步态2、4或者左、右后腿分别向后腿步态4、2,左右前腿分别向前腿步态4、2切换;
(3.8)变结构适应性通行轮式向腿式运动步态切换时,单腿简单步态切换过程是后腿步态3与前腿步态3同时切换为后腿步态4与前腿步态4,αi1,i=1,2,3,4分别在[-30°,60°]内进行角度调整,αi2,i=1,2,3,4分别在[-45°,90°]内进行调整,αi3,i=1,2,3,4分别在[0°,135°]内进行调整;
(3.9)变结构适应性通行轮式向轮腿复合式运动步态切换时,根据地形条件,左、右后腿分别向后腿步态2、4,左右前腿分别向前腿步态2、4或者左、右后腿分别向后腿步态4、2,左右前腿分别向前腿步态4、2切换;
(3.10)腿式向轮腿复合式运动步态切换时,根据地形条件,左、右后腿分别向后腿步态2、4,左右前腿分别向前腿步态2、4或者左、右后腿分别向后腿步态4、2,左右前腿分别向前腿步态4、2切换。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210339690.4A CN102841605B (zh) | 2012-09-14 | 2012-09-14 | 一种轮腿复合式移动平台步态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210339690.4A CN102841605B (zh) | 2012-09-14 | 2012-09-14 | 一种轮腿复合式移动平台步态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102841605A CN102841605A (zh) | 2012-12-26 |
CN102841605B true CN102841605B (zh) | 2014-12-31 |
Family
ID=47369073
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210339690.4A Active CN102841605B (zh) | 2012-09-14 | 2012-09-14 | 一种轮腿复合式移动平台步态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102841605B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103223673B (zh) * | 2013-05-21 | 2015-10-28 | 重庆电子工程职业学院 | 轮腿式机器人的控制方法 |
CN105843222B (zh) * | 2016-03-18 | 2019-04-12 | 北京航空航天大学 | 一种六轮/腿机器人复合运动路径规划方法 |
CN116176726A (zh) * | 2023-03-23 | 2023-05-30 | 上海交通大学 | 一种全向移动的轮腿机器人及其运动控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4265326A (en) * | 1978-02-22 | 1981-05-05 | Willy Habegger | Rolling and stepping vehicle |
CN101850795A (zh) * | 2010-05-26 | 2010-10-06 | 河北工业大学 | 一种轮腿复合式移动机器人平台 |
CN202320579U (zh) * | 2011-11-21 | 2012-07-11 | 上海市第二中学 | 轮腿式混合移动基座 |
CN102616297A (zh) * | 2012-04-11 | 2012-08-01 | 中国人民解放军国防科学技术大学 | 轮腿复合式运动平台 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5069538B2 (ja) * | 2007-10-26 | 2012-11-07 | 株式会社Ihi | 脚式移動体の操縦方法及び脚式移動体 |
-
2012
- 2012-09-14 CN CN201210339690.4A patent/CN102841605B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4265326A (en) * | 1978-02-22 | 1981-05-05 | Willy Habegger | Rolling and stepping vehicle |
CN101850795A (zh) * | 2010-05-26 | 2010-10-06 | 河北工业大学 | 一种轮腿复合式移动机器人平台 |
CN202320579U (zh) * | 2011-11-21 | 2012-07-11 | 上海市第二中学 | 轮腿式混合移动基座 |
CN102616297A (zh) * | 2012-04-11 | 2012-08-01 | 中国人民解放军国防科学技术大学 | 轮腿复合式运动平台 |
Also Published As
Publication number | Publication date |
---|---|
CN102841605A (zh) | 2012-12-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105667622A (zh) | 一种具有三段机体的六轮足式移动机器人 | |
CN107554637B (zh) | 一种六足越障机器人 | |
CN109227544A (zh) | 一种c型腿六足小车全地形机器人 | |
CN105242677B (zh) | 四足机器人双足支撑相位力位混合控制方法 | |
CN109501880A (zh) | 独轮双足行走机器人 | |
CN107807655A (zh) | 基于三维空间中步态调整的四足机器人平衡稳定控制方法 | |
CN102841605B (zh) | 一种轮腿复合式移动平台步态控制方法 | |
CN105292298A (zh) | 一种融合运输与作业功能的三段机体式六足机器人 | |
CN208165135U (zh) | 一种轮腿式并联移动机器人 | |
CN102431604A (zh) | 具有双足步行与轮式移动互变功能的仿人机器人 | |
CN110039544A (zh) | 基于三次样条插值的仿人足球机器人步态规划 | |
CN105667624A (zh) | 电驱动四足仿生机器人 | |
CN114454983B (zh) | 一种四足机器人转弯控制方法及系统 | |
CN108705514A (zh) | 多模式两足行走机构 | |
CN102799184A (zh) | 仿生机械恐龙爬行稳定性控制方法 | |
CN206123679U (zh) | 一种高通过性变形人形机器人 | |
Bo et al. | Design and configuration of a hexapod walking robot | |
CN106608308A (zh) | 一种机器人 | |
CN112433535A (zh) | 轮步复合移动平台及越障模式下多关节协同的自回稳方法 | |
CN113552880B (zh) | 一种双足轮式机器人平衡控制方法 | |
Ye et al. | Multi-task control for a quadruped robot with changeable leg configuration | |
CN209350255U (zh) | 一种c型腿六足小车全地形机器人 | |
Lu et al. | A novel multi-configuration quadruped robot with redundant DOFs and its application scenario analysis | |
CN107933733B (zh) | 一种仿乌龟回项摆胫耦合翻转机器人 | |
CN115056880B (zh) | 一种多运动态机器人的运动态切换控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |