CN106737670B - 一种具有抗噪特性的冗余度机械臂重复运动规划方法 - Google Patents
一种具有抗噪特性的冗余度机械臂重复运动规划方法 Download PDFInfo
- Publication number
- CN106737670B CN106737670B CN201611159120.1A CN201611159120A CN106737670B CN 106737670 B CN106737670 B CN 106737670B CN 201611159120 A CN201611159120 A CN 201611159120A CN 106737670 B CN106737670 B CN 106737670B
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- noiseproof feature
- indicate
- joint
- programme
- 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.)
- Active
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/1628—Programme controls characterised by the control loop
- B25J9/1643—Programme controls characterised by the control loop redundant control
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
Abstract
本发明提供了一种具有抗噪特性的冗余度机械臂重复运动规划方法,如下:根据机械臂的雅可比矩阵等式,通过引入位置误差反馈,设计具有抗噪特性的新型雅可比矩阵等式;结合所需要优化的性能指标,建立相应的重复运动规划方案,所述的规划方案受约束于新型雅可比矩阵等式、关节角度极限和关节速度极限;将上述的冗余度解析方案转化为一个统一的二次型优化问题,并通过数值算法求解器对其进行求解;下位机控制器根据求解结果,驱动机械臂使其完成给定的规划任务。本发明基于位置误差反馈而设计的重复运动规划方案,使得机械臂能够在具有噪声的情况下仍可完成给定的末端任务,并实现重复运动规划的目的。
Description
技术领域
本发明涉及冗余度机械臂的规划及控制领域,具体涉及一种具有抗噪特性的冗余度机械臂重复运动规划方法。
背景技术
冗余度机械臂是一种末端能动的机械装置,其拥有的自由度要多于执行末端任务所需的最少自由度;已广泛应用于装备制造和产品加工等国民经济生产活动中。冗余度机械臂的规划和控制中容易存在的一个问题是关节角偏差问题,即,当机械臂末端的运动轨迹是闭合的,在完成给定的规划任务后,机械臂各关节角变量在运动空间中的轨迹不是闭合的。为了解决关节角偏差问题(或称,非重复运动问题),目前已有多种有效的重复运动规划方案被提出。然而,这些方案都是在不考虑噪声的情况下进行研究的;一旦存在噪声,那么它们将失效,从而无法使机械臂能够正常/成功地完成所给定的规划任务。
发明内容
本发明的目的在于克服现有方法的不足,提供一种具有抗噪特性的冗余度机械臂重复运动规划方法。
为了实现上述发明目的,采用的技术方案如下。
一种具有抗噪特性的冗余度机械臂重复运动规划方法,包括以下步骤:
根据机械臂的雅可比矩阵等式,通过引入位置误差反馈,设计具有抗噪特性的新型雅可比矩阵等式;
结合所需要优化的最小化性能指标,建立具有抗噪特性的重复运动规划方案,所述的规划方案受约束于新型雅可比矩阵等式、关节角度极限和关节速度极限;
将具有抗噪特性的重复运动规划方案转化为一个统一的二次型优化问题,并通过数值算法求解器对该优化问题进行求解;
下位机控制器根据二次型优化问题的求解结果,驱动机械臂使其完成给定的规划任务。
具有抗噪特性的新型雅可比矩阵等式设计为:
其中,设计参数α>0,β>0,且两者满足α2>β;θ表示机械臂关节角度,表示机械臂关节速度,J(θ)表示机械臂的雅可比矩阵;e(t)表示机械臂的位置误差且
e(t)=f(θ)-rd,t表示时间,f表示一个非线性映射函数,rd表示机械臂末端期望的运动轨迹;表示rd的时间导数,τ表示积分变量。
具有抗噪特性的重复运动规划方案设计为:
最小化
受约束于θ-≤θ≤θ+,
其中,设计参数λ>0,θ(0)表示机械臂关节的初始状态,上标T表示矩阵或向量的转置;等式约束对应于机械臂在速度层的运动轨迹;θ±和分别表示关节角度极限和关节速度极限。
将具有抗噪特性的重复运动规划方案转化为一个统一的二次型优化问题,其性能指标为xTx/2+pTx,约束条件为Ax=b,x-≤x≤x+,其中,p=λ(θ-θ(0)),A=J(θ),x±表示x的上下限。
通过数值算法求解器对二次型优化问题进行求解,具体为:将所述二次型优化问题进一步变换为分段线性投影方程,从而构造相应的数值算法求解器进行求解。
本发明与先有方法相比,具有以下优点:
本发明能有效克服现有方法的不足,提供了一种能使得冗余度机械臂在具有噪声的情况下仍可完成给定任务的重复运动规划方法。
附图说明
图1为本发明的流程图。
具体实施方式
下面结合附图对本发明做进一步的说明。
图1所示的一种具有抗噪特性的冗余度机械臂重复运动规划方法主要由设计具有抗噪特性的新型雅克比矩阵等式1、建立重复运动规划方案2、转为二次型优化问题3、数值算法求解器4、下位机控制器5、冗余度机械臂6这六个部分组成。
首先根据机械臂的雅可比矩阵等式,通过引入位置误差反馈,设计具有抗噪特性的新型雅可比矩阵等式;然后结合所需要优化的最小化性能指标,建立相应的重复运动规划方案,并将其转化为一个统一的二次型优化问题,从而构造相应的数值算法求解器来求解该优化问题;最后将求解结果用于驱动机械臂的各个关节以使机械臂完成给定的规划任务。
根据机械臂的雅可比矩阵等式,通过引入位置误差反馈,具有抗噪特性的新型雅可比矩阵等式可设计为:
其中设计参数α>0,β>0,且两者满足α2>β;θ表示机械臂关节角度,表示机械臂关节速度,J(θ)表示机械臂的雅可比矩阵;e(t)表示机械臂的位置误差且e(t)=f(θ)-rd,t表示时间,f表示一个非线性映射函数,rd表示机械臂末端期望的运动轨迹;表示rd的时间导数,τ表示积分变量。
基于上述等式(1),结合所需要优化的性能指标,便可建立如下的重复运动规划方案:
最小化
约束条件:
θ-≤θ≤θ+, (4)
其中,设计参数λ>0,θ(0)表示机械臂关节的初始状态,上标T表示矩阵或向量的转置;等式约束对应于机械臂在速度层的运动轨迹;θ±和分别表示关节角度极限和关节速度极限。
对于上述带物理约束的重复运动规划方案(2)-(5),其可转化为如下的二次型优化问题:
最小化xTx/2+pTx, (6)
约束条件:Ax=b, (7)
x-≤x≤x+, (8)
其中,p=λ(θ-θ(0)),A=J(θ),x±表示x的上下限。
并且,上述的二次型优化问题(6)-(8)等价于如下的分段线性投影方程:
PΩ(y-(My+q))-y=0, (9)
其中,PΩ(·)表示分段线性投影算子。分段线性投影方程(9)中的原对偶决策变向量y,增广系数矩阵M和向量q分别定义如下:
其中,I表示单位矩阵,对偶决策变量u对应于等式约束(7)。对于上述的分段线性投影方程(9)和二次型优化问题(6)-(8),可采用如下的数值算法来进行求解:
e(yk)=yk-PΩ(yk-(Myk+q)),
yk+1=yk-ρ(yk)φ(yk),
φ(yk)=(MT+I)e(yk),
其中,||·||2表示向量的二范数,迭代次数k=0,1,2,…。给定一个初始值y0,通过该算法的不断迭代,便可得到分段线性投影方程(9)的解,从而得到二次型优化问题(6)-(8)的最优解,也即前文所述的具有抗噪特性的重复运动规划方案(2)-(5)的最优解。
通过数值算法求解器得到该二次型优化问题的最优解之后,再将求解结果传递给下位机控制器驱动机械臂的运动,从而使得机械臂完成所给定的规划任务。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (2)
1.一种具有抗噪特性的冗余度机械臂重复运动规划方法,其特征在于,包括:
根据机械臂的雅可比矩阵等式,通过引入位置误差反馈,设计具有抗噪特性的新型雅可比矩阵等式;
结合所需要优化的最小化性能指标,建立具有抗噪特性的重复运动规划方案,所述的规划方案受约束于新型雅可比矩阵等式、关节角度极限和关节速度极限;
将具有抗噪特性的重复运动规划方案转化为一个统一的二次型优化问题,并通过数值算法求解器对该优化问题进行求解;
下位机控制器根据二次型优化问题的求解结果,驱动机械臂使其完成给定的规划任务;
具有抗噪特性的新型雅可比矩阵等式设计为:
其中,设计参数α>0,β>0,且两者满足α2>β;θ表示机械臂关节角度,表示机械臂关节速度,J(θ)表示机械臂的雅可比矩阵;e(t)表示机械臂的位置误差且e(t)=f(θ)-rd,t表示时间,f表示一个非线性映射函数,rd表示机械臂末端期望的运动轨迹;表示rd的时间导数,τ表示积分变量;
具有抗噪特性的重复运动规划方案设计为:
最小化
受约束于
其中,设计参数λ>0,θ(0)表示机械臂关节的初始状态,上标T表示矩阵或向量的转置;等式约束对应于机械臂在速度层的运动轨迹;θ±和分别表示关节角度极限和关节速度极限;
将具有抗噪特性的重复运动规划方案转化为一个统一的二次型优化问题,其性能指标为xTx/2+pTx,约束条件为Ax=b,x-≤x≤x+,其中,p=λ(θ-θ(0)),A=J(θ),x±表示x的上下限。
2.根据权利要求1所述的具有抗噪特性的冗余度机械臂重复运动规划方法,其特征在于,通过数值算法求解器对二次型优化问题进行求解,具体为:将所述二次型优化问题进一步变换为分段线性投影方程,从而构造相应的数值算法求解器进行求解。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611159120.1A CN106737670B (zh) | 2016-12-15 | 2016-12-15 | 一种具有抗噪特性的冗余度机械臂重复运动规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611159120.1A CN106737670B (zh) | 2016-12-15 | 2016-12-15 | 一种具有抗噪特性的冗余度机械臂重复运动规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106737670A CN106737670A (zh) | 2017-05-31 |
CN106737670B true CN106737670B (zh) | 2019-01-25 |
Family
ID=58887564
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611159120.1A Active CN106737670B (zh) | 2016-12-15 | 2016-12-15 | 一种具有抗噪特性的冗余度机械臂重复运动规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106737670B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108015763B (zh) * | 2017-11-17 | 2020-09-22 | 华南理工大学 | 一种抗噪声干扰的冗余度机械臂路径规划方法 |
CN108098777B (zh) * | 2018-01-12 | 2021-04-30 | 华侨大学 | 一种冗余度机械臂力矩层重复运动控制方法 |
CN109129486B (zh) * | 2018-09-26 | 2021-04-30 | 华南理工大学 | 一种抑制周期噪声的冗余度机械臂重复运动规划方法 |
CN109129487B (zh) * | 2018-09-26 | 2021-05-11 | 华南理工大学 | 在周期噪声下基于泰勒型离散周期节律神经网络的冗余度机械臂重复运动规划方法 |
CN109514563B (zh) * | 2019-01-08 | 2021-08-31 | 华侨大学 | 一种自适应抗噪的冗余度机械臂运动规划方法 |
CN109623827B (zh) * | 2019-01-21 | 2023-04-07 | 兰州大学 | 一种高性能冗余度机械臂重复运动规划方法与装置 |
CN109648567B (zh) * | 2019-01-25 | 2021-08-03 | 华侨大学 | 一种具有容噪特性的冗余度机械臂规划方法 |
CN110014427B (zh) * | 2019-03-26 | 2021-11-02 | 华侨大学 | 一种基于伪逆的冗余度机械臂高精度运动规划方法 |
CN112873208A (zh) * | 2021-01-29 | 2021-06-01 | 佛山树客智能机器人科技有限公司 | 一种抗噪与动力学约束的机器人实时运动规划方法及装置 |
CN114571448A (zh) * | 2021-12-30 | 2022-06-03 | 广州铁路职业技术学院(广州铁路机械学校) | 一种关节受限的冗余机械臂伪逆型重复运动规划方法 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104750116A (zh) * | 2014-12-31 | 2015-07-01 | 中国航天科技集团公司第五研究院第五一三研究所 | 一种双臂机器人协调操作的路径规划方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9321175B2 (en) * | 2013-02-28 | 2016-04-26 | Mda U.S. Systems, Llc | Robotic manipulator articulation techniques |
-
2016
- 2016-12-15 CN CN201611159120.1A patent/CN106737670B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104750116A (zh) * | 2014-12-31 | 2015-07-01 | 中国航天科技集团公司第五研究院第五一三研究所 | 一种双臂机器人协调操作的路径规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106737670A (zh) | 2017-05-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106737670B (zh) | 一种具有抗噪特性的冗余度机械臂重复运动规划方法 | |
CN107351081B (zh) | 具有速度优化特性的冗余度机械臂突加度层运动规划方法 | |
CN101927495B (zh) | 一种冗余度机械臂重复运动规划方法 | |
CN104908040B (zh) | 一种冗余度机械臂加速度层的容错规划方法 | |
CN104760041B (zh) | 一种基于突加度的障碍物躲避运动规划方法 | |
CN106625680B (zh) | 一种冗余度机械臂加速度层容噪控制方法 | |
CN108098777B (zh) | 一种冗余度机械臂力矩层重复运动控制方法 | |
CN107891424A (zh) | 一种求解冗余机械臂逆运动学的有限时间神经网络优化方法 | |
CN105159096A (zh) | 一种基于粒子群算法的冗余度空间机械臂关节力矩优化方法 | |
CN105382841B (zh) | 一种基于双通道通讯的遥操作双边控制方法 | |
CN110103225A (zh) | 一种数据驱动的机械臂重复运动控制方法与装置 | |
CN107962566A (zh) | 一种移动机械臂重复运动规划方法 | |
KR102030141B1 (ko) | 로봇의 팔꿈치 제어시스템 및 그 제어방법 | |
Islam et al. | Teleoperation systems with symmetric and unsymmetric time varying communication delay | |
CN108015766A (zh) | 一种非线性约束的原对偶神经网络机器人动作规划方法 | |
CN109129486A (zh) | 一种抑制周期噪声的冗余度机械臂重复运动规划方法 | |
CN109623827A (zh) | 一种高性能冗余度机械臂重复运动规划方法与装置 | |
CN107066698A (zh) | 基于新型数值求解器的冗余度机械臂重复运动规划方法 | |
CN103802113A (zh) | 基于任务和样条曲线的工业机器人路径规划方法 | |
CN109940615A (zh) | 一种面向双臂机械手同步重复运动规划的终态网络优化方法 | |
CN110014427B (zh) | 一种基于伪逆的冗余度机械臂高精度运动规划方法 | |
CN110000788A (zh) | 用于远程操作系统的有限时间容错控制方法 | |
CN109648567B (zh) | 一种具有容噪特性的冗余度机械臂规划方法 | |
CN110303501A (zh) | 一种可容噪的冗余度机械臂加速度层避障规划方法 | |
Zheng et al. | Time‐Varying Impedance Control of Port Hamiltonian System with a New Energy‐Storing Tank |
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 |