CN105598984A - 一种冗余度机械臂加速度层运动规划的初始化方法 - Google Patents
一种冗余度机械臂加速度层运动规划的初始化方法 Download PDFInfo
- Publication number
- CN105598984A CN105598984A CN201510843147.1A CN201510843147A CN105598984A CN 105598984 A CN105598984 A CN 105598984A CN 201510843147 A CN201510843147 A CN 201510843147A CN 105598984 A CN105598984 A CN 105598984A
- Authority
- CN
- China
- Prior art keywords
- centerdot
- theta
- joint
- mechanical arm
- acceleration
- 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
- 230000001133 acceleration Effects 0.000 title claims abstract description 51
- 238000013439 planning Methods 0.000 title claims abstract description 17
- 238000011423 initialization method Methods 0.000 title abstract 3
- 238000000034 method Methods 0.000 claims abstract description 16
- 238000005457 optimization Methods 0.000 claims abstract description 11
- 238000006243 chemical reaction Methods 0.000 claims description 11
- 239000011159 matrix material Substances 0.000 claims description 4
- 230000017105 transposition Effects 0.000 claims description 3
- 238000012913 prioritisation Methods 0.000 claims description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 230000007812 deficiency Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
Landscapes
- Numerical Control (AREA)
Abstract
本发明中的冗余度机械臂加速度层运动规划的初始化方法通过先将冗余度机械臂调节到其极限位置,而后利用该极限位置作为起始值,并设定机械臂任务执行位置作为终止值,建立基于二次型优化描述的加速度层位置调整方案,而后利用数值算法对加速度层位置调整方案求解,最后通过该求解结果驱动机械臂使其由极限位置转动到任务执行位置,该冗余度机械臂加速度层运动规划的初始化方法具有操作方便、工作量小、作业规范的优点。
Description
技术领域
本发明涉及冗余度机械臂加速度层运动规划领域,具体涉及一种冗余度机械臂加速度层运动规划的初始化方法。
背景技术
冗余度机械臂是一种末端能动的机械装置,其自由度多于执行末端任务所需最少自由度;目前已广泛应用于装备制造、产品加工、机器作业等国民经济生产活动中。冗余度机械臂在工作空间中不同的位置执行任务时,当结束一个任务后,往往需要从当前位置移动到下一个任务的执行位置。一般而言,冗余度机械臂从当前位置移动到下一个任务的执行位置,都是通过慢慢转动机械臂各个关节并不断调整来实现。然而,这种做法是相当繁琐且存在着不足的:每次改变任务操作位置时都有可能需要多次度量各个关节角度以使机械臂准确到达其执行任务的位置;并且任务执行位置测量或调整的不准确也将影响到机械臂正常/成功完成所要求的任务。
发明内容
本发明的目的在于克服一般技术的不足,提供一种操作方便、工作量少、作业规范且是在加速度层上实现的冗余度机械臂运动规划初始化方法。
本发明提供的技术方案如下:一种冗余度机械臂加速度层运动规划的初始化方法,包括以下步骤:
1)启动机械臂控制器,将冗余度机械臂调节到其极限位置,具体操作是依次驱动机械臂各个关节的电机使其最终达到各自的极限位置;
2)将步骤1)的极限位置作为起始值,并设定机械臂任务执行位置作为终止值,建立基于二次型优化描述的加速度层位置调整方案,所述的优化方案受约束于关节角度极限、关节速度极限和关节加速度极限;对于拥有n自由度的机械臂而言,加速度层位置调整方案设计为:
最小化
其中,设计参数γ>0∈R,上标T表示矩阵或向量的转置;θ∈Rn表示关节角度,表示关节速度,表示关节加速度;θd∈Rn为机械臂任务执行初始位置;加速度层位置调整方案受约束于:θ-≤θ≤θ+,
其中,θ±∈Rn、和分别表示关节角度极限、关节速度极限和关节加速度极限;
3)将步骤2)的加速度层位置调整方案利用数值算法进行求解;
4)下位机控制器根据步骤3)的求解结果,驱动机械臂使其由极限位置转动到任务执行位置。
在本发明的较佳实施例中,步骤2)中,将机械臂的关节极限转化为在加速度层上描述的双端约束,具体操作是利用约束转换方法将θ-≤θ≤θ+,和转化描述为一个基于关节加速度的双端约束,即,其中η-∈Rn和η+∈Rn的第i个元素分别定义为和i=1,2,…n,关节极限转换参数k1>0∈R和k2>0∈R,关节极限转换裕量
在本发明的较佳实施例中,步骤3)中,通过数值算法对加速度层位置调整方案进行求解,具体操作是将所述加速度层位置调整方案进一步变换为分段线性投影方程,从而构造相应的数值算法进行求解。
本发明中的冗余度机械臂加速度层运动规划的初始化方法通过先将冗余度机械臂调节到其极限位置,而后利用该极限位置作为起始值,并设定机械臂任务执行位置作为终止值,建立基于二次型优化描述的加速度层位置调整方案,而后利用数值算法对加速度层位置调整方案求解,最后通过该求解结果驱动机械臂使其由极限位置转动到任务执行位置,该冗余度机械臂加速度层运动规划的初始化方法具有操作方便、工作量小、作业规范的优点。
具体实施方式
一种冗余度机械臂加速度层运动规划的初始化方法主要由冗余度机械臂调节到其极限位置、加速度层位置调整方案、数值算法求解器、下位机控制器、冗余度机械臂转动到任务执行位置组成。
首先启动机械臂控制器,将冗余度机械臂调节到其极限位置;再将该极限位置作为起始值,并设定机械臂任务执行位置作为终止值,从而建立基于二次型优化描述的加速度层位置调整方案;然后构造相应的数值算法来求解该加速度层位置调整方案;最后把求解结果用于驱动机械臂使其由极限位置转动到任务执行位置。
基于最小化机械臂各个关节的当前位置与任务执行位置之间偏移量的思想,n自由度冗余度机械臂的加速度层位置调整方案可设计为:
最小化:
约束条件:θ-≤θ≤θ+,(2)
其中,设计参数γ>0∈R,上标T表示矩阵或向量的转置;θ∈Rn表示关节角度,表示关节速度,表示关节加速度;θd∈Rn为机械臂任务执行初始位置;θ±∈Rn、和表示关节角度极限、关节速度极限和关节加速度极限。
利用约束转换方法将(2)-(4)转化描述为一个基于关节加速度的双端约束,即,其中η-∈Rn和η+∈Rn的第i个元素分别定义为和i=1,2,…n,关节极限转换参数k1>0∈R和k2>0∈R,关节极限转换裕量用x∈Rn表示机械臂的关节加速度上述的冗余度机械臂加速度层位置调整方案(1)-(4)便可描述为如下的二次型优化问题:
最小化:xTQx/2+pTx(5)
约束条件:η-≤x≤η+,(6)
其中,Q=I∈Rn×n,I为单位矩阵。
并且,求解上述的二次型优化问题(5)-(6)等价于求解如下的分段线性投影方程:
PΩ(x-(Qx+p))-x=0∈Rn,(7)
其中,PΩ(·)表示分段线性投影算子。对于分段线性投影方程(7)和二次型优化问题(5)-(6),可采用如下的数值算法来求解:
e(xk)=xk-PΩ(xk-(Qxk+p)),
xk+1=xk-ρ(xk)φ(xk),
φ(xk)=(QT+I)e(xk),
其中,迭代次数k=0,1,2,…,||·||2表示向量的二范数。给定初始值x0∈Rn,通过该算法的不断迭代,便可得到分段线性投影方程(7)的解,从而得到二次型优化问题(5)-(6)的最优解,也即加速度层位置调整方案(1)-(4)的最优解。
通过数值算法得到该二次型优化问题的解后,再将求解结果传递给下位机控制器来驱动机械臂使其由极限位置转动到任务执行位置,从而完成冗余度机械臂加速度层运动规划的初始化工作。
综上所述,该冗余度机械臂加速度层运动规划的初始化方法通过先将冗余度机械臂调节到其极限位置1,而后利用该极限位置作为起始值,并设定机械臂任务执行位置作为终止值,建立基于二次型优化描述的加速度层位置调整方案2,而后利用数值算法求解器3对加速度层位置调整方案求解,最后通过该求解结果驱动机械臂使其由极限位置转动到任务执行位置,该冗余度机械臂加速度层运动规划的初始化方法具有操作方便、工作量小、作业规范的优点。
上述仅为本发明的一个具体实施例,但本发明的设计构思并不局限于此,凡利用此构思对本发明进行非实质性的改动,均应属于侵犯本发明保护范围的行为。
Claims (3)
1.一种冗余度机械臂加速度层运动规划的初始化方法,其特征在于:包括以下步骤:
1)启动机械臂控制器,将冗余度机械臂调节到其极限位置,具体操作是依次驱动机械臂各个关节的电机使其最终达到各自的极限位置;
2)将步骤1)的极限位置作为起始值,并设定机械臂任务执行位置作为终止值,建立基于二次型优化描述的加速度层位置调整方案,所述的优化方案受约束于关节角度极限、关节速度极限和关节加速度极限;对于拥有n自由度的机械臂而言,加速度层位置调整方案设计为:
最小化
其中,设计参数γ>0∈R,上标T表示矩阵或向量的转置;θ∈Rn表示关节角度,表示关节速度,表示关节加速度;θd∈Rn为机械臂任务执行初始位置;
加速度层位置调整方案受约束于:
其中,θ±∈Rn、和分别表示关节角度极限、关节速度极限和关节加速度极限;
3)将步骤2)的加速度层位置调整方案利用数值算法进行求解;
4)下位机控制器根据步骤3)的求解结果,驱动机械臂使其由极限位置转动到任务执行位置。
2.根据权利要求1所述的冗余度机械臂加速度层运动规划的初始化方法,其特征在于:步骤2)中,将机械臂的关节极限转化为在加速度层上描述的双端约束,具体操作是利用约束转换方法将θ-≤θ≤θ+,和转化描述为一个基于关节加速度的双端约束,即,其中η-∈Rn和η+∈Rn的第i个元素分别定义为和i=1,2,…n,关节极限转换参数k1>0∈R和k2>0∈R,关节极限转换裕量
3.根据权利要求1所述的冗余度机械臂加速度层运动规划的初始化方法,其特征在于:步骤3)中,通过数值算法对加速度层位置调整方案进行求解,具体操作是将所述加速度层位置调整方案进一步变换为分段线性投影方程,从而构造相应的数值算法进行求解。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510843147.1A CN105598984B (zh) | 2015-11-26 | 2015-11-26 | 一种冗余度机械臂加速度层运动规划的初始化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510843147.1A CN105598984B (zh) | 2015-11-26 | 2015-11-26 | 一种冗余度机械臂加速度层运动规划的初始化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105598984A true CN105598984A (zh) | 2016-05-25 |
CN105598984B CN105598984B (zh) | 2017-10-20 |
Family
ID=55979587
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510843147.1A Expired - Fee Related CN105598984B (zh) | 2015-11-26 | 2015-11-26 | 一种冗余度机械臂加速度层运动规划的初始化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105598984B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106625680A (zh) * | 2017-02-07 | 2017-05-10 | 华侨大学 | 一种冗余度机械臂加速度层容噪控制方法 |
CN107127754A (zh) * | 2017-05-09 | 2017-09-05 | 浙江工业大学 | 一种基于终态吸引优化指标的冗余机械臂重复运动规划方法 |
CN107361847A (zh) * | 2017-08-17 | 2017-11-21 | 成都中科博恩思医学机器人有限公司 | 一种初始化手术机器人中手术器械的方法及对应装置 |
CN108098777A (zh) * | 2018-01-12 | 2018-06-01 | 华侨大学 | 一种冗余度机械臂力矩层重复运动控制方法 |
CN109648567A (zh) * | 2019-01-25 | 2019-04-19 | 华侨大学 | 一种具有容噪特性的冗余度机械臂高精度规划方法 |
CN112518749A (zh) * | 2020-11-30 | 2021-03-19 | 国网浙江省电力有限公司宁波供电公司 | 一种电力巡检机器人机械臂 |
CN113771038A (zh) * | 2021-09-28 | 2021-12-10 | 千翼蓝犀智能制造科技(广州)有限公司 | 一种冗余度机械臂突加度层运动规划的初始化方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030195643A1 (en) * | 2002-04-11 | 2003-10-16 | Knirck Jeffrey G. | Method and apparatus for acceleration limiting a position command for motion control |
CN101927495A (zh) * | 2010-08-25 | 2010-12-29 | 中山大学 | 一种冗余度机械臂重复运动规划方法 |
CN103144111A (zh) * | 2013-02-26 | 2013-06-12 | 中山大学 | 一种qp统一协调的移动机械臂运动描述与规划方法 |
CN103231381A (zh) * | 2013-05-03 | 2013-08-07 | 中山大学 | 一种冗余度机械臂的新型加速度层重复运动规划方法 |
CN104908040A (zh) * | 2015-06-23 | 2015-09-16 | 广东顺德中山大学卡内基梅隆大学国际联合研究院 | 一种冗余度机械臂加速度层的容错规划方法 |
-
2015
- 2015-11-26 CN CN201510843147.1A patent/CN105598984B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030195643A1 (en) * | 2002-04-11 | 2003-10-16 | Knirck Jeffrey G. | Method and apparatus for acceleration limiting a position command for motion control |
CN101927495A (zh) * | 2010-08-25 | 2010-12-29 | 中山大学 | 一种冗余度机械臂重复运动规划方法 |
CN103144111A (zh) * | 2013-02-26 | 2013-06-12 | 中山大学 | 一种qp统一协调的移动机械臂运动描述与规划方法 |
CN103231381A (zh) * | 2013-05-03 | 2013-08-07 | 中山大学 | 一种冗余度机械臂的新型加速度层重复运动规划方法 |
CN104908040A (zh) * | 2015-06-23 | 2015-09-16 | 广东顺德中山大学卡内基梅隆大学国际联合研究院 | 一种冗余度机械臂加速度层的容错规划方法 |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106625680A (zh) * | 2017-02-07 | 2017-05-10 | 华侨大学 | 一种冗余度机械臂加速度层容噪控制方法 |
CN106625680B (zh) * | 2017-02-07 | 2019-07-09 | 华侨大学 | 一种冗余度机械臂加速度层容噪控制方法 |
CN107127754A (zh) * | 2017-05-09 | 2017-09-05 | 浙江工业大学 | 一种基于终态吸引优化指标的冗余机械臂重复运动规划方法 |
CN107361847A (zh) * | 2017-08-17 | 2017-11-21 | 成都中科博恩思医学机器人有限公司 | 一种初始化手术机器人中手术器械的方法及对应装置 |
CN107361847B (zh) * | 2017-08-17 | 2019-12-06 | 成都博恩思医学机器人有限公司 | 一种初始化手术机器人中手术器械的方法及对应装置 |
CN108098777A (zh) * | 2018-01-12 | 2018-06-01 | 华侨大学 | 一种冗余度机械臂力矩层重复运动控制方法 |
CN109648567A (zh) * | 2019-01-25 | 2019-04-19 | 华侨大学 | 一种具有容噪特性的冗余度机械臂高精度规划方法 |
CN109648567B (zh) * | 2019-01-25 | 2021-08-03 | 华侨大学 | 一种具有容噪特性的冗余度机械臂规划方法 |
CN112518749A (zh) * | 2020-11-30 | 2021-03-19 | 国网浙江省电力有限公司宁波供电公司 | 一种电力巡检机器人机械臂 |
CN113771038A (zh) * | 2021-09-28 | 2021-12-10 | 千翼蓝犀智能制造科技(广州)有限公司 | 一种冗余度机械臂突加度层运动规划的初始化方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105598984B (zh) | 2017-10-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105598984A (zh) | 一种冗余度机械臂加速度层运动规划的初始化方法 | |
CN101927495B (zh) | 一种冗余度机械臂重复运动规划方法 | |
CN101890718A (zh) | 一种冗余度机械臂运动规划的初始化方法 | |
CN103492133B (zh) | 具有运动冗余臂的工业机器人和用于控制该机器人的方法 | |
CN105353725B (zh) | 用于工业机器人的过辅助点姿态空间圆弧插补方法 | |
JP4137909B2 (ja) | ロボットプログラム補正装置 | |
CN104889986B (zh) | 机器人控制装置 | |
CN108568814A (zh) | 机器人以及机器人的控制方法 | |
CN104684695A (zh) | 用于修改机器人轨迹的方法和编程装置 | |
CN101804627A (zh) | 一种冗余度机械臂运动规划方法 | |
CN105607636A (zh) | 一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 | |
CN102785248A (zh) | 一种解耦型六自由度工业机器人的运动控制方法 | |
CN102514008A (zh) | 一种冗余度机械臂的不同层性能指标同时优化方法 | |
CN105856231A (zh) | 一种特定构型六轴工业机器人的运动控制方法 | |
CN102033981B (zh) | 热轧h型钢飞剪机初始停位角的设计方法 | |
CN103862465A (zh) | 多关节机械臂坐标校正方法和*** | |
JP6802208B2 (ja) | 熱変位補正システム及び計算機 | |
WO2021231242A1 (en) | Accelerating robotic planning for operating on deformable objects | |
CN102983807A (zh) | 异步电机转子时间常数在线识别***及方法 | |
JP2009148850A (ja) | ロボットの動作制御装置及びその動作制御方法 | |
CN103279029A (zh) | 多机器人手臂***的自适应协调控制方法 | |
CN101870104B (zh) | 机械手臂反向运动方法 | |
CN102354120A (zh) | 混凝土泵车智能臂架***的仿真实验装置及方法 | |
CN103605290B (zh) | 基于向量方法的鲁棒分数阶PDμ控制器的参数整定方法 | |
CN113787502B (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 | ||
GR01 | Patent grant | ||
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: 20171020 |