CN106991277A - 一种任意关系的二阶子问题逆运动学求解方法 - Google Patents
一种任意关系的二阶子问题逆运动学求解方法 Download PDFInfo
- Publication number
- CN106991277A CN106991277A CN201710168532.XA CN201710168532A CN106991277A CN 106991277 A CN106991277 A CN 106991277A CN 201710168532 A CN201710168532 A CN 201710168532A CN 106991277 A CN106991277 A CN 106991277A
- Authority
- CN
- China
- Prior art keywords
- subproblem
- formula
- order
- relation
- inverse kinematics
- 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
- G16—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS
- G16Z—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS, NOT OTHERWISE PROVIDED FOR
- G16Z99/00—Subject matter not provided for in other main groups of this subclass
Landscapes
- Manipulator (AREA)
- Prostheses (AREA)
Abstract
本发明公开了一种任意关系的二阶子问题逆运动学求解方法,属于机器人逆运动学领域,本发明涉及二阶子问题RR的逆解方法,该方法在指数积模型的基础上,利用旋量理论的基本性质和Rodrigues旋转矩阵表达,将几何方法与代数方法结合起来给出一种通用的关节角求解公式,不需要考虑关节轴线之间的关系,无论是相交、平行、还是异面都可以利用这种方法直接求出。本发明对机器人逆解的求解方法进行了拓展,扩大了适应范围,简化了求解过程,为机器人在实际的开发和应该提供了方便。
Description
技术领域
本发明属于机器人逆运动学领域,具体涉及一种任意关系的二阶子问题逆运动学求解方法。
背景技术
Paden-Kanhan子问题在机器人逆运动学应用非常广泛,因为它具有几何意义和数值稳定性,能够灵活的为多种机器人提供封闭解。Paden-Kanhan子问题主要分为三类:一阶子问题,二阶子问题,三阶子问题。其中一阶子问题是针对单关节的转动R或平移T运动的逆解问题;二阶子问题是针对两个关节逆解问题,包含了3种情况:RR,TT,RT/TR,其中RR又分为相交、平行、异面垂直等不同的类型;三阶子问题是针对三个关节的逆解问题,包含了6种情况。在实际中,由于加工、装配很多几何关系很难保证,比如:相交、平行,而且不同的结构需要选择不同的公式,这为实际应用带来很多不便。
发明内容
针对现有技术中存在的上述技术问题,本发明提出了一种任意关系的二阶子问题逆运动学求解方法,设计合理,克服了现有技术的不足,具有良好的效果。
为了实现上述目的,本发明采用如下技术方案:
一种任意关系的二阶子问题逆运动学求解方法,包括如下步骤:
步骤1:求θ1
二阶子问题RR可用公式表示为
其中,是p,q的齐次坐标,由第i关节轴的轴方向向量ωi和轴上一点ri组成,这些参数均已知。根据旋量理论的距离相等原则可知:
||c-r2||=||p-r2|| (5);
将带入上式,并利用的Rodrigues旋转公式将其化简成关于θ1的三角函数方程:
x1sinθ1+y1cosθ1=z1 (9);
其中为已知参数,从上式可解得θ1的表达式:
上式中需要通过调整r1和r2来保证
步骤2:求θ2
根据已知的θ1可得c的值,而c还可表示为:
将的Rodrigues旋转公式带入上式整理可得:
x2sinθ2+y2cosθ2=z2 (14);
其中均为已知参数,从上式中可解的θ2的表达式:
θ2角度的具体象限由和的符号决定,需注意的是当相邻两关节相交的时候,两关节轴上的点r1和r2,必须满足r1≠r2≠r0,其中r0是两条轴线的交点。
本发明所带来的有益技术效果:
1、计算效率高,给出了关节角度的封闭解,可利反三角函数直接求出,具有很高的计算效率;2、实现简单,每个关节的表达形式非常简单易懂,只需求解一次反三角函数即可;3、应用范围广,可应用于任意2R机器人中,不需要考虑其轴线之间的几何关系。
附图说明
图1为任意关系的RR结构图。
具体实施方式
下面结合附图以及具体实施方式对本发明作进一步详细说明:
一种任意关系的二阶子问题逆运动学求解方法,包括如下步骤:
步骤1:求θ1
如图1所示,二阶子问题RR可用公式表示为
其中,和是空间点p和q的齐次坐标表示,且点为初始点,绕轴ω2转θ2到点c,c点绕ω1旋转θ1到点q,为运动旋量,由关节轴的单位方向向量和轴上的任意一点构成,是刚体变换的指数表达,对于转动关节其表达式为:
其中,I3×3为3×3的单位矩阵,是旋转矩阵,可用Rodrigues表示为:
其中,是单位方向向量ω=[ωx,ωy,ωz]T的反对称矩阵,可表示为:
根据旋量理论的距离相等原则可知:
||c-r2||=||p-r2|| (5);
根据旋量理论的基本原理可知:
上述两式相减可得:
将指数积公式的表达式(2)带入式(6)可得:
将公式(7)带入公式(5)可得:
再将的Rodrigues表达(3)带入式(8),两边平方后,整理可得:
x1sinθ1+y1cosθ1=z1 (9);
其中
设x1=ρcosφ,y1=ρsinφ,则利用三角函数的积化和差公式,公式(9)可变为:
其中,同理可以得到:
则关节角度θ1可表示为:
上式中需要通过调整r1和r2来保证
步骤2:求θ2
将θ1的值带入公式(7)中可得c的值,而c还可表示为:
将的Rodrigues表达(3)带入式(13),整理可得:
x2sinθ2+y2cosθ2=z2 (14);
其中
由于则在公式(14)两边分别同乘以和可得:
则θ2可表示为:
θ2角度的具体象限由和的符号决定,需要注意的是当相邻两关节相交的时候,两关节轴上的点r1和r2,必须满足r1≠r2≠r0,其中r0是两条轴线的交点。
当然,上述说明并非是对本发明的限制,本发明也并不仅限于上述举例,本技术领域的技术人员在本发明的实质范围内所做出的变化、改型、添加或替换,也应属于本发明的保护范围。
Claims (1)
1.一种任意关系的二阶子问题逆运动学求解方法,其特征在于,包括如下步骤:
步骤1:求θ1
二阶子问题RR可用公式表示为
其中,是p,q的齐次坐标,i=1,2由第i关节轴的轴方向向量ωi和轴上一点ri组成,这些参数均已知,根据旋量理论的距离相等原则可知:
||c-r2||=||p-r2|| (5);
将带入上式,并利用的Rodrigues旋转公式将其化简成关于θ1的三角函数方程:
x1sinθ1+y1cosθ1=z1 (9);
其中为已知参数,从公式(9)可解得θ1的表达式:
其中,
步骤2:求θ2
根据已知的θ1可得c的值,而c还可表示为:
将的Rodrigues旋转公式带入上式整理可得:
x2sinθ2+y2cosθ2=z2 (14);
其中均为已知参数,从公式(14)中可解的θ2的表达式:
θ2角度的具体象限由和的符号决定,当相邻两关节相交的时候,两关节轴上的点r1和r2,必须满足r1≠r2≠r0,其中r0是两条轴线的交点。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710168532.XA CN106991277B (zh) | 2017-03-21 | 2017-03-21 | 一种任意关系的二阶子问题逆运动学求解方法 |
PCT/CN2018/078833 WO2018171467A1 (zh) | 2017-03-21 | 2018-03-13 | 一种任意关系的二阶子问题逆运动学求解方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710168532.XA CN106991277B (zh) | 2017-03-21 | 2017-03-21 | 一种任意关系的二阶子问题逆运动学求解方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106991277A true CN106991277A (zh) | 2017-07-28 |
CN106991277B CN106991277B (zh) | 2018-03-20 |
Family
ID=59411703
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710168532.XA Active CN106991277B (zh) | 2017-03-21 | 2017-03-21 | 一种任意关系的二阶子问题逆运动学求解方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN106991277B (zh) |
WO (1) | WO2018171467A1 (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018171467A1 (zh) * | 2017-03-21 | 2018-09-27 | 山东科技大学 | 一种任意关系的二阶子问题逆运动学求解方法 |
CN108763151A (zh) * | 2018-04-12 | 2018-11-06 | 山东科技大学 | 一种任意三关节的逆运动学求解方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102509025A (zh) * | 2011-11-25 | 2012-06-20 | 苏州大学 | 一种六自由度仿人灵巧臂逆运动学的快速求解方法 |
CN102637158A (zh) * | 2012-04-28 | 2012-08-15 | 谷菲 | 一种六自由度串联机器人运动学逆解的求解方法 |
CN103390101A (zh) * | 2013-07-15 | 2013-11-13 | 哈尔滨工程大学 | 串联形式机器人的逆运动学通用求解方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20160081668A1 (en) * | 2013-08-27 | 2016-03-24 | The Johns Hopkins University | System and Method For Medical Imaging Calibration and Operation |
CN106991277B (zh) * | 2017-03-21 | 2018-03-20 | 山东科技大学 | 一种任意关系的二阶子问题逆运动学求解方法 |
-
2017
- 2017-03-21 CN CN201710168532.XA patent/CN106991277B/zh active Active
-
2018
- 2018-03-13 WO PCT/CN2018/078833 patent/WO2018171467A1/zh active Application Filing
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102509025A (zh) * | 2011-11-25 | 2012-06-20 | 苏州大学 | 一种六自由度仿人灵巧臂逆运动学的快速求解方法 |
CN102637158A (zh) * | 2012-04-28 | 2012-08-15 | 谷菲 | 一种六自由度串联机器人运动学逆解的求解方法 |
CN103390101A (zh) * | 2013-07-15 | 2013-11-13 | 哈尔滨工程大学 | 串联形式机器人的逆运动学通用求解方法 |
Non-Patent Citations (2)
Title |
---|
HAIXIA WANG 等: "A screw axis identification method for serial robot calibration based on the POE model", 《INDUSTRIAL ROBOT: AN INTERNATIONAL JOURNAL》 * |
马园园: "旋量理论在机器人运动学逆解中的应用", 《万方数据知识服务平台 硕士学位论文》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018171467A1 (zh) * | 2017-03-21 | 2018-09-27 | 山东科技大学 | 一种任意关系的二阶子问题逆运动学求解方法 |
CN108763151A (zh) * | 2018-04-12 | 2018-11-06 | 山东科技大学 | 一种任意三关节的逆运动学求解方法 |
WO2019196229A1 (zh) * | 2018-04-12 | 2019-10-17 | 山东科技大学 | 一种任意三关节的逆运动学求解方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106991277B (zh) | 2018-03-20 |
WO2018171467A1 (zh) | 2018-09-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107203653A (zh) | 一种六自由度串联机器人的逆运动学通用求解方法 | |
Alexandroff | Elementary concepts of topology | |
CN106845037A (zh) | 一种五自由度串联机器人的逆运动学通用求解方法 | |
CN102637158B (zh) | 一种六自由度串联机器人运动学逆解的求解方法 | |
Samuel et al. | Unifying screw geometry and matrix transformations | |
CN106991277B (zh) | 一种任意关系的二阶子问题逆运动学求解方法 | |
Zeng et al. | Ricci flow for shape analysis and surface registration: theories, algorithms and applications | |
CN107756400A (zh) | 一种基于旋量理论的6r机器人逆运动学几何求解方法 | |
CN106625687A (zh) | 一种关节机器人运动学建模方法 | |
Sachkov | Left-invariant optimal control problems on Lie groups: classification and problems integrable by elementary functions | |
Song et al. | Mobility analysis of the threefold-symmetric Bricard linkage and its network | |
Cvijović et al. | Closed-form summations of Dowker's and related trigonometric sums | |
CN109434838A (zh) | 线驱动连续机器人内窥操作的协同运动规划方法及系统 | |
Ham et al. | Explicit formulae for Chern-Simons invariants of the twist-knot orbifolds and edge polynomials of twist knots | |
CN107577905A (zh) | 一种三自由度混联机械臂的运动学正解求解方法 | |
Hasebe | squeezing for Bloch four-hyperboloid via the non-compact Hopf map | |
Beschastnyi et al. | Geodesics in the sub-Riemannian problem on the group | |
CN108763151A (zh) | 一种任意三关节的逆运动学求解方法 | |
Bin et al. | Kinematics analysis of a novel 7-DOF humanoid manipulator for table tennis | |
Beschastnyǐ | The optimal rolling of a sphere, with twisting but without slipping | |
Scribano et al. | Note: On the inclusion of a diagonal Born-Oppenheimer correction in the reduced dimensional treatment of the H2O–para-H2 complex | |
Krasnov | Real Kummer quartics and their Heisenberg invariance | |
Jeong et al. | Virtual joint method for kinematic modeling of wheeled mobile manipulators | |
Ricca et al. | The Jones polynomial as a new invariant of topological fluid dynamics | |
CN110259911A (zh) | 一种谐波减速器刚柔轮啮合点瞬时速度计算方法 |
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 |