CN103144111B - 一种二次规划统一协调的移动机械臂运动描述与规划方法 - Google Patents
一种二次规划统一协调的移动机械臂运动描述与规划方法 Download PDFInfo
- Publication number
- CN103144111B CN103144111B CN201310060690.5A CN201310060690A CN103144111B CN 103144111 B CN103144111 B CN 103144111B CN 201310060690 A CN201310060690 A CN 201310060690A CN 103144111 B CN103144111 B CN 103144111B
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- mobile
- associating
- quadratic programming
- mobile platform
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 17
- 230000033001 locomotion Effects 0.000 claims abstract description 20
- 238000012887 quadratic function Methods 0.000 claims abstract description 3
- 239000011159 matrix material Substances 0.000 claims description 12
- 239000012636 effector Substances 0.000 claims description 6
- 230000001105 regulatory effect Effects 0.000 claims description 3
- 238000012916 structural analysis Methods 0.000 claims description 3
- 230000017105 transposition Effects 0.000 claims description 2
- 230000001276 controlling effect Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 240000007594 Oryza sativa Species 0.000 description 1
- 235000007164 Oryza sativa Nutrition 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 230000009347 mechanical transmission Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 235000009566 rice Nutrition 0.000 description 1
Landscapes
- Numerical Control (AREA)
Abstract
本发明提供了一种QP(二次规划)统一协调的移动机械臂运动描述与规划方法,包括如下步骤:1)对移动机械臂,建立QP统一协调的冗余度解析方案,所述解析方案设计的最小性能指标为移动平台和机械臂的联合速度向量的二次函数,受约束于移动平台和机械臂的统一描述方程、联合速度极限和联合角度极限;2)将步骤1)的QP统一协调的冗余度解析方案运用QP求解器进行求解;3)将步骤2)的求解结果传递给下位机控制器,驱动移动平台和机械臂同时协调完成给定的末端任务。本发明特点在于,通过对移动平台和机械臂的统一描述与规划,控制移动机械臂的移动平台和机械臂同时协调运动,完成给定末端任务。
Description
技术领域
本发明涉及移动机械臂的运动规划及控制领域,更具体地,涉及一种二次规划统一协调的移动机械臂运动描述与规划方法。
背景技术
移动机械臂是由一个移动平台和固定在移动平台上的一个机械臂组成。相比于固定平台的机械臂而言,移动机械臂既拥有移动平台的大范围移动性,又拥有机械臂的可操作能力,因此受到了广泛的关注和研究。然而,移动平台和固定机械臂的结合产生了新的问题:怎么样同时协调控制移动平台和机械臂的运动?就一般规划方案而言,要么是先控制移动平台的运动,后控制机械臂的运动;要么是先控制机械臂的运动,后控制移动平台的运动,从而无法对移动平台和机械臂同时进行协调控制。而基于二次规划统一协调的移动机械臂运动描述与规划方法,就是对移动平台和机械臂同时进行协调控制运动,从而使得移动机械臂更加有效地完成给定的末端任务。
发明内容
本发明所要解决的技术问题是提供一种计算量小、用于移动机械臂对移动平台和机械臂同时进行协调控制运动的二次规划统一协调的移动机械臂运动描述与规划方法。
为解决上述技术问题,本发明通过以下技术方案予以实现:
一种二次规划统一协调的移动机械臂运动描述与规划方法,包括如下步骤:
S1.对移动机械臂,建立二次规划统一协调的冗余度解析方案,所述解析方案设计的最小性能指标为移动平台和机械臂的联合速度向量的二次函数,受约束于移动平台和机械臂的统一描述方程、联合速度极限和联合角度极限;
S2.将步骤S1的二次规划统一协调的冗余度解析方案运用二次规划求解器进行求解;
S3.将步骤S2的求解结果传递给下位机控制器,驱动移动平台和机械臂同时协调完成给定的末端任务。
优选地,二次规划统一协调的冗余度解析方案设计为:最小化受约束于 q-≤q≤qw、 其中 为需优化的运动性能指标,表示移动平台和机械臂的联合速度向量,上标T表示矩阵和向量的转置,W为非零系数矩阵,p为系数向量,且W和p由欲优化的目标决定,等式约束对应移动平台和机械臂的统一描述方程,K表示机械臂末端执行器速度向量和移动机械臂联合速度向量的连接矩阵,表示移动机械臂末端执行器的速度向量,q表示移动平台和机械臂的联合角度向量,q-≤q≤q+和分别表示联合角度范围和联合速度范围,q±表示联合角度上下极限,表示联合速度上下极限。
优选地,所述等式约束为移动平台和机械臂的统一运动学描述方程,根据给定的移动机械臂,通过对其结构分析,求得具体的连接矩阵K。
优选地,所述二次规划统一协调的冗余度解析方案转化为一个标准二次规划:最小化xTWx/2+pTx,受约束于Kx=d,ζ-≤x≤ζ+,其中 正的常数k用来调节和保证联合速度足够大的可行域。通过二次规划求解器求解所述标准二次规划,从而得到二次规划统一协调的移动机械臂运动描述与规划方法的最优解。
与现有技术相比,本发明具有如下优点:
以往,对移动机械臂的运动规划控制,要么是先控制移动平台的运动,要么是先控制机械臂的运动,不能对移动平台和机械臂同时进行协调控制运动,控制过程较为繁琐。本发明通过对移动平台和机械臂运动学方程进行统一描述,建立二次规划统一协调的移动机械臂的冗余度解析方案,从而对移动平台和机械臂同时进行协调控制运动,完成给定末端任务,避免了分别控制移动平台或者机械臂运动带来的额外工作量以及繁琐过程。
附图说明
图1为本发明的流程图。
图2为本发明的具体实施移动机械臂三维模型图。
图3为本发明的具体实施移动平台结构示意图。
具体实施方式
下面结合附图对本发明做进一步的描述,但本发明的实施方式并不限于此。
图1所示的二次规划统一协调的移动机械臂运动描述与规划方法首先主要建立移动机械臂的二次规划统一协调的冗余度解析方案;然后运用二次规划求解器对二次规划方案进行求解;下位机控制器根据求解结果控制移动机械臂的运动。
具体实施例一
图2展示了实现本发明的移动机械臂为一个三维的二轮驱动的移动机械臂。机械臂由六个连杆所组成,通过关节5、关节6、关节7、关节8、关节9和关节10连接。移动平台包括两个驱动轮:左驱动轮11和右驱动轮12。在本发明专利示例中,该机械臂关节5-10初始角度设置为[0,π/3,π/6,π,π/2,0]T弧度,左驱动轮11和右驱动轮12初始角度设置为[0,0]T弧度,即q(0)=[0,0,0,π/3,π/6,π,π/2,0]T,其联合角度上下极限设置为q±=[±∞,±∞,±0.5236,±2.3562,±6.2832,±6.2832,±6.2832,±6.2832]T弧度,其联合速度上下极限设置为 弧度/秒。该空间六自由度冗余度机械臂的前向运动学方程为
其中li表示第i个连杆的长度,ci=cos(θi),si=sin(θi),θi表示第i个关节的角度,i=1,2,…6,s32=sin(θ3+θ2),c32=cos(θ3+θ2),h表示第一个关节到移动平台底部的距离。在该空间六自由度冗余度机械臂中,l=[0.065,0.555,0.19,0.13,0.082,0.018]T米,h=0.698米。
图3为实现本发明的移动平台结构示意图。在这个具体示例中,通过对移动平台的结构分析,求得二轮驱动的移动平台运动学方程为和其中(和分别表示移动平台左右轮的旋转速度,其初始速度设置为零),表示移动平台航向角的速度(初始速度设置为零),表示移动平台和机械臂连接点的速度(和分别表示它的横坐标和纵坐标的速度), (r表示驱动轮的半径,其为0.1025米,d表示两个驱动轮的中点到机械臂和移动平台连接点的距离,其为0.1米,b表示驱动轮到其两中点的距离,其为0.32米,φ表示移动平台的航向角)。根据移动平台和机械臂的运动学描述方程,建立移动平台和机械臂在速度层上统一的运动学描述方程为 其中 I为单位矩阵。
下面是本发明关于二次规划统一协调的移动械臂运动描述与规划方法:
最小化
约束条件
q-≤q≤q+ (3)
其中为欲优化的运动性能指标,表示联合速度向量,W为非零系数矩阵,p为系数向量,且W和p由欲优化的目标决定,等式约束对应移动平台和机械臂的统一描述方程,K表示机械臂的末端执行器速度向量和移动机械臂联合速度变量的连接矩阵,表示移动机械臂末端执行器速度向量,q表示移动机械臂的联合角度向量,q-≤q≤q+和分别表示联合角度范围和联合速度范围,q±表示联合角度上下限,表示联合速度上下限。
考虑到上述优化问题是在速度层上求解,因此需将移动机械臂的联合角度约束(3)、联合速度约束(4)合并,从而得到基于联合速度的双端不等式约束:
其中ζ-和ζ+的第i个元素分别定义为 和 正的常数k(如取为4)用来调节联合速度的可行域。用x表示移动机械臂的联合速度带物理约束的移动机械臂冗余度解析方案(1)-(4)便可描述为如下的标准二次规划方案:
最小化 xTWx/2+pTx (6)
约束条件 Kx=d (7)
ζ-≤x≤ζ+ (8)
其中和在本实施例中,W为单位矩阵,p为零向量和q-q(0)的组合,如此运动性能指标可以起到最小轮速和最小关节运动的双重目的。上述标准二次规划用二次规划求解器进行求解,进而得到二次规划统一协调的移动机械臂描述与运动规划方法的最优解。
以上所述的本发明的实施方式,并不构成对本发明保护范围的限定。任何在本发明的精神原则之内所作出的修改、等同替换和改进等,均应包含在本发明的权利要求保护范围之内。
Claims (3)
1.一种二次规划统一协调的移动机械臂运动描述与规划方法,其特征在于,包括如下步骤:
S1.对移动机械臂,建立二次规划统一协调的冗余度解析方案,所述解析方案的最小性能指标为移动平台和机械臂的联合速度向量的二次函数,受约束于移动平台和机械臂的统一描述方程、联合速度极限和联合角度极限;
S2.将步骤S1的二次规划统一协调的移动机械臂冗余度解析方案运用二次规划求解器进行求解;
S3.将步骤S2的求解结果传递给下位机控制器,驱动移动平台和机械臂同时协调完成给定的末端任务;
所述步骤S1的二次规划统一协调的冗余度解析方案具体为:最小化受约束于q-≤q≤q+、其中为欲优化的运动性能指标,表示移动平台和机械臂的联合速度向量,上标T表示矩阵和向量的转置,W为非零系数矩阵,p为系数向量,且W和p由欲优化的目标决定,等式约束对应移动平台和机械臂的统一描述方程,K表示机械臂末端执行器速度向量和移动机械臂联合速度向量的连接矩阵,表示移动机械臂末端执行器的速度向量,q表示移动平台和机械臂的联合角度向量,q-≤q≤q+和分别表示联合角度范围和联合速度范围,q±表示联合角度上下极限,表示联合速度上下极限。
2.根据权利要求1所述的二次规划统一协调的移动机械臂运动描述与规划方法,其特征在于:所述等式约束为移动平台和机械臂的统一运动学描述方程,根据给定的移动机械臂,通过对其结构分析,求得具体的连接矩阵K。
3.根据权利要求1所述的二次规划统一协调的移动机械臂运动描述与规划方法,其特征在于:所述步骤S1的二次规划统一协调的冗余度解析方案转化为一个标准二次规划:最小化xTWx/2+pTx,受约束于Kx=d,其中 和分别表示联合速度的双端不等式约束的两个端点,和的第i个元素分别定义为 正的常数k用来调节和保证联合速度足够大的可行域;通过二次规划求解器求解所述标准二次规划,从而得到二次规划统一协调的移动机械臂运动描述与规划方法的最优解。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310060690.5A CN103144111B (zh) | 2013-02-26 | 2013-02-26 | 一种二次规划统一协调的移动机械臂运动描述与规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310060690.5A CN103144111B (zh) | 2013-02-26 | 2013-02-26 | 一种二次规划统一协调的移动机械臂运动描述与规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103144111A CN103144111A (zh) | 2013-06-12 |
CN103144111B true CN103144111B (zh) | 2015-11-04 |
Family
ID=48542571
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310060690.5A Expired - Fee Related CN103144111B (zh) | 2013-02-26 | 2013-02-26 | 一种二次规划统一协调的移动机械臂运动描述与规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103144111B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105563490A (zh) * | 2016-03-03 | 2016-05-11 | 吉首大学 | 一种移动机械臂障碍物躲避的容错运动规划方法 |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104760041B (zh) * | 2015-03-19 | 2016-08-03 | 中山大学 | 一种基于突加度的障碍物躲避运动规划方法 |
DE102015108473A1 (de) * | 2015-05-28 | 2016-12-01 | Schwing Gmbh | Großmanipulator mit schnell ein- und ausfaltbarem Knickmast |
CN105598984B (zh) * | 2015-11-26 | 2017-10-20 | 华侨大学 | 一种冗余度机械臂加速度层运动规划的初始化方法 |
CN105538327A (zh) * | 2016-03-03 | 2016-05-04 | 吉首大学 | 一种基于突加度的冗余度机械臂重复运动规划方法 |
CN105904458B (zh) * | 2016-05-16 | 2018-01-19 | 西北工业大学 | 一种基于复杂操作任务的非完整遥操作约束控制方法 |
CN106378776A (zh) * | 2016-11-29 | 2017-02-08 | 闫建东 | 手足一体化机器人的操控方法和装置 |
CN108214483B (zh) * | 2016-12-15 | 2020-12-11 | 香港理工大学深圳研究院 | 多固定基座冗余度机械臂的任务动态追踪方法和装置 |
CN108908347B (zh) * | 2018-09-07 | 2020-07-07 | 浙江科技学院 | 一种面向冗余移动机械臂容错型重复运动规划方法 |
CN110900581B (zh) * | 2019-12-27 | 2023-12-22 | 福州大学 | 基于RealSense相机的四自由度机械臂视觉伺服控制方法及装置 |
CN111844040A (zh) * | 2020-07-23 | 2020-10-30 | 兰州大学 | 一种附带机械臂的电动轮椅的运动规划方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4999553A (en) * | 1989-12-28 | 1991-03-12 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Method and apparatus for configuration control of redundant robots |
DE4333820A1 (de) * | 1992-10-10 | 1994-04-14 | Licentia Gmbh | Verfahren zur Steuerung der Bewegung eines vielgliedrig ausgebildeten Manipulators |
CN102126219A (zh) * | 2010-11-22 | 2011-07-20 | 中山大学 | 一种冗余度机械臂容错型运动规划方法 |
CN102514008A (zh) * | 2011-11-21 | 2012-06-27 | 中山大学 | 一种冗余度机械臂的不同层性能指标同时优化方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007136590A (ja) * | 2005-11-16 | 2007-06-07 | Kawasaki Heavy Ind Ltd | 冗長関節部を有する冗長ロボットの制御装置および制御方法 |
-
2013
- 2013-02-26 CN CN201310060690.5A patent/CN103144111B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4999553A (en) * | 1989-12-28 | 1991-03-12 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Method and apparatus for configuration control of redundant robots |
DE4333820A1 (de) * | 1992-10-10 | 1994-04-14 | Licentia Gmbh | Verfahren zur Steuerung der Bewegung eines vielgliedrig ausgebildeten Manipulators |
CN102126219A (zh) * | 2010-11-22 | 2011-07-20 | 中山大学 | 一种冗余度机械臂容错型运动规划方法 |
CN102514008A (zh) * | 2011-11-21 | 2012-06-27 | 中山大学 | 一种冗余度机械臂的不同层性能指标同时优化方法 |
Non-Patent Citations (2)
Title |
---|
基于二次型优化的不定目标自运动规划方案及PA10机械臂仿真验证;张雨浓等;《暨南大学学报(自然科学版)》;20100630;第31卷(第03期);正文第229-234页 * |
轮式移动机器人机械臂跟踪技术研究;杨海亮;《中国优秀硕士学位论文全文数据库信息科技辑》;20100715(第07期);正文第9-35页 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105563490A (zh) * | 2016-03-03 | 2016-05-11 | 吉首大学 | 一种移动机械臂障碍物躲避的容错运动规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103144111A (zh) | 2013-06-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103144111B (zh) | 一种二次规划统一协调的移动机械臂运动描述与规划方法 | |
CN105563490A (zh) | 一种移动机械臂障碍物躲避的容错运动规划方法 | |
CN101927495B (zh) | 一种冗余度机械臂重复运动规划方法 | |
CN108621158B (zh) | 一种关于机械臂的时间最优轨迹规划控制方法及装置 | |
CN103149933B (zh) | 基于闭环控制的仿人机器人全向行走方法 | |
CN108089578B (zh) | 一种用于双足步行机器人的步行运动规划方法 | |
CN102785248B (zh) | 一种解耦型六自由度工业机器人的运动控制方法 | |
CN101804627A (zh) | 一种冗余度机械臂运动规划方法 | |
CN106945041A (zh) | 一种冗余度机械臂重复运动规划方法 | |
CN107351081B (zh) | 具有速度优化特性的冗余度机械臂突加度层运动规划方法 | |
CN105005656B (zh) | 一种6自由度机械手自主抓取逆解工程算法 | |
CN105538327A (zh) | 一种基于突加度的冗余度机械臂重复运动规划方法 | |
CN103399986B (zh) | 基于微分几何的空间机械臂建模方法 | |
CN102126219A (zh) | 一种冗余度机械臂容错型运动规划方法 | |
CN104760041A (zh) | 一种基于突加度的障碍物躲避运动规划方法 | |
CN108381555B (zh) | 一种飞行作业机器人冗余度机械臂下位控制器的设计方法 | |
US20150251316A1 (en) | Coordinated Robotic Control | |
CN102509025A (zh) | 一种六自由度仿人灵巧臂逆运动学的快速求解方法 | |
CN104723341A (zh) | 基于连接和阻尼配置的柔性关节机械臂的位置控制方法 | |
CN105404744B (zh) | 一种空间机械臂全状态动力学半物理仿真*** | |
CN103231381A (zh) | 一种冗余度机械臂的新型加速度层重复运动规划方法 | |
CN104908040A (zh) | 一种冗余度机械臂加速度层的容错规划方法 | |
CN105320138A (zh) | 康复训练机器人运动速度和运动轨迹同时跟踪的控制方法 | |
CN102514008A (zh) | 一种冗余度机械臂的不同层性能指标同时优化方法 | |
CN104573255A (zh) | 一种基于改进多体***传递矩阵的机械臂建模与求解方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20151104 Termination date: 20210226 |