CN108614427A - 一种四足机器人应激控制方法和装置 - Google Patents
一种四足机器人应激控制方法和装置 Download PDFInfo
- Publication number
- CN108614427A CN108614427A CN201810579632.6A CN201810579632A CN108614427A CN 108614427 A CN108614427 A CN 108614427A CN 201810579632 A CN201810579632 A CN 201810579632A CN 108614427 A CN108614427 A CN 108614427A
- Authority
- CN
- China
- Prior art keywords
- indicate
- foot
- fuselage
- leg
- equation
- 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
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
Abstract
本发明提供一种四足机器人应激控制方法和装置,先确定四足机器人简化模型中虚拟腿的动力学方程,然后确定足部支撑运动轨迹规划方程,最后对四足机器人进行应激控制,四足机器人不容易损坏,避免安装力传感器,降低了成本,可靠性高,且能够提高四足机器人应激能力,控制过程具有平稳性和柔顺性。本发明中竖直方向运动轨迹规划方程基于三角函数轨迹规划,易于实现,通过可变的高度支撑幅度,能够灵活有效控制机身的高度,且提高了机身的支撑柔顺性,且根据足部支撑运动轨迹规划方程和足部受到的竖直方向力对四足机器人进行应激控制,充分考虑支撑机身的外部柔顺作用力,足部接触柔顺性高。
Description
技术领域
本发明涉及机器人运动控制领域,具体涉及一种四足机器人应激控制方法和装置。
背景技术
相比于传统的轮式或履带式车辆,四足机器人可通过选择离散的摆动腿落足点,因此可适应高原、山地等复杂地形,现有技术中四足机器人的控制方法主要有位置伺服控制与力伺服控制。位置伺服控制对于四足机器人在复杂环境下的应激能力较差,且容易造成四足机器人的损坏。力伺服控制主要有主动力反馈控制与阻抗力控制,主动力反馈控制与阻抗力控制对于四足机器人与地面的作用较为柔顺,均可实现四足机器人的力柔顺性控制,且在复杂越野环境下具有较好的行走稳定性。主动力反馈控制需安装力传感器,导致成本高,且可靠性较低;阻抗力控制需要先规划足部支撑轨迹,并获取足地接触位置,然而现有技术中未充分考虑足部支撑轨迹规划的柔顺性与平稳性,且未充分考虑外部作用力的柔顺性,导致应激能力差。
发明内容
为克服现有技术中四足机器人容易损坏、成本高、可靠性较低且应激能力差的不足,本发明提供一种四足机器人应激控制方法和装置,先确定预先构建的四足机器人简化模型中虚拟腿的动力学方程,然后根据虚拟腿的动力学方程确定足部支撑运动轨迹规划方程,最后根据足部支撑运动轨迹规划方程和足部受到的竖直方向力对四足机器人进行应激控制,四足机器人不容易损坏,避免安装力传感器,降低了成本,可靠性高,且能够提高四足机器人应激能力,控制过程具有平稳性和柔顺性。
为了实现上述发明目的,本发明采取如下技术方案:
一方面,本发明提供一种四足机器人应激控制方法,包括:
确定预先构建的四足机器人简化模型中虚拟腿的动力学方程;
根据虚拟腿的动力学方程确定足部支撑运动轨迹规划方程;
根据足部支撑运动轨迹规划方程和足部受到的竖直方向力对四足机器人进行应激控制。
所述确定预先构建的四足机器人简化模型中虚拟腿的动力学方程之前,包括:
按照下述过程构建四足机器人简化模型:
基于四足机器人的对角小跑步态特性和对称运动特性,将由成对角关系的两条支撑腿构成的第一组对角腿简化为第一虚拟腿,并将其余两条支撑腿构成的第二组对角腿简化为第二虚拟腿;
所述第一虚拟腿和第二虚拟腿分别和机身连接,所述第一虚拟腿的长度第二虚拟腿的长度相等。
所述虚拟腿的动力学方程包括足地接触水平方向动力学方程、足地接触竖直方向动力学方程和机身转动动力学方程。
所述足地接触水平方向动力学方程按下式确定:
其中,x表示机身水平方向位置,表示机身水平方向加速度,m表示机身质量,Ft表示足部受到的水平方向力,l表示虚拟腿的长度,τ表示机身惯性力矩,θ表示虚拟腿与竖直方向的夹角;
所述足地接触竖直方向动力学方程按下式确定:
其中,z表示机身竖直方向位置,表示机身的竖直方向加速度,g表示重力加速度,Fn表示足部受到的竖直方向力,且其中kp表示机身高度变化的刚度系数,kd表示机身高度变化的阻尼系数,zd表示机身的期望位置,为机身高度的变化速度;
所述机身转动动力学方程按下式确定:
其中,表示机身与水平面之间的姿态角,表示机体与水平面之间的姿态角加速度,I表示机身主惯性矩。
所述足部支撑运动轨迹规划方程包括水平方向运动轨迹规划方程和竖直方向运动轨迹规划方程;
所述根据虚拟腿的动力学方程确定足部支撑运动轨迹规划方程,包括:
基于不考虑机身惯性力矩时满足按下式确定水平方向运动轨迹规划方程:
其中,xp(t)表示t时刻的足部水平方向位置,且xp(t)=-x(t),x(t)表示t时刻的机身水平方向位置;表示t时刻的足部水平方向速度;xp(0)表示足部水平方向初始位置,且 表示零时刻的足部水平方向初始速度,且ω表示线性倒立摆的角频率,λ表示水平方向支撑跨度,Ts表示支撑离地时刻,xp(Ts)表示支撑离地时刻的足部水平方向位置,表示支撑离地时刻的足部水平方向位置;
按下式确定竖直方向运动轨迹规划方程:
其中,zp(t)表示t时刻的足部竖直方向位置,且zp(t)=-z(t)-z0,z(t)表示t时刻的机身竖直方向位置;z0表示机身的恒定高度,A表示高度支撑幅度。
所述根据足部支撑运动轨迹规划方程和足部受到的竖直方向力对四足机器人进行应激控制,包括:
按下式确定第i条支撑腿的足地接触反馈力:
其中,表示第i条支撑腿的足地接触反馈力,表示第i条支撑腿受到的竖直方向力,其根据确定,N表示支撑腿的数量;表示第i条支撑腿的足部与地面之间的柔顺控制力,且kfp表示足部力伺服的刚度系数,kfd足部力伺服的阻尼系数,表示第i条支撑腿对应的足部期望位置,pi表示第i条支撑腿对应的足部实际位置,表示第i条支撑腿对应的足部位置变化速度;
通过将支撑腿多自由度的雅可比矩阵映射到关节,实现多自由度的柔顺控制,其中,T表示转置,J表示支撑腿多自由度的雅可比矩阵,表示第i条支撑腿的多自由度力矩输入。
另一方面,本发明提供一种四足机器人应激控制装置,包括:
第一确定模块,用于确定预先构建的四足机器人简化模型中虚拟腿的动力学方程;
第二确定模块,用于根据虚拟腿的动力学方程确定足部支撑运动轨迹规划方程;
应激控制模块,用于根据足部支撑运动轨迹规划方程和足部受到的竖直方向力对四足机器人进行应激控制。
所述装置还包括:
建模模块,用于按照下述过程构建四足机器人简化模型:
基于四足机器人的对角小跑步态特性和对称运动特性,将由成对角关系的两条支撑腿构成的第一组对角腿简化为第一虚拟腿,并将其余两条支撑腿构成的第二组对角腿简化为第二虚拟腿;
所述第一虚拟腿和第二虚拟腿分别和机身连接,所述第一虚拟腿的长度第二虚拟腿的长度相等。
所述第一确定模块确定的虚拟腿的动力学方程包括足地接触水平方向动力学方程、足地接触竖直方向动力学方程和机身转动动力学方程;
所述足地接触水平方向动力学方程按下式确定:
其中,x表示机身水平方向位置,表示机身水平方向加速度,m表示机身质量,Ft表示足部受到的水平方向力,l表示虚拟腿的长度,τ表示机身惯性力矩,θ表示虚拟腿与竖直方向的夹角;
所述足地接触竖直方向动力学方程按下式确定:
其中,z表示机身竖直方向位置,表示机身的竖直方向加速度,g表示重力加速度,Fn表示足部受到的竖直方向力,且其中kp表示机身高度变化的刚度系数,kd表示机身高度变化的阻尼系数,zd表示机身的期望位置,为机身高度的变化速度;
所述机身转动动力学方程按下式确定:
其中,表示机身与水平面之间的姿态角,表示机体与水平面之间的姿态角加速度,I表示机身主惯性矩。
所述第二确定模块确定的足部支撑运动轨迹规划方程包括水平方向运动轨迹规划方程和竖直方向运动轨迹规划方程;
所述水平方向运动轨迹规划方程按下式确定:
其中,xp(t)表示t时刻的足部水平方向位置,且xp(t)=-x(t),x(t)表示t时刻的机身水平方向位置;表示t时刻的足部水平方向速度;xp(0)表示足部水平方向初始位置,且 表示零时刻的足部水平方向初始速度,且ω表示线性倒立摆的角频率,λ表示水平方向支撑跨度,Ts表示支撑离地时刻,xp(Ts)表示支撑离地时刻的足部水平方向位置,表示支撑离地时刻的足部水平方向位置;
所述竖直方向运动轨迹规划方程按下式确定:
其中,zp(t)表示t时刻的足部竖直方向位置,且zp(t)=-z(t)-z0,z(t)表示t时刻的机身竖直方向位置;z0表示机身的恒定高度,A表示高度支撑幅度。
所述应激控制模块具体用于:
按下式确定第i条支撑腿的足地接触反馈力:
其中,表示第i条支撑腿的足地接触反馈力,表示第i条支撑腿受到的竖直方向力,其根据确定,N表示支撑腿的数量;表示第i条支撑腿的足部与地面之间的柔顺控制力,且kfp表示足部力伺服的刚度系数,kfd足部力伺服的阻尼系数,表示第i条支撑腿对应的足部期望位置,pi表示第i条支撑腿对应的足部实际位置,表示第i条支撑腿对应的足部位置变化速度;
通过将支撑腿多自由度的雅可比矩阵映射到关节,实现多自由度的柔顺控制,其中,T表示转置,J表示支撑腿多自由度的雅可比矩阵,表示第i条支撑腿的多自由度力矩输入。
与最接近的现有技术相比,本发明提供的技术方案具有以下有益效果:
本发明提供四足机器人应激控制方法中,先确定预先构建的四足机器人简化模型中虚拟腿的动力学方程,然后根据虚拟腿的动力学方程确定足部支撑运动轨迹规划方程,最后根据足部支撑运动轨迹规划方程和足部受到的竖直方向力对四足机器人进行应激控制,四足机器人不容易损坏,避免安装力传感器,降低了成本,可靠性高,且能够提高四足机器人应激能力,控制过程具有平稳性和柔顺性;
本发明提供四足机器人应激控制装置包括第一确定模块、第二确定模块和应激控制模块,第一确定模块用于确定预先构建的四足机器人简化模型中虚拟腿的动力学方程,第二确定模块用于根据虚拟腿的动力学方程确定足部支撑运动轨迹规划方程,应激控制模块用于根据足部支撑运动轨迹规划方程和足部受到的竖直方向力对四足机器人进行应激控制,四足机器人不容易损坏,避免安装力传感器,降低了成本,可靠性高,且能够提高四足机器人应激能力,控制过程具有平稳性和柔顺性;
本发明通过对四足机器人进行简化,得到四足机器人简化模型,然后根据四足机器人简化模型确定虚拟腿的动力学方程,控制过程简单且可靠;
本发明提供的技术方案中的水平方向运动轨迹规划方程基于线性倒立摆模型规划,保证四足机器人运动平稳,竖直方向运动轨迹规划方程基于三角函数轨迹规划,易于实现,通过可变的高度支撑幅度,能够灵活有效控制机身的高度,且提高了机身的支撑柔顺性;
本发明提供的技术方案中根据足部支撑运动轨迹规划方程和足部受到的竖直方向力对四足机器人进行应激控制,充分考虑支撑机身的外部柔顺作用力,足部接触柔顺性高;
本发明提供的技术方案能够对四足机器人进行应激控制,控制成本低,且在复杂环境下使四足机器人具有较强的应激能力。
附图说明
图1是本发明实施例中四足机器人应激控制方法流程图;
图2是本发明实施例中四足机器人简化模型示意图;
图3是本发明实施例中虚拟腿的动力学示意图;
图4是本发明实施例中四足机器人足部支撑轨迹示意图;
图5是本发明实施例中四足机器人应激控制示意图。
具体实施方式
下面结合附图对本发明作进一步详细说明。
实施例1
本发明实施例1提供了一种四足机器人应激控制方法,具体流程图如图1所示,具体过程如下:
S101:确定预先构建的四足机器人简化模型中虚拟腿的动力学方程;
S102:根据虚拟腿的动力学方程确定足部支撑运动轨迹规划方程;
S103:根据足部支撑运动轨迹规划方程和足部受到的竖直方向力对四足机器人进行应激控制。
上述S101的确定预先构建的四足机器人简化模型中虚拟腿的动力学方程之前,可以构建如图2所示的四足机器人简化模型,图2中,A、B、C、D分别为四足机器人的四条实际的支撑腿,E表示机身,F表示虚拟腿,o表示原点,x、z表示轴,四足机器人简化模型具体按照下述过程构建:
由于四足机器人的步态包括支撑相与摆动相,支撑相与摆动相的时间设置为相等,四足机器人的对称运动特性包括对角腿同时支撑或同时离地,即同时支撑是对角腿同时处在支撑相,同时离地是对角腿同时处在摆动相。于是基于四足机器人的对角小跑步态特性和对称运动特性,将由成对角关系的两条支撑腿(比如图2中的支撑腿A和支撑腿D)构成的第一组对角腿简化为第一虚拟腿,并将其余两条支撑腿(如图2中的支撑腿B和支撑腿C)构成的第二组对角腿简化为第二虚拟腿;第一虚拟腿和第二虚拟腿可看作一条虚拟腿的支撑状态(支撑相)与摆动状态(摆动相)。
第一虚拟腿和第二虚拟腿分别和机身连接,第一虚拟腿的长度第二虚拟腿的长度相等。
虚拟腿的动力学示意图如图3所示,图3中,Ft表示足部受到的水平方向力,τ表示机身惯性力矩,θ表示虚拟腿与竖直方向的夹角,Fn表示足部受到的竖直方向力,表示机身与水平面之间的姿态角。于是上述S101中,虚拟腿的动力学方程包括足地接触水平方向动力学方程、足地接触竖直方向动力学方程和机身转动动力学方程共三个方程,具体如下:
1、足地接触水平方向动力学方程按下式确定:
其中,x表示机身水平方向位置,表示机身水平方向加速度,m表示机身质量,Ft表示足部受到的水平方向力,l表示虚拟腿的长度,τ表示机身惯性力矩,θ表示虚拟腿与竖直方向的夹角;
2、足地接触竖直方向动力学方程按下式确定:
其中,z表示机身竖直方向位置,表示机身的竖直方向加速度,θ表示虚拟腿与竖直方向的夹角,g表示重力加速度,Fn表示足部受到的竖直方向力,考虑到足部需支撑机身的重量及高度变化,其中kp表示机身高度变化的刚度系数,kd表示机身高度变化的阻尼系数,zd表示机身的期望位置,为机身高度的变化速度;
3、机身转动动力学方程按下式确定:
其中,表示机身与水平面之间的姿态角,表示机体与水平面之间的姿态角加速度,I表示机身主惯性矩。
四足机器人的足部支撑运动轨迹如图4所示,图4中,xp(t)表示t时刻的足部水平方向位置,zp(t)表示t时刻的足部竖直方向位置,Ts表示支撑离地时刻。于是上述S102中,根据虚拟腿的动力学方程确定的足部支撑运动轨迹规划方程包括水平方向运动轨迹规划方程和竖直方向运动轨迹规划方程;
根据虚拟腿的动力学方程确定足部支撑运动轨迹规划方程,包括:
基于不考虑机身惯性力矩时满足按下式确定水平方向运动轨迹规划方程:
其中,xp(t)表示t时刻的足部水平方向位置,且xp(t)=-x(t),x(t)表示t时刻的机身水平方向位置;表示t时刻的足部水平方向速度;xp(0)表示足部水平方向初始位置,且 表示零时刻的足部水平方向初始速度,且ω表示线性倒立摆的角频率,λ表示水平方向支撑跨度,Ts表示支撑离地时刻,xp(Ts)表示支撑离地时刻的足部水平方向位置,表示支撑离地时刻的足部水平方向位置;
按下式确定竖直方向运动轨迹规划方程:
其中,zp(t)表示t时刻的足部竖直方向位置,且zp(t)=-z(t)-z0,z(t)表示t时刻的机身竖直方向位置;z0表示机身的恒定高度,A表示高度支撑幅度。
四足机器人应激控制示意图如图5所示,图5中,表示第i条支撑腿的足地接触反馈力,表示第i条支撑腿受到的竖直方向力,kfp表示足部力伺服的刚度系数,kfd足部力伺服的阻尼系数,pi表示第i条支撑腿对应的足部实际位置。于是上述S103中,根据足部支撑运动轨迹规划方程和足部受到的竖直方向力对四足机器人进行应激控制的具体过程如下:
1)按下式确定第i条支撑腿的足地接触反馈力:
其中,表示第i条支撑腿的足地接触反馈力,表示第i条支撑腿受到的竖直方向力,其根据确定,N表示支撑腿的数量;表示第i条支撑腿的足部与地面之间的柔顺控制力,且kfp表示足部力伺服的刚度系数,kfd足部力伺服的阻尼系数,表示第i条支撑腿对应的足部期望位置,pi表示第i条支撑腿对应的足部实际位置,表示第i条支撑腿对应的足部位置变化速度;
2)通过将支撑腿多自由度的雅可比矩阵映射到关节,实现多自由度的柔顺控制,其中,T表示转置,J表示支撑腿多自由度的雅可比矩阵,表示第i条支撑腿的多自由度力矩输入。
实施例2
基于与实施例1同一发明构思,本发明实施例2提供了一种四足机器人应激控制装置,包括第一确定模块、第二确定模块和应激控制模块,下面分别介绍这几个模块的功能:
其中的第一确定模块,用于确定预先构建的四足机器人简化模型中虚拟腿的动力学方程;
其中的第二确定模块,用于根据虚拟腿的动力学方程确定足部支撑运动轨迹规划方程;
其中的应激控制模块,用于根据足部支撑运动轨迹规划方程和足部受到的竖直方向力对四足机器人进行应激控制。
本发明实施例2提供的四足机器人应激控制装置还包括建模模块,该建模模块用于按照下述过程构建四足机器人简化模型:
基于四足机器人的对角小跑步态特性和对称运动特性,将由成对角关系的两条支撑腿构成的第一组对角腿简化为第一虚拟腿,并将其余两条支撑腿构成的第二组对角腿简化为第二虚拟腿;第一虚拟腿和第二虚拟腿分别和机身连接,所述第一虚拟腿的长度第二虚拟腿的长度相等。
上述的第一确定模块确定的虚拟腿的动力学方程包括足地接触水平方向动力学方程、足地接触竖直方向动力学方程和机身转动动力学方程,具体如下:
1)足地接触水平方向动力学方程按下式确定:
其中,x表示机身水平方向位置,表示机身水平方向加速度,m表示机身质量,Ft表示足部受到的水平方向力,l表示虚拟腿的长度,τ表示机身惯性力矩;
2)足地接触竖直方向动力学方程按下式确定:
其中,z表示机身竖直方向位置,表示机身的竖直方向加速度,θ表示虚拟腿与竖直方向的夹角,g表示重力加速度,Fn表示足部受到的竖直方向力,且其中kp表示机身高度变化的刚度系数,kd表示机身高度变化的阻尼系数,zd表示机身的期望位置,为机身高度的变化速度;
3)机身转动动力学方程按下式确定:
其中,表示机身与水平面之间的姿态角,表示机体与水平面之间的姿态角加速度,I表示机身主惯性矩。
上述的第二确定模块确定的足部支撑运动轨迹规划方程包括水平方向运动轨迹规划方程和竖直方向运动轨迹规划方程,具体如下:
基于不考虑机身惯性力矩时满足水平方向运动轨迹规划方程按下式确定:
其中,xp(t)表示t时刻的足部水平方向位置,且xp(t)=-x(t),x(t)表示t时刻的机身水平方向位置;表示t时刻的足部水平方向速度;xp(0)表示足部水平方向初始位置,且 表示零时刻的足部水平方向初始速度,且ω表示线性倒立摆的角频率,λ表示水平方向支撑跨度,Ts表示支撑离地时刻,xp(Ts)表示支撑离地时刻的足部水平方向位置,表示支撑离地时刻的足部水平方向位置;
竖直方向运动轨迹规划方程按下式确定:
其中,zp(t)表示t时刻的足部竖直方向位置,且zp(t)=-z(t)-z0,z(t)表示t时刻的机身竖直方向位置;z0表示机身的恒定高度,A表示高度支撑幅度。
上述应激控制模块根据足部支撑运动轨迹规划方程和足部受到的竖直方向力对四足机器人进行应激控制的具体过程如下:
1)按下式确定第i条支撑腿的足地接触反馈力:
其中,表示第i条支撑腿的足地接触反馈力,表示第i条支撑腿受到的竖直方向力,其根据确定,N表示支撑腿的数量;表示第i条支撑腿的足部与地面之间的柔顺控制力,且kfp表示足部力伺服的刚度系数,kfd足部力伺服的阻尼系数,表示第i条支撑腿对应的足部期望位置,pi表示第i条支撑腿对应的足部实际位置,表示第i条支撑腿对应的足部位置变化速度;
2)通过将支撑腿多自由度的雅可比矩阵映射到关节,实现多自由度的柔顺控制,其中,T表示转置,J表示支撑腿多自由度的雅可比矩阵,表示第i条支撑腿的多自由度力矩输入。
为了描述的方便,以上所述装置的各部分以功能分为各种模块或单元分别描述。当然,在实施本申请时可以把各模块或单元的功能在同一个或多个软件或硬件中实现。
本领域内的技术人员应明白,本申请的实施例可提供为方法、系统、或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本申请是参照根据本申请实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
最后应当说明的是:以上实施例仅用以说明本发明的技术方案而非对其限制,所属领域的普通技术人员参照上述实施例依然可以对本发明的具体实施方式进行修改或者等同替换,这些未脱离本发明精神和范围的任何修改或者等同替换,均在申请待批的本发明的权利要求保护范围之内。
Claims (10)
1.一种四足机器人应激控制方法,其特征在于,包括:
确定预先构建的四足机器人简化模型中虚拟腿的动力学方程;
根据虚拟腿的动力学方程确定足部支撑运动轨迹规划方程;
根据足部支撑运动轨迹规划方程和足部受到的竖直方向力对四足机器人进行应激控制。
2.根据权利要求1所述的四足机器人应激控制方法,其特征在于,所述确定预先构建的四足机器人简化模型中虚拟腿的动力学方程之前,包括:
按照下述过程构建四足机器人简化模型:
基于四足机器人的对角小跑步态特性和对称运动特性,将由成对角关系的两条支撑腿构成的第一组对角腿简化为第一虚拟腿,并将其余两条支撑腿构成的第二组对角腿简化为第二虚拟腿;
所述第一虚拟腿和第二虚拟腿分别和机身连接,所述第一虚拟腿的长度第二虚拟腿的长度相等。
3.根据权利要求1所述的四足机器人应激控制方法,其特征在于,所述虚拟腿的动力学方程包括足地接触水平方向动力学方程、足地接触竖直方向动力学方程和机身转动动力学方程;
所述足地接触水平方向动力学方程按下式确定:
其中,x表示机身水平方向位置,表示机身水平方向加速度,m表示机身质量,Ft表示足部受到的水平方向力,l表示虚拟腿的长度,τ表示机身惯性力矩,θ表示虚拟腿与竖直方向的夹角;
所述足地接触竖直方向动力学方程按下式确定:
其中,z表示机身竖直方向位置,表示机身的竖直方向加速度,g表示重力加速度,Fn表示足部受到的竖直方向力,且其中kp表示机身高度变化的刚度系数,kd表示机身高度变化的阻尼系数,zd表示机身的期望位置,为机身高度的变化速度;
所述机身转动动力学方程按下式确定:
其中,表示机身与水平面之间的姿态角,表示机体与水平面之间的姿态角加速度,I表示机身主惯性矩。
4.根据权利要求3所述的四足机器人应激控制方法,其特征在于,所述足部支撑运动轨迹规划方程包括水平方向运动轨迹规划方程和竖直方向运动轨迹规划方程;
所述根据虚拟腿的动力学方程确定足部支撑运动轨迹规划方程,包括:
基于不考虑机身惯性力矩时满足按下式确定水平方向运动轨迹规划方程:
其中,xp(t)表示t时刻的足部水平方向位置,且xp(t)=-x(t),x(t)表示t时刻的机身水平方向位置;表示t时刻的足部水平方向速度;xp(0)表示足部水平方向初始位置,且 表示零时刻的足部水平方向初始速度,且ω表示线性倒立摆的角频率,λ表示水平方向支撑跨度,Ts表示支撑离地时刻,xp(Ts)表示支撑离地时刻的足部水平方向位置,表示支撑离地时刻的足部水平方向位置;
按下式确定竖直方向运动轨迹规划方程:
其中,zp(t)表示t时刻的足部竖直方向位置,且zp(t)=-z(t)-z0,z(t)表示t时刻的机身竖直方向位置;z0表示机身的恒定高度,A表示高度支撑幅度。
5.根据权利要求4所述的四足机器人应激控制方法,其特征在于,所述根据足部支撑运动轨迹规划方程和足部受到的竖直方向力对四足机器人进行应激控制,包括:
按下式确定第i条支撑腿的足地接触反馈力:
其中,表示第i条支撑腿的足地接触反馈力,表示第i条支撑腿受到的竖直方向力,其根据确定,N表示支撑腿的数量;表示第i条支撑腿的足部与地面之间的柔顺控制力,且kfp表示足部力伺服的刚度系数,kfd足部力伺服的阻尼系数,表示第i条支撑腿对应的足部期望位置,pi表示第i条支撑腿对应的足部实际位置,表示第i条支撑腿对应的足部位置变化速度;
通过将支撑腿多自由度的雅可比矩阵映射到关节,实现多自由度的柔顺控制,其中,T表示转置,J表示支撑腿多自由度的雅可比矩阵,表示第i条支撑腿的多自由度力矩输入。
6.一种四足机器人应激控制装置,其特征在于,包括:
第一确定模块,用于确定预先构建的四足机器人简化模型中虚拟腿的动力学方程;
第二确定模块,用于根据虚拟腿的动力学方程确定足部支撑运动轨迹规划方程;
应激控制模块,用于根据足部支撑运动轨迹规划方程和足部受到的竖直方向力对四足机器人进行应激控制。
7.根据权利要求6所述的四足机器人应激控制装置,其特征在于,所述装置还包括:
建模模块,用于按照下述过程构建四足机器人简化模型:
基于四足机器人的对角小跑步态特性和对称运动特性,将由成对角关系的两条支撑腿构成的第一组对角腿简化为第一虚拟腿,并将其余两条支撑腿构成的第二组对角腿简化为第二虚拟腿;
所述第一虚拟腿和第二虚拟腿分别和机身连接,所述第一虚拟腿的长度第二虚拟腿的长度相等。
8.根据权利要求6所述的四足机器人应激控制装置,其特征在于,所述第一确定模块确定的虚拟腿的动力学方程包括足地接触水平方向动力学方程、足地接触竖直方向动力学方程和机身转动动力学方程;
所述足地接触水平方向动力学方程按下式确定:
其中,x表示机身水平方向位置,表示机身水平方向加速度,m表示机身质量,Ft表示足部受到的水平方向力,l表示虚拟腿的长度,τ表示机身惯性力矩,θ表示虚拟腿与竖直方向的夹角;
所述足地接触竖直方向动力学方程按下式确定:
其中,z表示机身竖直方向位置,表示机身的竖直方向加速度,g表示重力加速度,Fn表示足部受到的竖直方向力,且其中kp表示机身高度变化的刚度系数,kd表示机身高度变化的阻尼系数,zd表示机身的期望位置,为机身高度的变化速度;
所述机身转动动力学方程按下式确定:
其中,表示机身与水平面之间的姿态角,表示机体与水平面之间的姿态角加速度,I表示机身主惯性矩。
9.根据权利要求8所述的四足机器人应激控制装置,其特征在于,所述第二确定模块确定的足部支撑运动轨迹规划方程包括水平方向运动轨迹规划方程和竖直方向运动轨迹规划方程;
所述水平方向运动轨迹规划方程按下式确定:
其中,xp(t)表示t时刻的足部水平方向位置,且xp(t)=-x(t),x(t)表示t时刻的机身水平方向位置;表示t时刻的足部水平方向速度;xp(0)表示足部水平方向初始位置,且 表示零时刻的足部水平方向初始速度,且ω表示线性倒立摆的角频率,λ表示水平方向支撑跨度,Ts表示支撑离地时刻,xp(Ts)表示支撑离地时刻的足部水平方向位置,表示支撑离地时刻的足部水平方向位置;
所述竖直方向运动轨迹规划方程按下式确定:
其中,zp(t)表示t时刻的足部竖直方向位置,且zp(t)=-z(t)-z0,z(t)表示t时刻的机身竖直方向位置;z0表示机身的恒定高度,A表示高度支撑幅度。
10.根据权利要求9所述的四足机器人应激控制装置,其特征在于,所述应激控制模块具体用于:
按下式确定第i条支撑腿的足地接触反馈力:
其中,表示第i条支撑腿的足地接触反馈力,表示第i条支撑腿受到的竖直方向力,其根据确定,N表示支撑腿的数量;表示第i条支撑腿的足部与地面之间的柔顺控制力,且kfp表示足部力伺服的刚度系数,kfd足部力伺服的阻尼系数,表示第i条支撑腿对应的足部期望位置,pi表示第i条支撑腿对应的足部实际位置,表示第i条支撑腿对应的足部位置变化速度;
通过将支撑腿多自由度的雅可比矩阵映射到关节,实现多自由度的柔顺控制,其中,T表示转置,J表示支撑腿多自由度的雅可比矩阵,表示第i条支撑腿的多自由度力矩输入。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810579632.6A CN108614427B (zh) | 2018-06-07 | 2018-06-07 | 一种四足机器人应激控制方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810579632.6A CN108614427B (zh) | 2018-06-07 | 2018-06-07 | 一种四足机器人应激控制方法和装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108614427A true CN108614427A (zh) | 2018-10-02 |
CN108614427B CN108614427B (zh) | 2022-06-17 |
Family
ID=63664859
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810579632.6A Active CN108614427B (zh) | 2018-06-07 | 2018-06-07 | 一种四足机器人应激控制方法和装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108614427B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111438694A (zh) * | 2020-05-21 | 2020-07-24 | 中国计量大学 | 一种基于双生成函数的四足机器人对角步态规划方法 |
CN111475949A (zh) * | 2020-04-09 | 2020-07-31 | 淮阴工学院 | 一种基于行人足底力提取腿部动力特征值的方法 |
CN112207825A (zh) * | 2020-09-28 | 2021-01-12 | 杭州云深处科技有限公司 | 一种四足机器人仿生跳跃动作的控制方法、装置、电子设备及计算机可读介质 |
CN113524177A (zh) * | 2021-06-25 | 2021-10-22 | 南方科技大学 | 一种足式机器人的控制方法 |
CN115202372A (zh) * | 2022-09-19 | 2022-10-18 | 泰州朵儿智能科技有限公司 | 一种基于足端力调节的仿生四足机器人控制系统及方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050110448A1 (en) * | 2002-01-18 | 2005-05-26 | Honda Giken Kogyo Kabushiki Kaisha | Controller of legged mobile robot |
CN103112517A (zh) * | 2013-01-22 | 2013-05-22 | 北京理工大学 | 一种调节四足机器人身体姿态的方法和装置 |
CN105137969A (zh) * | 2015-07-31 | 2015-12-09 | 中国人民解放军国防科学技术大学 | 基于支撑线运动分解的四足机器人trot步态本体位姿控制方法 |
CN105242677A (zh) * | 2015-07-31 | 2016-01-13 | 中国人民解放军国防科学技术大学 | 四足机器人双足支撑相位力位混合控制方法 |
CN105945979A (zh) * | 2016-07-08 | 2016-09-21 | 上海航天控制技术研究所 | 对欠驱动二指爪机构进行柔顺控制的方法 |
CN107256284A (zh) * | 2017-05-10 | 2017-10-17 | 中国北方车辆研究所 | 一种实时交互式四足机器人多步态动力学建模方法及系统 |
-
2018
- 2018-06-07 CN CN201810579632.6A patent/CN108614427B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050110448A1 (en) * | 2002-01-18 | 2005-05-26 | Honda Giken Kogyo Kabushiki Kaisha | Controller of legged mobile robot |
CN103112517A (zh) * | 2013-01-22 | 2013-05-22 | 北京理工大学 | 一种调节四足机器人身体姿态的方法和装置 |
CN105137969A (zh) * | 2015-07-31 | 2015-12-09 | 中国人民解放军国防科学技术大学 | 基于支撑线运动分解的四足机器人trot步态本体位姿控制方法 |
CN105242677A (zh) * | 2015-07-31 | 2016-01-13 | 中国人民解放军国防科学技术大学 | 四足机器人双足支撑相位力位混合控制方法 |
CN105945979A (zh) * | 2016-07-08 | 2016-09-21 | 上海航天控制技术研究所 | 对欠驱动二指爪机构进行柔顺控制的方法 |
CN107256284A (zh) * | 2017-05-10 | 2017-10-17 | 中国北方车辆研究所 | 一种实时交互式四足机器人多步态动力学建模方法及系统 |
Non-Patent Citations (3)
Title |
---|
PENG XU 等: "An Efficient Autonomous Traction Control Method for Quadruped Robot", 《2017 IEEE INTERNATIONAL CONFERENCE ON UNMANNED SYSTEMS (ICUS)》 * |
柯贤锋 等: "基于力反馈的液压足式机器人主_被动柔顺性控制", 《机械工程学报》 * |
鄂明成 等: "一种粗糙地形下四足仿生机器人的柔顺步态生成方法", 《机器人》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111475949A (zh) * | 2020-04-09 | 2020-07-31 | 淮阴工学院 | 一种基于行人足底力提取腿部动力特征值的方法 |
CN111438694A (zh) * | 2020-05-21 | 2020-07-24 | 中国计量大学 | 一种基于双生成函数的四足机器人对角步态规划方法 |
CN112207825A (zh) * | 2020-09-28 | 2021-01-12 | 杭州云深处科技有限公司 | 一种四足机器人仿生跳跃动作的控制方法、装置、电子设备及计算机可读介质 |
CN113524177A (zh) * | 2021-06-25 | 2021-10-22 | 南方科技大学 | 一种足式机器人的控制方法 |
CN115202372A (zh) * | 2022-09-19 | 2022-10-18 | 泰州朵儿智能科技有限公司 | 一种基于足端力调节的仿生四足机器人控制系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108614427B (zh) | 2022-06-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108614427A (zh) | 一种四足机器人应激控制方法和装置 | |
CN109311159B (zh) | 一种具有增强的平衡运动和行为能力的移动机器人 | |
CN111891252A (zh) | 一种四足仿生机器人的身体姿态斜坡自适应控制方法 | |
CN106078752A (zh) | 一种基于Kinect的仿人机器人人体行为模仿方法 | |
CN106607910A (zh) | 一种机器人实时模仿方法 | |
CN105182770A (zh) | 一种基于旋翼飞行器的航天器半物理仿真实验系统及方法 | |
CN104723341A (zh) | 基于连接和阻尼配置的柔性关节机械臂的位置控制方法 | |
Shafii et al. | Omnidirectional walking and active balance for soccer humanoid robot | |
CN114641375A (zh) | 动态规划控制器 | |
Zheng et al. | Human motion tracking control with strict contact force constraints for floating-base humanoid robots | |
US20230234222A1 (en) | Humanoid robot balance control method, humanoid robot, and storage medium | |
CN107121128A (zh) | 一种足式机器人地形参数的测量方法及系统 | |
Szumowski et al. | Preview control applied for humanoid robot motion generation | |
Kim et al. | Dynamic behaviors on the NAO robot with closed-loop whole body operational space control | |
CN104238360B (zh) | 一种仿人机器人桌子-小车模型的Zc参数的获取方法 | |
CN114474066B (zh) | 一种智能人形机器人控制系统和方法 | |
Chen et al. | Design and dynamics modeling of a novel 2R1T 3-DOF parallel motion simulator | |
Abdolmaleki et al. | Omnidirectional walking with a compliant inverted pendulum model | |
CN109976384A (zh) | 一种自治水下机器人及路径跟随控制方法、装置 | |
CN112276947B (zh) | 一种机器人动作模仿方法、装置、设备及存储介质 | |
CN109709967B (zh) | 机器人低运算要求的动态步态的实现方法 | |
KR102110848B1 (ko) | 모듈러 타입 모션 플랫폼 기반 부하 정보 추정 방법 및 그 장치 | |
US10906178B2 (en) | Systems, devices, and methods for distributed graphical models in robotics | |
Lima et al. | Humanoid robot simulation with a joint trajectory optimized controller | |
Dung et al. | Humanoid climbing robot modeling in matlab-simechanics |
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 |