CN111914416B - 一种高能效轻量化结构双足机器人的逆运动学求解方法 - Google Patents

一种高能效轻量化结构双足机器人的逆运动学求解方法 Download PDF

Info

Publication number
CN111914416B
CN111914416B CN202010722914.4A CN202010722914A CN111914416B CN 111914416 B CN111914416 B CN 111914416B CN 202010722914 A CN202010722914 A CN 202010722914A CN 111914416 B CN111914416 B CN 111914416B
Authority
CN
China
Prior art keywords
robot
vector
joint
matrix
angle
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
Application number
CN202010722914.4A
Other languages
English (en)
Other versions
CN111914416A (zh
Inventor
袁海辉
施佳晨
顾建军
朱世强
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhejiang Lab
Original Assignee
Zhejiang Lab
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Zhejiang Lab filed Critical Zhejiang Lab
Priority to CN202010722914.4A priority Critical patent/CN111914416B/zh
Publication of CN111914416A publication Critical patent/CN111914416A/zh
Application granted granted Critical
Publication of CN111914416B publication Critical patent/CN111914416B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00Computer-aided design [CAD]
    • G06F30/20Design optimisation, verification or simulation
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F2111/00Details relating to CAD techniques
    • G06F2111/10Numerical modelling

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Computer Hardware Design (AREA)
  • Evolutionary Computation (AREA)
  • Geometry (AREA)
  • General Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Manipulator (AREA)

Abstract

本发明公开了一种高能效轻量化结构双足机器人的逆运动学求解方法,该方法采用旋量法建立机器人坐标系,并通过构造可表征姿态信息的矢量,构建出了可用于逆运动学求解的表达式方程,进而采用牛顿拉夫逊算法对机器人的逆运动学进行数值求解;该方法还进一步考虑了驱动连杆的存在,并采用解析方法计算出驱动电机实际需要转动的角度。本发明可用于机器人髋关节电机轴不相交的情形下进行逆运动学求解。

Description

一种高能效轻量化结构双足机器人的逆运动学求解方法
技术领域
本发明属于机器人技术领域,尤其涉及一种具有高能效轻量化腿足结构双足机器人的逆运动学求解方法。
背景技术
双足机器人是具有多个自由度的高维非线性系统,对其进行步态规划与控制是一项非常具有挑战性的工作。如何实现快速的步态规划一直是国内外研究人员重点关注的问题,它关系到双足机器人的实时性与鲁棒性能。为实现高实时性的步态规划,国内外研究人员目前一般先基于简化模型规划出机器人的质心(或躯干)以及落脚点轨迹,然后再利用逆运动学求解出机器人腿足各驱动关节的轨迹。
目前,国内外研究人员在进行双足机器人结构设计时常使其髋关节的三个电机轴交于一点,包括硕士论文《仿人机器人结构设计与分析》所述的浙江大学的ZJUKong,以及最近的期刊论文《Contact Force/Torque Control Based on Viscoelastic Model forStable Bipedal Walking on Indefinite Uneven Terrain》所述的北京理工大学的BHR-6P。当双足机器人髋关节的电机轴交于一点时,其逆运动学可采用解析方法进行几何求解,如最近的硕士论文《GTX-Ⅲ型双足机器人样机研制与行走实验研究》以及专利《基于闭环控制的仿人机器人全向行走方法》(专利号CN201310060399.8)所述。随着双足机器人技术的发展,国内外研究人员从追求走稳向追求走好发展。为实现高效步行,提高续航能力,国内外研究人员开始考虑高能效轻量化腿足结构布局。在此类布局设计中,一般以减轻机器人腿足结构的转动惯量作为主要优化目标,机器人驱动电机会往躯干方向布置以尽量减轻腿足结构的质量,并采用平行连杆进行驱动。在此情形下,机器人髋关节的电机轴不一定交于一点,从而难以采用几何解析方法进行逆运动学求解。此外,由于加入了连杆,如何从机器人的关节角度计算出驱动电机实际需要转动的角度,也需要进一步考虑。
发明内容
本发明的目的在于针对现有技术的不足,提供一种高能效轻量化结构双足机器人的逆运动学求解方法。
本发明的目的是通过以下技术方案来实现的:一种高能效轻量化结构双足机器人的逆运动学求解方法,包括以下步骤:
步骤一,采用旋量法建立机器人坐标系,并构造表征姿态信息的矢量,进而构建出用于逆运动学求解的表达式方程,根据期望的末端位置采用牛顿拉夫逊算法对机器人的逆运动学进行数值求解获得机器人各关节角度;
步骤二,基于步骤一得到的关节角度,采用几何方法计算出各关节驱动电机需要转动的角度。
进一步地,所述步骤一具体为:
首先,利用旋量法建立机器人坐标系并获得机器人位姿的表达式;在初始状态下,各关节角度为0,各关节的局部坐标系与世界坐标系平行;机器人第i个关节角度qi相对第i-1个关节角度qi-1的齐次变换矩阵
Figure BDA0002600668090000021
为:
Figure BDA0002600668090000022
其中,ai为关节角度qi的单位转轴向量,
Figure BDA0002600668090000023
表示由ai生成的斜对称矩阵,bi表示关节角度qi-1局部坐标系下qi局部坐标系原点的位置矢量,
Figure BDA0002600668090000024
的表达如下:
Figure BDA0002600668090000025
其中,E为单位矩阵;基于齐次转换矩阵
Figure BDA0002600668090000026
机器人关节角度qi的位姿矩阵为Ti
Figure BDA0002600668090000027
其中,Ri为关节角度qi的姿态矩阵,pi为关节角度qi的绝对位置矢量,R0和p0分别为机器人起始杆件的位姿矩阵和绝对位置矢量;基于位姿矩阵Ti,令第j个关节角度qj为机器人的末端关节角度,则机器人末端的位姿矩阵Tj为:
Figure BDA0002600668090000028
然后,基于机器人末端的位姿矩阵Tj,构建机器人逆运动学求解的表达式方程:
f(q)=fref
其中,
Figure BDA0002600668090000031
q=[q1,…,qj]T为机器人关节角度组成的向量,pref为末端位置矢量的期望值,向量vor构造如下:
vor=[M(1,1) M(2,2) M(3,3)]T
其中,矩阵
Figure BDA0002600668090000032
Figure BDA0002600668090000033
为机器人末端期望姿态矩阵Rref的转置;
接着,利用牛顿拉夫逊算法对方程f(q)=fref进行求解,方程求解的迭代方程如下:
Xk=Xk-1-J-1(f(Xk-1)-fref)
其中,Xk为向量q在第k次的迭代值;
Figure BDA0002600668090000034
J-1为J的逆,X0为关节角度向量q的初始估计值;当向量f(Xk)-fref的欧几里得范数小于阈值λ时,迭代终止,最终得到关节角度向量q=Xk
进一步地,所述阈值λ=10-7
进一步地,所述步骤二中,机器人踝关节驱动电机的输出曲柄、连杆以及起始杆件构成空间四边形,计算采用踝关节驱动电机需要转动的角度具体为:首先,找到该空间四边形中可基于局部坐标系表示的三个顶点,即连杆与脚掌的连接点、电机输出曲柄与电机的连接点以及机器人起始杆件上的一个固定点;该固定点位于电机输出曲柄的运动平面内,以便基于该固定点表达电机的转动角度;并在局部坐标系下对三个顶点进行表达;然后,将电机输出曲柄末端的位置表示为电机转动角度的函数,进而表示出连杆在局部坐标系下的位置向量;最后,根据连杆的长度为定值,计算出踝关节驱动电机实际需要转动的角度。
本发明的有益效果在于:本发明可用于机器人髋关节电机轴不相交的情形,通过构造可表征姿态信息的矢量,构建出了可用于逆运动学求解的表达式方程,并进一步采用牛顿拉夫逊算法对机器人的逆运动学进行数值求解;还进一步考虑了驱动连杆的存在,并采用几何方法计算出驱动电机实际需要转动的角度。
附图说明
图1为具有高能效轻量化腿足结构的双足机器人示意图;其中,a为机器人结构示意图,b为机器人左腿关节角度与尺寸示意图。
具体实施方式
以下结合附图和实施例对本发明作进一步说明。
本发明所提供的一种高能效轻量化结构双足机器人的逆运动学求解方法,包含如下步骤:
步骤一,采用旋量法建立机器人坐标系,并构造出可表征姿态信息的矢量,进而构建出可用于逆运动学求解的表达式方程,并进一步采用牛顿拉夫逊算法对机器人的逆运动学进行数值求解,以获得机器人各关节角度:
首先,利用旋量法建立具有高能效轻量化腿足结构双足机器人的坐标系,并获得机器人位姿的表达式。机器人各关节局部坐标系如图1所示,机器人起始杆件(即脚掌)绝对位置矢量为p0,其姿态矩阵为R0;q1为踝关节俯仰角度,q1对应的转动轴矢量a1=[1,0,0]T、相对位置矢量b1=[0,0,0]T;q2为踝关节滚动角度,q2对应的转动轴矢量a2=[0,1,0]T、相对位置矢量b2=[0,0,0]T;q3为膝关节俯仰角度,q3对应的转动轴矢量a3=[1,0,0]T、相对位置矢量b3=[0,0,l1]T;q4为髋关节俯仰角度,q4对应的转动轴矢量a4=[1,0,0]T、相对位置矢量b4=[0,0,l2]T;q5为髋关节旋转角度,q5对应的转动轴矢量a5=[0,0,1]T、相对位置矢量b5=[0,0,0]T;q6为髋关节滚动角度,q6对应的转动轴矢量a6=[0,1,0]T、相对位置矢量b6=[0,0,l3]T;髋关节绝对位置矢量为p6,其姿态矩阵为R6;其中,l1为小腿的长度,l2为大腿的长度,l3为髋关节到躯干的距离;本实施例中l1=0.275m,l2=0.275m,l3=0.05m。
在初始状态下,各关节角度为0,此时选取各关节的局部坐标系与世界坐标系W平行。在此局部坐标系下,机器人关节角度qi(i=1~6)相对关节角度qi-1的齐次变换矩阵
Figure BDA0002600668090000041
为:
Figure BDA0002600668090000042
其中,ai为关节角度qi的单位转轴向量,
Figure BDA0002600668090000043
表示由ai生成的斜对称矩阵,bi表示关节角度qi-1局部坐标系下qi局部坐标系原点的位置矢量,
Figure BDA0002600668090000044
表达如下:
Figure BDA0002600668090000045
其中,E为单位矩阵。基于齐次转换矩阵
Figure BDA0002600668090000051
机器人关节角度qi的位姿矩阵Ti为:
Figure BDA0002600668090000052
其中,Ri(i=0,6)为关节角度qi的姿态矩阵,pi(i=0,6)为关节qi的绝对位置矢量,R0和p0分别为机器人起始杆件的位姿矩阵和绝对位置矢量。基于上述位姿矩阵表达式,设q6为机器人的末端关节,则机器人末端的位姿矩阵可表示为:
Figure BDA0002600668090000053
然后,基于机器人末端的位姿矩阵,构建机器人逆运动学求解的表达式方程:
f(q)=fref
其中,
Figure BDA0002600668090000054
q=[q1,q2,q3,q4,q5,q6]T为机器人关节角度所组成的向量,pref为末端位置矢量的期望值;向量vor构造如下:
vor=[M(1,1) M(2,2) M(3,3)]T
其中,矩阵
Figure BDA0002600668090000055
Figure BDA0002600668090000056
为机器人末端期望姿态矩阵Rref的转置。构造vor的原理在于,当末端姿态矩阵Rj=Rref时,
Figure BDA0002600668090000057
为单位矩阵E,从而取M的对角线元素构造目标向量vor。本实施例取pref=[0 -0.1234 0.5841]T
Figure BDA0002600668090000058
接着,利用牛顿拉夫逊算法对方程f(q)=fref进行求解,方程求解的迭代方程如下所示:
Xk=Xk-1-J-1(f(Xk-1)-fref)
其中,Xk为向量q在第k次的迭代值;
Figure BDA0002600668090000059
J-1为J的逆;X0为关节角度向量q的初始估计值。当向量f(Xk)-fref的欧几里得范数小于某一足够小的阈值λ=10-7时,迭代终止,最终获得q=[0.1 0 0.2 0 0.5235 0.6283]T
步骤二,基于步骤一所求解的关节角度q,采用几何方法计算出驱动电机实际需要转动的角度。本实施例以踝关节右侧驱动电机的转动值qm为例进行计算,其余关节的驱动电机可类似处理:
首先,如图1b所示,基于驱动电机曲柄pa1-pa2与连杆pa2-pa3构建空间四边形pa1pa2pa3pa4,其中pa4为机器人小腿杆件上选择的一个任意已知点,满足pa1pa4与pa1pa2间的夹角即为电机实际需要的转动角度;然后,在局部坐标系下,对三个顶点pa1、pa3、pa4进行表达,并将pa2的位置表示为qm的函数,再进一步在局部坐标系下表示向量pa3pa2;最后,根据连杆pa2-pa3长度为一定值,即可求解出电机的实际转动角度qm=-0.1。
以上实施例仅用于说明本发明的设计思想和特点,其目的在于使本领域内的技术人员能够了解本发明的内容并据以实施,本发明的保护范围不限于上述实施例。所以,凡依据本发明所揭示的原理、设计思路所作的等同变化或修饰,均在本发明的保护范围之内。

Claims (3)

1.一种高能效轻量化结构双足机器人的逆运动学求解方法,其特征在于,包括以下步骤:
步骤一,采用旋量法建立机器人坐标系,并构造表征姿态信息的矢量,进而构建出用于逆运动学求解的表达式方程,根据期望的末端位置采用牛顿拉夫逊算法对机器人的逆运动学进行数值求解获得机器人各关节角度;
步骤二,基于步骤一得到的关节角度,采用几何方法计算出各关节驱动电机需要转动的角度;
所述步骤一具体为:
首先,利用旋量法建立机器人坐标系并获得机器人位姿的表达式;在初始状态下,各关节角度为0,各关节的局部坐标系与世界坐标系平行;机器人第i个关节角度qi相对第i-1个关节角度qi-1的齐次变换矩阵
Figure FDA0002937375370000011
为:
Figure FDA0002937375370000012
其中,ai为关节角度qi的单位转轴向量,
Figure FDA0002937375370000013
表示由ai生成的斜对称矩阵,bi表示关节角度qi-1局部坐标系下qi局部坐标系原点的位置矢量,
Figure FDA0002937375370000014
的表达如下:
Figure FDA0002937375370000015
其中,E为单位矩阵;基于齐次转换矩阵
Figure FDA0002937375370000016
机器人关节角度qi的位姿矩阵为Ti
Figure FDA0002937375370000017
其中,Ri为关节角度qi的姿态矩阵,pi为关节角度qi的绝对位置矢量,R0和p0分别为机器人起始杆件的位姿矩阵和绝对位置矢量;基于位姿矩阵Ti,令第j个关节角度qj为机器人的末端关节角度,则机器人末端的位姿矩阵Tj为:
Figure FDA0002937375370000018
然后,基于机器人末端的位姿矩阵Tj,构建机器人逆运动学求解的表达式方程:
f(q)=fref
其中,
Figure FDA0002937375370000021
q=[q1,…,qj]T为机器人关节角度组成的向量,pref为末端位置矢量的期望值,向量vor构造如下:
vor=[M(1,1) M(2,2) M(3,3)]T
其中,矩阵
Figure FDA0002937375370000022
Figure FDA0002937375370000023
为机器人末端期望姿态矩阵Rref的转置;
接着,利用牛顿拉夫逊算法对方程f(q)=fref进行求解,方程求解的迭代方程如下:
Xk=Xk-1-J-1(f(Xk-1)-fref)
其中,Xk为向量q在第k次的迭代值;
Figure FDA0002937375370000024
J-1为J的逆,X0为关节角度向量q的初始估计值;当向量f(Xk)-fref的欧几里得范数小于阈值λ时,迭代终止,最终得到关节角度向量q=Xk
2.如权利要求1所述高能效轻量化结构双足机器人的逆运动学求解方法,其特征在于,阈值λ=10-7
3.如权利要求1所述高能效轻量化结构双足机器人的逆运动学求解方法,其特征在于,所述步骤二中,机器人踝关节驱动电机的输出曲柄、连杆以及起始杆件构成空间四边形,计算采用踝关节驱动电机需要转动的角度具体为:首先,找到该空间四边形中可基于局部坐标系表示的三个顶点,即连杆与起始杆件的连接点、电机输出曲柄与电机的连接点以及机器人起始杆件上的一个固定点,所述固定点位于电机输出曲柄的运动平面内,并在局部坐标系下对三个顶点进行表达;然后,将电机输出曲柄末端的位置表示为电机转动角度的函数,进而表示出连杆在局部坐标系下的位置向量;最后,根据连杆的长度,计算出踝关节驱动电机实际需要转动的角度。
CN202010722914.4A 2020-07-24 2020-07-24 一种高能效轻量化结构双足机器人的逆运动学求解方法 Active CN111914416B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010722914.4A CN111914416B (zh) 2020-07-24 2020-07-24 一种高能效轻量化结构双足机器人的逆运动学求解方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010722914.4A CN111914416B (zh) 2020-07-24 2020-07-24 一种高能效轻量化结构双足机器人的逆运动学求解方法

Publications (2)

Publication Number Publication Date
CN111914416A CN111914416A (zh) 2020-11-10
CN111914416B true CN111914416B (zh) 2021-03-30

Family

ID=73280745

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010722914.4A Active CN111914416B (zh) 2020-07-24 2020-07-24 一种高能效轻量化结构双足机器人的逆运动学求解方法

Country Status (1)

Country Link
CN (1) CN111914416B (zh)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112882485B (zh) * 2021-01-25 2022-04-26 河南大学 一种双足机器人逆运动学的几何计算方法
CN113835429B (zh) * 2021-09-08 2024-07-05 南方科技大学 一种仿生双足机器人的控制方法及仿生双足机器人
CN114147720B (zh) * 2021-12-14 2024-04-02 杭州锐沃机器人科技有限公司 一种多自由度机械臂的逆运动学通用求解方法及装置
CN114355964B (zh) * 2021-12-29 2023-08-18 深圳市优必选科技股份有限公司 多自由度单腿运动学求解方法、装置和机器人
CN114002990B (zh) * 2021-12-30 2022-04-08 之江实验室 并联双足机器人关节实时控制方法和装置
CN115994288B (zh) * 2023-01-11 2023-10-13 中国兵器装备集团自动化研究所有限公司 一种双足机器人逆运动学求解方法及装置
CN116304512B (zh) * 2023-03-16 2024-01-30 中国兵器装备集团自动化研究所有限公司 一种机器人腿部的逆运动学求解方法及装置
CN116859978B (zh) * 2023-08-08 2024-05-03 之江实验室 一种双足机器人踝关节控制的逆运动学求解方法及装置

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110634161A (zh) * 2019-08-30 2019-12-31 哈尔滨工业大学(深圳) 一种基于点云数据的工件位姿快速高精度估算方法及装置

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009099082A (ja) * 2007-10-19 2009-05-07 Sony Corp 力学シミュレーション装置及び力学シミュレーション方法、並びにコンピュータ・プログラム
CN103499922A (zh) * 2013-09-16 2014-01-08 北京邮电大学 一种基于fpga的七自由度空间机械臂运动学实时解算方法
CN110434851B (zh) * 2019-06-24 2020-11-27 浙江工业大学 一种5自由度机械臂逆运动学求解方法

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110634161A (zh) * 2019-08-30 2019-12-31 哈尔滨工业大学(深圳) 一种基于点云数据的工件位姿快速高精度估算方法及装置

Also Published As

Publication number Publication date
CN111914416A (zh) 2020-11-10

Similar Documents

Publication Publication Date Title
CN111914416B (zh) 一种高能效轻量化结构双足机器人的逆运动学求解方法
Wu et al. Design and analysis of a novel octopod platform with a reconfigurable trunk
CN108009680A (zh) 基于多目标粒子群算法的仿人机器人步态规划方法
CN106363633A (zh) 基于改良粒子群算法的机器人稳定步态规划方法和装置
Khadiv et al. Dynamics modeling of fully-actuated humanoids with general robot-environment interaction
Harada et al. Limit cycle based walk of a powered 7DOF 3D biped with flat feet
Sun et al. Rhex-t3: A transformable hexapod robot with ladder climbing function
Miao et al. Biped walking robot based on a 2-UPU+ 2-UU parallel mechanism
WO2024066868A1 (zh) 机器人控制方法、装置、机器人、计算机可读存储介质及计算机程序产品
Hodoshima et al. Development of ASURA I: harvestman-like hexapod walking robot—approach for Long-legged robot and leg mechanism design
Chavdarov Walking robot realized through 3D printing
Chen et al. Position-posture trajectory tracking of a six-legged walking robot
Sadedel et al. Heel-strike and toe-off motions optimization for humanoid robots equipped with active toe joints
Liu et al. A stable walking strategy of quadruped robot based on foot trajectory planning
Silva et al. Energy analysis of multi-legged locomotion systems
Wang et al. Kinematic analysis of snake-like robot using sliding joints
Xu et al. Trajectory planning of jumping over obstacles for hopping robot
Pelit et al. Effects of passive biarticular muscles on walking performance for bipedal robots
Ali et al. Bipedal robot walking strategy on inclined surfaces using position and orientation based inverse kinematics algorithm
Xiao et al. Improvement of winding gait for snake robot
Li et al. A Method of Foot Trajectory Generation for Quadruped Robots in Swing Phase to Optimize the Joint Torque
Xinxing et al. Simulation and experiment of legs-stride forward and overcoming obstacle gait of walking robot based on double 6-UPU parallel mechanism.
Pan et al. Gait and simulation analysis of quadruped crawling robot based on metamorphic structure
Leng et al. Falling forward of humanoid robot based on similarity with parametric optimum
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