CN105598984B - 一种冗余度机械臂加速度层运动规划的初始化方法 - Google Patents
一种冗余度机械臂加速度层运动规划的初始化方法 Download PDFInfo
- Publication number
- CN105598984B CN105598984B CN201510843147.1A CN201510843147A CN105598984B CN 105598984 B CN105598984 B CN 105598984B CN 201510843147 A CN201510843147 A CN 201510843147A CN 105598984 B CN105598984 B CN 105598984B
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- acceleration layer
- msup
- mover
- joint
- 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
- 230000001133 acceleration Effects 0.000 title claims abstract description 42
- 238000000034 method Methods 0.000 title claims abstract description 18
- 238000006243 chemical reaction Methods 0.000 claims description 12
- 239000011159 matrix material Substances 0.000 claims description 4
- 230000017105 transposition Effects 0.000 claims description 3
- 238000005457 optimization Methods 0.000 description 6
- 238000004519 manufacturing process Methods 0.000 description 2
- 230000007812 deficiency Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 239000000203 mixture Substances 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个元素分别定义为和 关节极限转换参数k1＞0∈R和k2＞0∈R，关节极限转换裕量
在本发明的较佳实施例中，步骤3)中，通过数值算法对加速度层位置调整方案进行求解，具体操作是将所述加速度层位置调整方案进一步变换为分段线性投影方程，从而构造相应的数值算法进行求解。
本发明中的冗余度机械臂加速度层运动规划的初始化方法通过先将冗余度机械臂调节到其极限位置，而后利用该极限位置作为起始值，并设定机械臂任务执行位置作为终止值，建立基于二次型优化描述的加速度层位置调整方案，而后利用数值算法对加速度层位置调整方案求解，最后通过该求解结果驱动机械臂使其由极限位置转动到任务执行位置，该冗余度机械臂加速度层运动规划的初始化方法具有操作方便、工作量小、作业规范的优点。
具体实施方式
一种冗余度机械臂加速度层运动规划的初始化方法主要由冗余度机械臂调节到其极限位置、加速度层位置调整方案、数值算法求解器、下位机控制器、冗余度机械臂转动到任务执行位置组成。
首先启动机械臂控制器，将冗余度机械臂调节到其极限位置；再将该极限位置作为起始值，并设定机械臂任务执行位置作为终止值，从而建立基于二次型优化描述的加速度层位置调整方案；然后构造相应的数值算法来求解该加速度层位置调整方案；最后把求解结果用于驱动机械臂使其由极限位置转动到任务执行位置。
基于最小化机械臂各个关节的当前位置与任务执行位置之间偏移量的思想，n自由度冗余度机械臂的加速度层位置调整方案可设计为：
最小化：
约束条件：θ-≤θ≤θ+， (2)
其中，设计参数γ＞0∈R，上标T表示矩阵或向量的转置；θ∈Rn表示关节角度，表示关节速度，表示关节加速度；θd∈Rn为机械臂任务执行初始位置；θ±∈Rn、和表示关节角度极限、关节速度极限和关节加速度极限。
利用约束转换方法将(2)-(4)转化描述为一个基于关节加速度的双端约束，即，其中η-∈Rn和η+∈Rn的第i个元素分别定义为 和 关节极限转换参数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)的最优解。
通过数值算法得到该二次型优化问题的解后，再将求解结果传递给下位机控制器来驱动机械臂使其由极限位置转动到任务执行位置，从而完成冗余度机械臂加速度层运动规划的初始化工作。
综上所述，该冗余度机械臂加速度层运动规划的初始化方法通过先将冗余度机械臂调节到其极限位置，而后利用该极限位置作为起始值，并设定机械臂任务执行位置作为终止值，建立基于二次型优化描述的加速度层位置调整方案，而后利用数值算法求解器对加速度层位置调整方案求解，最后通过该求解结果驱动机械臂使其由极限位置转动到任务执行位置，该冗余度机械臂加速度层运动规划的初始化方法具有操作方便、工作量小、作业规范的优点。
上述仅为本发明的一个具体实施例，但本发明的设计构思并不局限于此，凡利用此构思对本发明进行非实质性的改动，均应属于侵犯本发明保护范围的行为。
Claims (3)
1.一种冗余度机械臂加速度层运动规划的初始化方法，其特征在于：包括以下步骤：
1)启动机械臂控制器，将冗余度机械臂调节到其极限位置，具体操作是依次驱动机械臂各个关节的电机使其最终达到各自的极限位置；
2)将步骤1)的极限位置作为起始值，并设定机械臂任务执行位置作为终止值，建立基于二次型优化描述的加速度层位置调整方案，所述的调整方案受约束于关节角度极限、关节速度极限和关节加速度极限；对于拥有n自由度的机械臂而言，加速度层位置调整方案设计为：
最小化
其中，设计参数γ＞0∈R，上标T表示矩阵或向量的转置；θ∈Rn表示关节角度，表示关节速度，表示关节加速度；θd∈Rn为机械臂任务执行初始位置；
加速度层位置调整方案受约束于：
<mrow>
<msup>
<mi>&theta;</mi>
<mo>-</mo>
</msup>
<mo>&le;</mo>
<mi>&theta;</mi>
<mo>&le;</mo>
<msup>
<mi>&theta;</mi>
<mo>+</mo>
</msup>
<mo>,</mo>
<msup>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
</msup>
<mo>&le;</mo>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>&le;</mo>
<msup>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
</msup>
<mo>,</mo>
<msup>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>-</mo>
</msup>
<mo>&le;</mo>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>&le;</mo>
<msup>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>+</mo>
</msup>
<mo>;</mo>
</mrow>
其中，θ±∈Rn、和分别表示关节角度极限、关节速度极限和关节加速度极限；
3)将步骤2)的加速度层位置调整方案利用数值算法进行求解；
4)下位机控制器根据步骤3)的求解结果，驱动机械臂使其由极限位置转动到任务执行位置。
2.根据权利要求1所述的冗余度机械臂加速度层运动规划的初始化方法，其特征在于：步骤2)中，将机械臂的关节极限转化为在加速度层上描述的双端约束，具体操作是利用约束转换方法将θ-≤θ≤θ+，和转化描述为一个基于关节加速度的双端约束，即，其中η-∈Rn和η+∈Rn的第i个元素分别定义为 和关节极限转换参数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 CN105598984A (zh) | 2016-05-25 |
| CN105598984B true 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) |
Families Citing this family (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106625680B (zh) * | 2017-02-07 | 2019-07-09 | 华侨大学 | 一种冗余度机械臂加速度层容噪控制方法 |
| CN107127754A (zh) * | 2017-05-09 | 2017-09-05 | 浙江工业大学 | 一种基于终态吸引优化指标的冗余机械臂重复运动规划方法 |
| CN107361847B (zh) * | 2017-08-17 | 2019-12-06 | 成都博恩思医学机器人有限公司 | 一种初始化手术机器人中手术器械的方法及对应装置 |
| CN108098777B (zh) * | 2018-01-12 | 2021-04-30 | 华侨大学 | 一种冗余度机械臂力矩层重复运动控制方法 |
| CN109648567B (zh) * | 2019-01-25 | 2021-08-03 | 华侨大学 | 一种具有容噪特性的冗余度机械臂规划方法 |
| CN112518749A (zh) * | 2020-11-30 | 2021-03-19 | 国网浙江省电力有限公司宁波供电公司 | 一种电力巡检机器人机械臂 |
| CN113771038A (zh) * | 2021-09-28 | 2021-12-10 | 千翼蓝犀智能制造科技(广州)有限公司 | 一种冗余度机械臂突加度层运动规划的初始化方法 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| 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 | 广东顺德中山大学卡内基梅隆大学国际联合研究院 | 一种冗余度机械臂加速度层的容错规划方法 |
Family Cites Families (1)
| 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 |
-
2015
- 2015-11-26 CN CN201510843147.1A patent/CN105598984B/zh not_active Expired - Fee Related
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| 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 | 广东顺德中山大学卡内基梅隆大学国际联合研究院 | 一种冗余度机械臂加速度层的容错规划方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN105598984A (zh) | 2016-05-25 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105598984B (zh) | 一种冗余度机械臂加速度层运动规划的初始化方法 | |
| DE102018204740B4 (de) | Aktionsinformationslernvorrichtung, Robotersteuersystem und Aktionsinformationslernverfahren | |
| US10444733B2 (en) | Adjustment device and adjustment method | |
| CN101927495B (zh) | 一种冗余度机械臂重复运动规划方法 | |
| CN101890718B (zh) | 一种冗余度机械臂运动规划的初始化方法 | |
| CN106647282A (zh) | 一种考虑末端运动误差的六自由度机器人轨迹规划方法 | |
| CN108568814A (zh) | 机器人以及机器人的控制方法 | |
| CN105215987A (zh) | 一种工业机器人工艺云系统及其工作方法 | |
| CN102672717B (zh) | 机器人系统 | |
| CN105856231A (zh) | 一种特定构型六轴工业机器人的运动控制方法 | |
| CN105598968B (zh) | 一种并联机械臂的运动规划与控制方法 | |
| US11126149B2 (en) | Control parameter adjusting device and adjusting method using machine learning | |
| GB2584608A (en) | Robot motion optimization system and method | |
| CN107085430A (zh) | 一种轮式机器人参数调校的优化方法、装置和系统 | |
| CN102354107A (zh) | 一种交流位置伺服系统模型参数在线辨识和控制方法 | |
| CN104385279B (zh) | 一种机械手示教方法及系统 | |
| CN103862465A (zh) | 多关节机械臂坐标校正方法和系统 | |
| CN105785913A (zh) | 基于机床轴速度限制的刀具路径切削方向优化方法 | |
| CN103869749B (zh) | 控制装置、控制方法及位置命令补偿方法 | |
| CN110224639A (zh) | 一种基于滑模控制器的偏差耦合控制方法 | |
| CN114611362B (zh) | 一种大型器械工作面的安装调试方法、电子装置及介质 | |
| CN113787501A (zh) | 一种基于梯度下降的轮式移动机器人状态调整方法 | |
| US20180364678A1 (en) | Computer readable information recording medium, evaluation method, and control device | |
| CN107511830A (zh) | 一种五自由度混联机器人控制器参数自适应调整实现方法 | |
| CN107486860A (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 |
Granted publication date: 20171020 |
|
| CF01 | Termination of patent right due to non-payment of annual fee |