CN106625680A - 一种冗余度机械臂加速度层容噪控制方法 - Google Patents
一种冗余度机械臂加速度层容噪控制方法 Download PDFInfo
- Publication number
- CN106625680A CN106625680A CN201710067649.9A CN201710067649A CN106625680A CN 106625680 A CN106625680 A CN 106625680A CN 201710067649 A CN201710067649 A CN 201710067649A CN 106625680 A CN106625680 A CN 106625680A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- joint
- acceleration layer
- uproar
- limit
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1607—Calculation of inertia, jacobian matrixes and inverses
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1643—Programme controls characterised by the control loop redundant control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1651—Programme controls characterised by the control loop acceleration, rate control
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40367—Redundant manipulator
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
Abstract
本发明提供了一种冗余度机械臂加速度层容噪控制方法,包括:根据机械臂加速度层雅可比矩阵等式,通过引入位置误差和速度误差反馈,设计可容噪的新型雅可比矩阵等式;结合所需要优化的性能指标,建立加速度层容噪控制方案,所述的控制方案受约束于新型雅可比矩阵等式、机械臂动力学方程、关节角度极限、关节速度极限、关节加速度极限和关节力矩极限;将上述的控制方案转化为一个标准的二次型优化问题,并通过数值算法求解器对其进行求解;下位机控制器根据求解结果,驱动机械臂使其完成给定的末端任务。本发明的加速度层容噪控制方法,不仅能使机械臂在具有噪声的情况下仍可完成给定的末端任务,而且使机械臂各关节的末态速度接近为零。
Description
技术领域
本发明涉及冗余度机械臂的规划及控制领域,具体涉及一种冗余度机械臂加速度层容噪控制方法。
背景技术
冗余度机械臂是一种自身自由度多于执行末端任务所需最少自由度的机械装置,其末端任务包括组装、焊接和绘图等。冗余度机械臂规划控制中的一个关键问题是冗余度解析问题,即,如何通过给定的机械臂末端位姿信息来确定机械臂各个关节的角度/速度/加速度。目前已有多种加速度层冗余度解析方案(即用以求解冗余度解析问题的控制方案)被提出并实现了对机械臂的有效规划控制。然而,这些控制方案并没有把机械臂的关节力矩极限考虑在内,且其解析得到的末态速度往往不为零,因而难以广泛适用于实际工程当中。更重要的是,这些控制方案都是在不考虑噪声的情况下进行研究设计的;一旦存在噪声,那么它们将失效,从而无法使机械臂能够正常/成功地完成所给定的末端任务。
发明内容
本发明的目的在于克服现有方法的不足,提供一种冗余度机械臂加速度层容噪控制方法,不仅能使机械臂在具有噪声的情况下仍可完成给定的末端任务,而且使机械臂各关节的末态速度接近为零。
为了实现上述发明目的,采用的技术方案如下。
一种冗余度机械臂加速度层容噪控制方法,包括以下步骤:
根据机械臂加速度层雅可比矩阵等式,通过引入位置误差和速度误差反馈,设计可容噪的新型雅可比矩阵等式;
结合所需要优化的性能指标,建立加速度层容噪控制方案,所述的控制方案受约束于新型雅可比矩阵等式、机械臂动力学方程、关节角度极限、关节速度极限、关节加速度极限和关节力矩极限;
将加速度层容噪控制方案转化为一个标准的二次型优化问题,并通过数值算法求解器对其进行求解;
下位机控制器根据二次型优化问题的求解结果,驱动机械臂使其完成给定的末端任务。
可容噪的新型加速度层雅可比矩阵等式设计为:
其中,设计参数α>0,β>0,且两者满足α2>β;表示机械臂关节速度,表示机械臂关节加速度,J表示机械臂的雅可比矩阵,表示J的时间导数;e(t)表示机械臂末端的位置误差且e(t)=f(θ)-rd,t表示时间,θ表示机械臂关节角度,f表示一个非线性映射函数,rd表示机械臂末端期望的运动轨迹;ε(t)表示机械臂末端的速度误差且 表示rd的时间导数;另外,表示的时间导数,δ表示积分变量。
加速度层容噪控制方案设计为:
最小化
受约束于θ-≤θ≤θ+,τ-≤τ≤τ+;
其中,设计参数λ>0,上标T表示矩阵或向量的转置;等式约束 对应于机械臂末端在加速度层的运动轨迹;等式约束表示机械臂的动力学方程,H表示机械臂的惯性矩阵,c表示离心力变量,g表示重力变量,τ表示机械臂关节力矩;θ±、和τ±分别表示关节角度极限、关节速度极限、关节加速度极限和关节力矩极限。
将加速度层容噪控制方案转化为一个标准的二次型优化问题,其性能指标为xTx/2+pTx,约束条件为Cx=d,Ax≤b,x-≤x≤x+,其中,C=J,A=[-HT HT]T,b=[(c+g-τ-)T (τ+-c-g)T]T,x±表示x的上下限。
通过数值算法求解器对二次型优化问题进行求解,具体为:将所述二次型优化问题进一步变换为分段线性投影方程,从而构造相应的数值算法求解器进行求解。
本发明与先有方法相比,具有以下优点:
不仅能使机械臂在具有噪声的情况下仍可完成给定的末端任务,而且使机械臂各关节的末态速度接近为零。
以下结合附图及实施例对本发明作进一步详细说明,但本发明的一种冗余度机械臂加速度层容噪控制方法不局限于实施例。
附图说明
图1为本发明方法的流程图。
具体实施方式
下面结合附图对本发明做进一步的说明。
如图1所示的一种冗余度机械臂加速度层容噪控制方法主要由设计可容噪的加速度层雅克比矩阵等式1、建立加速度层容噪控制方案2、转为标准的二次型优化问题3、数值算法求解器4、下位机控制器5、冗余度机械臂6这六个部分组成。
首先根据机械臂加速度层雅可比矩阵等式,通过引入位置误差和速度误差反馈,设计可容噪的新型雅可比矩阵等式;然后结合所需要优化的性能指标,建立加速度层容噪控制方案,并将其转化为一个标准的二次型优化问题,从而构造相应的数值算法求解器来求解该优化问题;最后将求解结果用于驱动机械臂的各个关节以使机械臂完成给定的末端任务。
根据机械臂加速度层雅可比矩阵等式,通过引入位置误差和速度误差反馈,可容噪的新型雅可比矩阵等式设计为:
其中设计参数α>0,β>0,且两者满足α2>β;表示机械臂关节速度,表示机械臂关节速度,J表示机械臂的雅可比矩阵,表示J的时间导数;e(t )表示机械臂末端的位置误差且e(t)=f(θ)-rd,t表示时间,θ表示机械臂关节角度,f表示一个非线性映射函数,rd表示机械臂末端期望的运动轨迹;ε(t)表示机械臂末端的速度误差且 表示rd的时间导数;另外,表示的时间导数,δ表示积分变量。
基于上述等式(1),结合所需要优化的性能指标,便可建立如下的加速度层容噪控制方案:
最小化
约束条件:
θ-≤θ≤θ+, (5)
τ-≤τ≤τ+, (8)
其中设计参数λ>0,上标T表示矩阵或向量的转置;等式约束 对应于机械臂末端在加速度层的运动轨迹;等式约束表示机械臂的动力学方程,H表示机械臂的惯性矩阵,c表示离心力变量,g表示重力变量,τ表示机械臂关节力矩;θ±、和τ±分别表示关节角度极限、关节速度极限、关节加速度极限和关节力矩极限。
对于上述带物理约束的加速度层容噪控制方案(2)-(8),其可转化为如下标准的二次型优化问题:
最小化xTx/2+pTx, (9)
约束条件:Cx=d, (10)
Ax≤b, (11)
x-≤x≤x+, (12)
其中C=J,A=[-HT HT]T,b=[(c+g-τ-)T (τ+-c-g)T]T,x±表示x的上下限。
并且,上述二次型优化问题(9)-(12)的求解可等价于求解如下的分段线性投影方程:
PΩ(y-(My+q))-y=0, (13)
其中,PΩ(·)表示分段线性投影算子。分段线性投影方程(13)中的原对偶决策变向量y,增广系数矩阵M和向量q分别定义如下:
其中,I表示单位矩阵,对偶决策变量u和v分别对应于等式约束(10)和不等式约束(11)。为了求解分段线性投影方程(13)和二次型优化问题(9)-(12),可采用如下的数值算法:
e(yk)=yk-PΩ(yk-(Myk+q)),
yk+1=PΩ(yk-ρ(yk)φ(yk)),
φ(yk)=MTe(yk)+Myk+q,
其中,||·||2表示向量的二范数,迭代次数k=0,1,2,…。给定一个初始值y0,通过该数值算法的不断迭代,便可得到分段线性投影方程(13)的理论解,从而得到二次型优化问题(9)-(12)的最优解,也即前文所述的加速度层容噪控制方案(2)-(8)的最优解。
通过数值算法求解器得到该二次型优化问题的最优解之后,再将求解结果传递给下位机控制器驱动机械臂的运动,从而使得机械臂完成所给定的末端任务。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (5)
1.一种冗余度机械臂加速度层容噪控制方法,其特征在于,包括如下步骤:
根据机械臂加速度层雅可比矩阵等式,通过引入位置误差和速度误差反馈,设计可容噪的新型雅可比矩阵等式;
结合所需要优化的性能指标,建立加速度层容噪控制方案,所述的控制方案受约束于新型雅可比矩阵等式、机械臂动力学方程、关节角度极限、关节速度极限、关节加速度极限和关节力矩极限;
将加速度层容噪控制方案转化为一个标准的二次型优化问题,并通过数值算法求解器对其进行求解;
下位机控制器根据二次型优化问题的求解结果,驱动机械臂使其完成给定的末端任务。
2.根据权利要求1所述的冗余度机械臂加速度层容噪控制方法,其特征在于,可容噪的新型加速度层雅可比矩阵等式设计为:
其中,设计参数α>0,β>0,且两者满足α2>β;表示机械臂关节速度,表示机械臂关节加速度,J表示机械臂的雅可比矩阵,表示J的时间导数;e(t)表示机械臂末端的位置误差且e(t)=f(θ)-rd,t表示时间,θ表示机械臂关节角度,f表示一个非线性映射函数,rd表示机械臂末端期望的运动轨迹;ε(t)表示机械臂末端的速度误差且 表示rd的时间导数;另外,表示的时间导数,δ表示积分变量。
3.根据权利要求2所述的冗余度机械臂加速度层容噪控制方法,其特征在于,加速度层容噪控制方案设计为:
最小化
受约束于
其中,设计参数λ>0,上标T表示矩阵或向量的转置;等式约束 对应于机械臂末端在加速度层的运动轨迹;等式约束表示机械臂的动力学方程,H表示机械臂的惯性矩阵,c表示离心力变量,g表示重力变量,τ表示机械臂关节力矩;θ±、和τ±分别表示关节角度极限、关节速度极限、关节加速度极限和关节力矩极限。
4.根据权利要求3所述的冗余度机械臂加速度层容噪控制方法,其特征在于,将加速度层容噪控制方案转化为一个标准的二次型优化问题,其性能指标为xTx/2+pTx,约束条件为Cx=d,Ax≤b,x-≤x≤x+,其中,C=J,A=[-HT HT]T,b=[(c+g-τ-)T(τ+-c-g)T]T,x±表示x的上下限。
5.根据权利要求1至4中任意一项权利要求所述的冗余度机械臂加速度层容噪控制方法,其特征在于,通过数值算法求解器对二次型优化问题进行求解,具体为:将所述二次型优化问题进一步变换为分段线性投影方程,从而构造相应的数值算法求解器进行求解。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710067649.9A CN106625680B (zh) | 2017-02-07 | 2017-02-07 | 一种冗余度机械臂加速度层容噪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710067649.9A CN106625680B (zh) | 2017-02-07 | 2017-02-07 | 一种冗余度机械臂加速度层容噪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106625680A true CN106625680A (zh) | 2017-05-10 |
CN106625680B CN106625680B (zh) | 2019-07-09 |
Family
ID=58846351
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710067649.9A Active CN106625680B (zh) | 2017-02-07 | 2017-02-07 | 一种冗余度机械臂加速度层容噪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106625680B (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108098777A (zh) * | 2018-01-12 | 2018-06-01 | 华侨大学 | 一种冗余度机械臂力矩层重复运动控制方法 |
CN109129486A (zh) * | 2018-09-26 | 2019-01-04 | 华南理工大学 | 一种抑制周期噪声的冗余度机械臂重复运动规划方法 |
CN109648567A (zh) * | 2019-01-25 | 2019-04-19 | 华侨大学 | 一种具有容噪特性的冗余度机械臂高精度规划方法 |
CN110014427A (zh) * | 2019-03-26 | 2019-07-16 | 华侨大学 | 一种基于伪逆的冗余度机械臂高精度运动规划方法 |
CN110303501A (zh) * | 2019-07-25 | 2019-10-08 | 华侨大学 | 一种可容噪的冗余度机械臂加速度层避障规划方法 |
CN110561441A (zh) * | 2019-10-23 | 2019-12-13 | 中山大学 | 一种冗余度机械臂位姿控制的单94lvi迭代算法 |
CN112873208A (zh) * | 2021-01-29 | 2021-06-01 | 佛山树客智能机器人科技有限公司 | 一种抗噪与动力学约束的机器人实时运动规划方法及装置 |
CN113787501A (zh) * | 2021-09-28 | 2021-12-14 | 千翼蓝犀智能制造科技(广州)有限公司 | 一种基于梯度下降的轮式移动机器人状态调整方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4535372A (en) * | 1983-06-29 | 1985-08-13 | Storage Technology Corporation | Position tracking servo control systems and methods |
JPH0619528A (ja) * | 1992-06-30 | 1994-01-28 | Sony Corp | 加減速パターン生成装置及び加減速パターン生成方法、並びにこれに用いる逆運動学問題の解法と時間軸補正方法 |
CN102514008A (zh) * | 2011-11-21 | 2012-06-27 | 中山大学 | 一种冗余度机械臂的不同层性能指标同时优化方法 |
CN103886395A (zh) * | 2014-04-08 | 2014-06-25 | 河海大学 | 一种基于神经网络模型的水库优化调度方法 |
CN104760041A (zh) * | 2015-03-19 | 2015-07-08 | 中山大学 | 一种基于突加度的障碍物躲避运动规划方法 |
CN105598984A (zh) * | 2015-11-26 | 2016-05-25 | 华侨大学 | 一种冗余度机械臂加速度层运动规划的初始化方法 |
-
2017
- 2017-02-07 CN CN201710067649.9A patent/CN106625680B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4535372A (en) * | 1983-06-29 | 1985-08-13 | Storage Technology Corporation | Position tracking servo control systems and methods |
JPH0619528A (ja) * | 1992-06-30 | 1994-01-28 | Sony Corp | 加減速パターン生成装置及び加減速パターン生成方法、並びにこれに用いる逆運動学問題の解法と時間軸補正方法 |
CN102514008A (zh) * | 2011-11-21 | 2012-06-27 | 中山大学 | 一种冗余度机械臂的不同层性能指标同时优化方法 |
CN103886395A (zh) * | 2014-04-08 | 2014-06-25 | 河海大学 | 一种基于神经网络模型的水库优化调度方法 |
CN104760041A (zh) * | 2015-03-19 | 2015-07-08 | 中山大学 | 一种基于突加度的障碍物躲避运动规划方法 |
CN105598984A (zh) * | 2015-11-26 | 2016-05-25 | 华侨大学 | 一种冗余度机械臂加速度层运动规划的初始化方法 |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108098777A (zh) * | 2018-01-12 | 2018-06-01 | 华侨大学 | 一种冗余度机械臂力矩层重复运动控制方法 |
CN109129486B (zh) * | 2018-09-26 | 2021-04-30 | 华南理工大学 | 一种抑制周期噪声的冗余度机械臂重复运动规划方法 |
CN109129486A (zh) * | 2018-09-26 | 2019-01-04 | 华南理工大学 | 一种抑制周期噪声的冗余度机械臂重复运动规划方法 |
CN109648567A (zh) * | 2019-01-25 | 2019-04-19 | 华侨大学 | 一种具有容噪特性的冗余度机械臂高精度规划方法 |
CN109648567B (zh) * | 2019-01-25 | 2021-08-03 | 华侨大学 | 一种具有容噪特性的冗余度机械臂规划方法 |
CN110014427A (zh) * | 2019-03-26 | 2019-07-16 | 华侨大学 | 一种基于伪逆的冗余度机械臂高精度运动规划方法 |
CN110014427B (zh) * | 2019-03-26 | 2021-11-02 | 华侨大学 | 一种基于伪逆的冗余度机械臂高精度运动规划方法 |
CN110303501A (zh) * | 2019-07-25 | 2019-10-08 | 华侨大学 | 一种可容噪的冗余度机械臂加速度层避障规划方法 |
CN110303501B (zh) * | 2019-07-25 | 2022-05-03 | 华侨大学 | 一种可容噪的冗余度机械臂加速度层避障规划方法 |
CN110561441A (zh) * | 2019-10-23 | 2019-12-13 | 中山大学 | 一种冗余度机械臂位姿控制的单94lvi迭代算法 |
CN112873208A (zh) * | 2021-01-29 | 2021-06-01 | 佛山树客智能机器人科技有限公司 | 一种抗噪与动力学约束的机器人实时运动规划方法及装置 |
CN113787501A (zh) * | 2021-09-28 | 2021-12-14 | 千翼蓝犀智能制造科技(广州)有限公司 | 一种基于梯度下降的轮式移动机器人状态调整方法 |
CN113787501B (zh) * | 2021-09-28 | 2023-02-07 | 千翼蓝犀智能制造科技(广州)有限公司 | 一种基于梯度下降的轮式移动机器人状态调整方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106625680B (zh) | 2019-07-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106625680A (zh) | 一种冗余度机械臂加速度层容噪控制方法 | |
CN106737670A (zh) | 一种具有抗噪特性的冗余度机械臂重复运动规划方法 | |
CN102514008A (zh) | 一种冗余度机械臂的不同层性能指标同时优化方法 | |
CN101927495B (zh) | 一种冗余度机械臂重复运动规划方法 | |
Tsai | Solving the inverse dynamics of a Stewart-Gough manipulator by the principle of virtual work | |
CN107351081A (zh) | 具有速度优化特性的冗余度机械臂突加度层运动规划方法 | |
CN104760041B (zh) | 一种基于突加度的障碍物躲避运动规划方法 | |
Kozak et al. | Locally linearized dynamic analysis of parallel manipulators and application of input shaping to reduce vibrations | |
CN107544261A (zh) | 不确定环境接触下的可重构机器人分散学习最优控制方法 | |
CN105538327A (zh) | 一种基于突加度的冗余度机械臂重复运动规划方法 | |
CN104723340A (zh) | 基于连接和阻尼配置的柔性关节机械臂的阻抗控制方法 | |
Bi et al. | An inverse dynamic model of over-constrained parallel kinematic machine based on Newton–Euler formulation | |
CN107263466A (zh) | 空间机器人基于二次规划问题的基座无扰控制方法 | |
CN108098777B (zh) | 一种冗余度机械臂力矩层重复运动控制方法 | |
Zameroski et al. | Rapid swing-free transport of nonlinear payloads using dynamic programming | |
CN107942670A (zh) | 一种双柔性空间机械臂模糊鲁棒滑模削抖运动控制方法 | |
CN109129486A (zh) | 一种抑制周期噪声的冗余度机械臂重复运动规划方法 | |
CN109086557A (zh) | 一种基于欧拉型离散周期节律神经网络的冗余度机械臂重复运动规划方法 | |
CN107066698A (zh) | 基于新型数值求解器的冗余度机械臂重复运动规划方法 | |
Nishimura et al. | Motion control of three-link brachiation robot by using final-state control with error learning | |
Dachang et al. | Adaptive backstepping sliding mode control of trajectory tracking for robotic manipulators | |
Khakpour et al. | Analysis and optimization of a new differentially driven cable parallel robot | |
Sheng et al. | Aerial contact manipulation with soft end-effector compliance and inverse kinematic compensation | |
Ma et al. | Optimal Energy Consumption for Mobile Manipulators Executing Door‐Opening Task | |
Li et al. | Kinematic coupling‐based trajectory planning for rotary crane system with double‐pendulum effects and output constraints |
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 |