CN106845037B - 一种五自由度串联机器人的逆运动学通用求解方法 - Google Patents
一种五自由度串联机器人的逆运动学通用求解方法 Download PDFInfo
- Publication number
- CN106845037B CN106845037B CN201710168533.4A CN201710168533A CN106845037B CN 106845037 B CN106845037 B CN 106845037B CN 201710168533 A CN201710168533 A CN 201710168533A CN 106845037 B CN106845037 B CN 106845037B
- Authority
- CN
- China
- Prior art keywords
- formula
- joint
- expression
- robot
- wrist
- 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
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
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)
- Numerical Control (AREA)
Abstract
本发明公开了一种五自由度串联机器人的逆运动学通用求解方法,属于机器人逆运动学领域,本发明在指数积模型的基础上提出一种形式简单、易于计算的逆运动学通用求解方法,该发明主要将旋量理论的基本性质和Rodrigues旋转表达相结合简化了逆解求解过程,实现了在满足Pieper约束的条件下,不需要考虑前两个关节轴线之间的关系即可直接获得各关节的角度值,而且5个关节角度只需要2个表达式即可统一表达,为该类机器人在实际应用中提供了方便。
Description
技术领域
本发明属于机器人逆运动学领域,具体涉及一种五自由度串联机器人的逆运动学通用求解方法。
背景技术
机器人运动学是研究机器人末端姿态与各关节角度之间的关系,其中逆运动学是探讨在给定末端姿态的情况下,求解相对应的各关节角度值。逆运动学的求解精度直接影响机器人控制参数,即影响机器人最终的运动精度。对于串联机器人来说,逆解是不唯一的,它与机器人自身的结构有关。机器人逆解包括两大类:封闭解和数值解,其中数值解耗时、精度低;而封闭解则精度高、计算快,但其需要满足Pieper约束:三个相邻关节轴线交于一点或三个相邻关节轴线平行。目前大部分工业机器人采用末端三个关节轴线交于一点的结构,但即使在这样的约束条件下求逆解也是一件非常复杂的工作。Paden-Kahan等人提出一种将逆解问题化简成多个子问题进行求解的方法,该方法是基于POE(Product ofExponential)模型,相对D-H模型更加灵活、完备,这些子问题都是基于几何关系求解的,具有稳定的几何意义和数值稳定性,是近几年的研究热点。目前现有的子问题求解方法繁多,而且每一种子问题都有不同的求解方法,在应用的时候需要耗费时间去分析和计算,这为实际开发和应用带来很多不便。
发明内容
针对现有技术中存在的上述技术问题,本发明提出了一种五自由度串联机器人的逆运动学通用求解方法,设计合理,克服了现有技术的不足,具有良好的效果。
为了实现上述目的,本发明采用如下技术方案:
一种五自由度串联机器人的逆运动学通用求解方法,包括如下步骤:
步骤1:求解机器人的肩部关节角度θ1
根据指数积模型,机器人运动学方程可表示为:
且
其中,下标t和w分别表示末端工具坐标系与世界坐标系,θ是各关节的旋转角度向量θ=[θ1,...,θ5],gwt(0)和gwt(θ)分别表示在初始状态下和θ状态下末端工具坐标系相对世界坐标系的变换关系,为第i关节的运动旋量,包括关节轴的单位方向向量ωi和轴上的任意一点ri,ωi和ri被称为旋量参数,为第i关节坐标变换的指数表达形式,为是旋转矩阵的指数表达形式,其Rodrigues表达形式为:
空间任一向量p的齐次坐标用表示;
利用消元法消去机器人的腕部关节,设r3是腕部关节的交点,将公式(1)两边同乘以可得:
其中根据旋量理论中的距离相等原则可知:
||c-r2||=||p-r2|| (6);
将带入公式(6),两边平方后进行整理,并利用的Rodrigues旋转表达式将其化简为关于θ1的三角函数公式:
x1sinθ1+y1cosθ1=z1 (11);
其中为已知参数,则根据公式(11)可解得θ1为:
其中
步骤2:求解机器人的肘部关节角度θ2
将θ1的值带入中可获得c的值,而c还可表示为:
将的Rodrigues表达式(3)带入式(15),整理可得:
x2sinθ2+y2cosθ2=z2 (16);
其中均已知,则根据公式(16)可解得θ2的表达式为:
θ2角度的具体象限由和的符号决定;
步骤3:求解机器人的腕部前两个关节角度θ3和θ4
将θ1和θ2带入公式(1),并将已知项移到公式(1)的左边,可得:
将式(20)两边同乘以且r5≠r3,易知可得:
其中,可见公式(21)与公式(5)的形式相同,则根据θ1和θ2的表达式可给出θ3和θ4的表达式;
其中,且θ4所在象限由和的符号来决定;
步骤4:求解机器人的腕部末端关节角度θ5
将θ1、θ2、θ3和θ4带入公式(1),并将已知项移到公式(1)的左边,可得:
将式(24)两边同乘以除r5以外的点,这里取点r4,其齐次坐标为可得:
其中,易得:
公式(26)与公式(15)形式相同,则可直接得出角度θ5的表达式
其中,均已知,且θ5所在象限由和的符号来决定。
本发明所带来的有益技术效果:
1、计算精度高,给出了各关节角度的封闭解,可利反三角函数直接求出,具有很高的计
算精度;2、实现简单,每个关节的表达形式非常简单易懂,只需求解一次反三角函数即
可;3、形式统一,5个关节可用两个表达式统一表达,容易记忆,方便应用。
附图说明
图1为5自由度机器人运动学简图。
图2为两条任意轴线的结构简图。
其中,1-肩关节轴;2-肘关节轴;3-第一腕关节轴;4-第二腕关节轴;5-第三腕关节轴。
具体实施方式
下面结合附图以及具体实施方式对本发明作进一步详细说明:
如图1-2所示,针对5R机器人,包括肩关节轴1、肘关节轴2、第一腕关节轴3、第二腕关节轴4和第三腕关节轴5,腕部三条关节轴线相交于一点r3,肩关节和肘关节的轴线相互异面。
根据指数积模型,机器人运动学方程可表示为:
且
其中,下标t和w分别表示末端工具坐标系与世界坐标系,θ是各关节的旋转角度向量θ=[θ1,...,θ5],gwt(0)和gwt(θ)分别表示在初始状态下和瞬时状态下末端工具坐标系相对世界坐标系的变换关系,为第i关节的运动旋量,包括关节轴的单位方向向量ωi和轴上的任意一点ri,ωi和ri被称为旋量参数,为第i关节坐标变换的指数表达形式,为是旋转矩阵的指数表达形式,其Rodrigues表达形式为:
为了叙述方便假设空间任一向量p的齐次坐标可用表示。
实施过程分为三步,第一步求解机器人的肩部和肘部关节角度,第二步求解机器人的腕部前两个关节角度,最后求解机器人腕部末端关节角。
1)求θ1和θ2。首先,针对图1所示机器人,利用消元法消去机器人的腕部关节,将五自由度的逆解问题转化为多个低自由度的子问题进行求解。设r3是腕部关节的交点,将公式(3)两边同乘以r3,可得:
根据旋量理论的位置保持不变原则可知:
则公式(4)变为:
其中根据旋量理论中的距离相等原则可知:
||c-r2||=||p-r2|| (6);
根据旋量理论的基本性质可知:
联立式(7)和式(8)相减,并将的表达式(2)带入,整理可得:
将公式(9)带入公式(6)可得:
将的Rodrigues表达式(3)带入式(10),然后两边平方,整理可得:
x1sinθ1+y1cosθ1=z1 (11);
其中:
设x1=ρcosφ,y1=ρsinφ,则利用三角函数的积化和差公式,公式(11)可变为:
其中同理可以得到:
则关节角度θ1可表示为:
需要注意的是,在上式中需选择合适的r1和r2来保证需保证
将θ1的值带入公式(9)中可获得c的值,而c还可表示为:
再将的Rodrigues表达式(3)带入上式,整理可得:
x2sinθ2+y2cosθ2=z2 (16);
其中
由于则在公式(16)两边分别同乘以和可得:
则θ2可表示为:
θ2角度的具体象限由和的符号决定;
2)求θ3和θ4。将θ1和θ2带入公式(1),并将已知项移到公式(1)的左边,可得:
将式(20)两边同乘以r5,且r5≠r3,易知可得:
其中,可见公式(21)与公式(5)的形式相同,且r3≠r4≠r0,r0是两条轴线的交点,则根据θ1和θ2的表达式可给出θ3和θ4的表达式;
其中
其中,需要通过调整r4来保证且θ4所在象限根据和的符号来决定;
3)求θ5。将θ1、θ2、θ3和θ4带入公式(1),并将已知项移到公式(1)的左边,可得:
两边同乘以除r5以外的点,这里取点r4,其齐次坐标为可得:
其中根据公式(9)同理可得:
公式(26)与公式(15)形式相同,则可直接得出角度θ5的表达式,
其中
θ5所在象限由和的符号来决定。
当然,上述说明并非是对本发明的限制,本发明也并不仅限于上述举例,本技术领域的技术人员在本发明的实质范围内所做出的变化、改型、添加或替换,也应属于本发明的保护范围。
Claims (1)
1.一种五自由度串联机器人的逆运动学通用求解方法,其特征在于,包括如下步骤:
步骤1:求解机器人的肩部关节角度θ1
根据指数积模型,机器人运动学方程可表示为:
且
其中,下标t和w分别表示末端工具坐标系与世界坐标系,θ是各关节的旋转角度向量θ=[θ1,...,θ5],gwt(0)和gwt(θ)分别表示在初始状态下和θ状态下末端工具坐标系相对世界坐标系的变换关系,为第i关节的运动旋量,包括关节轴的单位方向向量ωi和轴上的任意一点ri,ωi和ri被称为旋量参数,为第i关节坐标变换的指数表达形式,为是旋转矩阵的指数表达形式,其Rodrigues表达形式为:
空间任一向量p的齐次坐标用表示;
利用消元法消去机器人的腕部关节,设r3是腕部关节的交点,将公式(1)两边同乘以可得:
其中根据旋量理论中的距离相等原则可知:
||c-r2||=||p-r2|| (6);
将带入公式(6),两边平方后进行整理,并利用的Rodrigues旋转表达式将其化简为关于θ1的三角函数公式:
x1sinθ1+y1cosθ1=z1 (11);
其中x1,y1,为已知参数,则根据公式(11)可解得θ1为:
其中
步骤2:求解机器人的肘部关节角度θ2
将θ1的值带入中可获得c的值,而c还可表示为:
将的Rodrigues表达式(3)带入式(15),整理可得:
x2sinθ2+y2cosθ2=z2 (16);
其中x2,y2,均已知,则根据公式(16)可解得θ2的表达式为:
θ2角度的具体象限由和的符号决定;
步骤3:求解机器人的腕部前两个关节角度θ3和θ4
将θ1和θ2带入公式(1),并将已知项移到公式(1)的左边,可得:
将式(20)两边同乘以且r5≠r3,易知可得:
其中,可见公式(21)与公式(5)的形式相同,则根据θ1和θ2的表达式可给出θ3和θ4的表达式;
其中,且θ4所在象限由和的符号来决定;
步骤4:求解机器人的腕部末端关节角度θ5
将θ1、θ2、θ3和θ4带入公式(1),并将已知项移到公式(1)的左边,可得:
将式(24)两边同乘以除r5以外的点,这里取点r4,其齐次坐标为可得:
其中,易得:
公式(26)与公式(15)形式相同,则可直接得出角度θ5的表达式
其中,x5,y5,均已知,且θ5所在象限由和的符号来决定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710168533.4A CN106845037B (zh) | 2017-03-21 | 2017-03-21 | 一种五自由度串联机器人的逆运动学通用求解方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710168533.4A CN106845037B (zh) | 2017-03-21 | 2017-03-21 | 一种五自由度串联机器人的逆运动学通用求解方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106845037A CN106845037A (zh) | 2017-06-13 |
CN106845037B true CN106845037B (zh) | 2018-07-24 |
Family
ID=59129571
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710168533.4A Active CN106845037B (zh) | 2017-03-21 | 2017-03-21 | 一种五自由度串联机器人的逆运动学通用求解方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106845037B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107756400B (zh) * | 2017-10-13 | 2020-12-04 | 北京工业大学 | 一种基于旋量理论的6r机器人逆运动学几何求解方法 |
CN108763151A (zh) * | 2018-04-12 | 2018-11-06 | 山东科技大学 | 一种任意三关节的逆运动学求解方法 |
CN108481324B (zh) * | 2018-04-25 | 2021-04-20 | 中国科学院合肥物质科学研究院 | 一种八轴多功能机械臂的逆解工程及其碰撞检测算法 |
CN110181522B (zh) * | 2019-07-05 | 2021-12-28 | 西北工业大学 | 一种五自由度首末对称机械臂逆运动学计算的优化方法 |
CN111113425B (zh) * | 2019-12-31 | 2022-12-09 | 上海大学 | 一种有寄生运动的五自由度串并联机器人运动学逆解求解方法 |
CN111452041B (zh) * | 2020-03-17 | 2022-10-21 | 湖南工业大学 | 一种非球腕6r机器人逆运动学求取方法 |
CN112364458B (zh) * | 2020-11-17 | 2023-12-29 | 苏州睿友智能装备有限公司 | 直角式钢轨打磨单元逆解求解方法及介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102509025A (zh) * | 2011-11-25 | 2012-06-20 | 苏州大学 | 一种六自由度仿人灵巧臂逆运动学的快速求解方法 |
CN103341865A (zh) * | 2013-07-05 | 2013-10-09 | 大连理工大学 | 一种三自由度等速解耦空间机器人主动球型腕与万向柔顺控制方法 |
CN105573143A (zh) * | 2015-11-30 | 2016-05-11 | 珞石(北京)科技有限公司 | 用于六自由度的工业机器人的逆运动学求解方法 |
CN106228260A (zh) * | 2016-01-26 | 2016-12-14 | 西北工业大学 | 一种平面三自由度空间机器人逆运动学求解方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102022989B (zh) * | 2010-09-29 | 2012-03-21 | 山东科技大学 | 一种基于指数积模型的机器人标定方法 |
-
2017
- 2017-03-21 CN CN201710168533.4A patent/CN106845037B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102509025A (zh) * | 2011-11-25 | 2012-06-20 | 苏州大学 | 一种六自由度仿人灵巧臂逆运动学的快速求解方法 |
CN103341865A (zh) * | 2013-07-05 | 2013-10-09 | 大连理工大学 | 一种三自由度等速解耦空间机器人主动球型腕与万向柔顺控制方法 |
CN105573143A (zh) * | 2015-11-30 | 2016-05-11 | 珞石(北京)科技有限公司 | 用于六自由度的工业机器人的逆运动学求解方法 |
CN106228260A (zh) * | 2016-01-26 | 2016-12-14 | 西北工业大学 | 一种平面三自由度空间机器人逆运动学求解方法 |
Non-Patent Citations (3)
Title |
---|
一种实用的六自由度机械臂逆运动学解算与验证;徐军;《机械工业标准化与质量》;20160131(第512期);全文 * |
六自由度局部闭链操作臂逆运动方程的一种新解法;杨改云, 郭长江;《郑州轻工业学院学报( 自然科学版)》;20010331;第16卷(第1期);全文 * |
六自由度机械臂逆运动学算法;朱齐丹,王欣璐;《机器人技术与应用》;20140228;全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN106845037A (zh) | 2017-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106845037B (zh) | 一种五自由度串联机器人的逆运动学通用求解方法 | |
CN107214701B (zh) | 一种基于运动基元库的带电作业机械臂自主避障路径规划方法 | |
CN106737689B (zh) | 基于模式函数的超冗余机械臂混合逆向求解方法及系统 | |
CN107203653A (zh) | 一种六自由度串联机器人的逆运动学通用求解方法 | |
CN104965517B (zh) | 一种机器人笛卡尔空间轨迹的规划方法 | |
CN107756400B (zh) | 一种基于旋量理论的6r机器人逆运动学几何求解方法 | |
CN108241339A (zh) | 仿人机械臂的运动求解和构型控制方法 | |
CN109291046A (zh) | 一种七自由度拟人构型机械臂逆运动学规划方法 | |
CN103481288B (zh) | 一种5关节机器人末端工具位姿控制方法 | |
CN107097203A (zh) | 混合切换的主从异构型遥操作机器人的工作空间映射方法 | |
CN105643619B (zh) | 一种采用框架描述的工业机器人工具位姿控制方法 | |
CN107791248B (zh) | 基于不满足Pieper准则的六自由度串联机器人的控制方法 | |
CN107160401B (zh) | 一种解决冗余度机械臂关节角偏移问题的方法 | |
CN108195327A (zh) | 一种基于机器人的附加轴标定方法及终端 | |
CN103529856A (zh) | 5关节机器人末端工具位姿控制方法 | |
Xu et al. | Inverse kinematics for 6-DOF serial manipulators with offset or reduced wrists via a hierarchical iterative algorithm | |
WO2018171467A1 (zh) | 一种任意关系的二阶子问题逆运动学求解方法 | |
Chen et al. | A general analytical algorithm for collaborative robot (cobot) with 6 degree of freedom (DOF) | |
CN108763151A (zh) | 一种任意三关节的逆运动学求解方法 | |
Li et al. | A real-time explicit mapping and teleoperation control method for humanoid robots with posture constraints | |
Li et al. | Power transmission line inspection robot inverse kinematics modeling and evaluation of dexterity | |
Li et al. | Design and workspace analysis of reconfigurable 3-RPRP spherical parallel mechanisms | |
Mei et al. | Simulation Research on Motion Trajectory of PUMA 560 Manipulator Based on MATLAB | |
Zhou et al. | Research on kinematics solution of 7-axis redundant robot based on self-motion | |
Yu et al. | An easily manufactured structure and its analytic solutions for forward and inverse position of 1–2–3-SPS type 6-DOF basic parallel mechanism |
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 |