CN111914416B - 一种高能效轻量化结构双足机器人的逆运动学求解方法 - Google Patents
一种高能效轻量化结构双足机器人的逆运动学求解方法 Download PDFInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 24
- 239000011159 matrix material Substances 0.000 claims description 40
- 210000000544 articulatio talocruralis Anatomy 0.000 claims description 9
- 210000001503 joint Anatomy 0.000 claims description 8
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 2
- 210000004394 hip joint Anatomy 0.000 abstract description 9
- 238000004458 analytical method Methods 0.000 abstract description 4
- 210000002414 leg Anatomy 0.000 description 6
- 210000002683 foot Anatomy 0.000 description 5
- 238000013461 design Methods 0.000 description 4
- 230000005021 gait Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000005096 rolling process Methods 0.000 description 2
- BWMFRQKICHXLSH-ZZZNUFMVSA-N Grayanotoxin-III Natural products O[C@H]1[C@@H]2[C@@](O)(C)C[C@]31[C@H]([C@](O)(C)[C@H]1[C@](O)([C@H](O)C3)C(C)(C)[C@@H](O)C1)CC2 BWMFRQKICHXLSH-ZZZNUFMVSA-N 0.000 description 1
- 206010034701 Peroneal nerve palsy Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 210000001624 hip Anatomy 0.000 description 1
- 210000000629 knee joint Anatomy 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 210000000689 upper leg Anatomy 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F2111/00—Details relating to CAD techniques
- G06F2111/10—Numerical 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)所述。随着双足机器人技术的发展,国内外研究人员从追求走稳向追求走好发展。为实现高效步行,提高续航能力,国内外研究人员开始考虑高能效轻量化腿足结构布局。在此类布局设计中,一般以减轻机器人腿足结构的转动惯量作为主要优化目标,机器人驱动电机会往躯干方向布置以尽量减轻腿足结构的质量,并采用平行连杆进行驱动。在此情形下,机器人髋关节的电机轴不一定交于一点,从而难以采用几何解析方法进行逆运动学求解。此外,由于加入了连杆,如何从机器人的关节角度计算出驱动电机实际需要转动的角度,也需要进一步考虑。
发明内容
本发明的目的在于针对现有技术的不足,提供一种高能效轻量化结构双足机器人的逆运动学求解方法。
本发明的目的是通过以下技术方案来实现的:一种高能效轻量化结构双足机器人的逆运动学求解方法,包括以下步骤:
步骤一,采用旋量法建立机器人坐标系,并构造表征姿态信息的矢量,进而构建出用于逆运动学求解的表达式方程,根据期望的末端位置采用牛顿拉夫逊算法对机器人的逆运动学进行数值求解获得机器人各关节角度;
步骤二,基于步骤一得到的关节角度,采用几何方法计算出各关节驱动电机需要转动的角度。
进一步地,所述步骤一具体为:
其中,Ri为关节角度qi的姿态矩阵,pi为关节角度qi的绝对位置矢量,R0和p0分别为机器人起始杆件的位姿矩阵和绝对位置矢量;基于位姿矩阵Ti,令第j个关节角度qj为机器人的末端关节角度,则机器人末端的位姿矩阵Tj为:
然后,基于机器人末端的位姿矩阵Tj,构建机器人逆运动学求解的表达式方程:
f(q)=fref
vor=[M(1,1) M(2,2) M(3,3)]T
接着,利用牛顿拉夫逊算法对方程f(q)=fref进行求解,方程求解的迭代方程如下:
Xk=Xk-1-J-1(f(Xk-1)-fref)
进一步地,所述阈值λ=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。
其中,Ri(i=0,6)为关节角度qi的姿态矩阵,pi(i=0,6)为关节qi的绝对位置矢量,R0和p0分别为机器人起始杆件的位姿矩阵和绝对位置矢量。基于上述位姿矩阵表达式,设q6为机器人的末端关节,则机器人末端的位姿矩阵可表示为:
然后,基于机器人末端的位姿矩阵,构建机器人逆运动学求解的表达式方程:
f(q)=fref
vor=[M(1,1) M(2,2) M(3,3)]T
其中,矩阵 为机器人末端期望姿态矩阵Rref的转置。构造vor的原理在于,当末端姿态矩阵Rj=Rref时,为单位矩阵E,从而取M的对角线元素构造目标向量vor。本实施例取pref=[0 -0.1234 0.5841]T,
接着,利用牛顿拉夫逊算法对方程f(q)=fref进行求解,方程求解的迭代方程如下所示:
Xk=Xk-1-J-1(f(Xk-1)-fref)
其中,Xk为向量q在第k次的迭代值;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.一种高能效轻量化结构双足机器人的逆运动学求解方法,其特征在于,包括以下步骤:
步骤一,采用旋量法建立机器人坐标系,并构造表征姿态信息的矢量,进而构建出用于逆运动学求解的表达式方程,根据期望的末端位置采用牛顿拉夫逊算法对机器人的逆运动学进行数值求解获得机器人各关节角度;
步骤二,基于步骤一得到的关节角度,采用几何方法计算出各关节驱动电机需要转动的角度;
所述步骤一具体为:
其中,Ri为关节角度qi的姿态矩阵,pi为关节角度qi的绝对位置矢量,R0和p0分别为机器人起始杆件的位姿矩阵和绝对位置矢量;基于位姿矩阵Ti,令第j个关节角度qj为机器人的末端关节角度,则机器人末端的位姿矩阵Tj为:
然后,基于机器人末端的位姿矩阵Tj,构建机器人逆运动学求解的表达式方程:
f(q)=fref
vor=[M(1,1) M(2,2) M(3,3)]T
接着,利用牛顿拉夫逊算法对方程f(q)=fref进行求解,方程求解的迭代方程如下:
Xk=Xk-1-J-1(f(Xk-1)-fref)
2.如权利要求1所述高能效轻量化结构双足机器人的逆运动学求解方法,其特征在于,阈值λ=10-7。
3.如权利要求1所述高能效轻量化结构双足机器人的逆运动学求解方法,其特征在于,所述步骤二中,机器人踝关节驱动电机的输出曲柄、连杆以及起始杆件构成空间四边形,计算采用踝关节驱动电机需要转动的角度具体为:首先,找到该空间四边形中可基于局部坐标系表示的三个顶点,即连杆与起始杆件的连接点、电机输出曲柄与电机的连接点以及机器人起始杆件上的一个固定点,所述固定点位于电机输出曲柄的运动平面内,并在局部坐标系下对三个顶点进行表达;然后,将电机输出曲柄末端的位置表示为电机转动角度的函数,进而表示出连杆在局部坐标系下的位置向量;最后,根据连杆的长度,计算出踝关节驱动电机实际需要转动的角度。
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)
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)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110634161A (zh) * | 2019-08-30 | 2019-12-31 | 哈尔滨工业大学(深圳) | 一种基于点云数据的工件位姿快速高精度估算方法及装置 |
Family Cites Families (3)
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自由度机械臂逆运动学求解方法 |
-
2020
- 2020-07-24 CN CN202010722914.4A patent/CN111914416B/zh active Active
Patent Citations (1)
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 | |
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 | |
Hodoshima et al. | Development of ASURA I: harvestman-like hexapod walking robot—approach for Long-legged robot and leg mechanism design | |
Chen et al. | Position-posture trajectory tracking of a six-legged walking robot | |
Ezati et al. | Dynamics modeling of a biped robot with active toe joints | |
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 | |
Samadi et al. | Pattern generation for humanoid robot with natural ZMP trajectory | |
Pelit et al. | Effects of passive biarticular muscles on walking performance for bipedal robots | |
Xu et al. | Trajectory planning of jumping over obstacles for hopping robot | |
Liu et al. | Feedback control of the locomotion of a tailed quadruped robot | |
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. | |
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 | |
Liu et al. | The intelligent biped robot AIRO: System overview and omnidirectional walking method design | |
Sripada et al. | Biped robot vertical jumping with control constraints |
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 |