CN107255926A - 一种快速求解冗余度机械臂关节角偏移问题的方法 - Google Patents
一种快速求解冗余度机械臂关节角偏移问题的方法 Download PDFInfo
- Publication number
- CN107255926A CN107255926A CN201710499338.XA CN201710499338A CN107255926A CN 107255926 A CN107255926 A CN 107255926A CN 201710499338 A CN201710499338 A CN 201710499338A CN 107255926 A CN107255926 A CN 107255926A
- Authority
- CN
- China
- Prior art keywords
- joint angle
- mechanical arm
- redundancy mechanical
- skew
- arm 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.)
- Granted
Links
Classifications
-
- 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
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
- G06F17/13—Differential equations
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N3/00—Computing arrangements based on biological models
- G06N3/02—Neural networks
- G06N3/04—Architecture, e.g. interconnection topology
- G06N3/049—Temporal neural networks, e.g. delay elements, oscillating neurons or pulsed inputs
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N3/00—Computing arrangements based on biological models
- G06N3/02—Neural networks
- G06N3/08—Learning methods
- G06N3/082—Learning methods modifying the architecture, e.g. adding, deleting or silencing nodes or connections
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Physics (AREA)
- Data Mining & Analysis (AREA)
- Software Systems (AREA)
- Health & Medical Sciences (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Analysis (AREA)
- Evolutionary Computation (AREA)
- Artificial Intelligence (AREA)
- Mathematical Optimization (AREA)
- General Engineering & Computer Science (AREA)
- Computational Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Computing Systems (AREA)
- Biomedical Technology (AREA)
- Biophysics (AREA)
- Computational Linguistics (AREA)
- Molecular Biology (AREA)
- Databases & Information Systems (AREA)
- Operations Research (AREA)
- Algebra (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Medical Informatics (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种快速求解冗余度机械臂关节角偏移问题的方法,包括以下步骤:1)将冗余度机械臂关节角速度层的逆运动学问题设计为考虑反馈的关节角无偏移规划;2)将步骤1)的关节角无偏移规划写成一个标准的二次规划;3)将步骤2)中标准的二次规划通过拉格朗日乘子法转化为时变矩阵等式的求解问题;4)将步骤3)的时变矩阵等式用变参收敛微分神经网络来求解。本发明采用一种新颖的变参收敛微分神经网络对考虑反馈的冗余度机械臂关节角无偏移规划进行求解,具有可行性高、计算效率高、计算精度高、实时性强、安全性好的优点。
Description
技术领域
本发明涉及冗余度机械臂控制领域,具体涉及一种基于变参收敛微分神经网络来解决冗余度机械臂关节角偏移问题的方法。
背景技术
冗余度机械臂在完成末端执行任务时具有比其所需自由度更多的自由度,这种更多的自由度可以提高机械臂的性能,如躲避障碍物和奇异点等。但是更多的自由度就意味着对应一个末端执行器位置点,可以得到无穷个关节角度解。所以末端执行器在完成一个闭合路径任务时,冗余度机械臂的关节角偏移问题就很有可能会出现。如果关节角偏移问题不能得以解决,就会影响到下个周期任务的精度,甚至会使机械臂的关节扭伤,影响生产过程,损害周围设备并伤害工作人员。固然我们可以在每个周期任务完成时通过调节关节的运动来解决关节角偏移问题,但是这种方法效率很低。
一种传统的解决关节角偏移问题的方法是基于伪逆的方法,但是这种方法并不能在任何关节状态下都能解决问题。为了解决冗余度机械臂的关节角偏移问题,关节角无偏移规划被提出,其主要思想是最小化关节角的末状态和初状态的差,接着将关节角无偏移规划写成标准的二次规划问题,求解二次规划问题的方法有数值方法求解器和神经网络求解器,其中神经网络求解器在近年来更受欢迎。因为神经网络求解器具有并行计算能力和更好的效率。在目前的神经动力学方法中,设计参数都是固定的,而本发明的神经网络设计参数是随着时间变化的,具有更快的收敛速度,鲁棒性更好,又因为设计方法基于微分理论,称为变参收敛微分神经网络。
发明内容
本发明的目的是针对现有技术的不足,提供了一种快速求解冗余度机械臂关节角偏移问题的方法。
本发明的目的可以通过如下技术方案实现:
一种快速求解冗余度机械臂关节角偏移问题的方法,所述方法包括以下步骤:
1)将冗余度机械臂关节角速度层的逆运动学问题设计为考虑反馈的关节角无偏移规划;
2)将步骤1)的关节角无偏移规划写成一个标准的二次规划;
3)将步骤2)中标准的二次规划通过拉格朗日乘子法转化为时变矩阵等式的求解问题;
4)将步骤3)的时变矩阵等式用变参收敛微分神经网络来求解。
进一步地,所述步骤1)的将冗余度机械臂关节角速度层的逆运动学问题设计为考虑反馈的关节角无偏移规划,即将冗余度机械臂关节角速度层无偏移性能指标设计为最小化,受约束于其中,θ(t)表示关节角度矢量,表示关节角速度矢量,W(t)表示I为单位矩阵,r(t)表示机械臂末端执行器位置矢量,表示机械臂末端执行器位置速度矢量,J(θ)表示雅可比矩阵c(t)为k(θ(t)-θ(0)),k为用来控制关节偏移的收敛系数,上标T表示转置,在约束等式中,为机械臂关节角速度层的逆运动学方程,K(r(t)-f(θ))表示添加反馈控制,K表示正定对称的反馈增益矩阵,f(·)表示机械臂末端执行器位置矢量关于关节角度矢量的非线性关系。
进一步地,所述步骤2)的将关节角无偏移规划写成一个标准的二次规划,即设计性能指标为最小化(xT(t)W(t)x(t))/2+cT(t)x(t),受约束于J(θ)x(t)=b(t),其中c(t)=k(θ(t)-θ(0)),
进一步地,所述步骤3)将标准的二次规划通过拉格朗日乘子法L(x(t),λ(t),t)=(xT(t)W(t)x(t))/2+cT(t)x(t)+λT(t)(J(θ)x(t)-b(t))转化为时变矩阵等式A(t)y(t)=g(t)的求解问题,其中λ(t)为拉格朗日因子,
进一步地,所述步骤4)将时变矩阵等式用变参收敛微分神经网络来求解,即其中(γ+tγ)为变参收敛微分神经网络的收敛速度参数,Φ(·)为激活函数矢量,由确定数量的标量单调递增的奇的激活函数子函数φ(·)组成。
本发明与现有技术相比,具有如下优点和有益效果:
1、本发明通过微分方程理论,设计了带有变参的负的时间倒数的神经网络,具有超指数收敛性,使收敛速度大大增加。
2、本发明采用带有变参的负的时间倒数的神经网络来求解关节角无偏移规划,大幅提高了关节角无偏移精度,大幅减小了关节角偏移值。
附图说明
图1为本发明实施例快速求解冗余度机械臂关节角偏移问题方法的流程图。
图2为冗余度机械臂出现关节角偏移问题的示意图。
图3为实现了本发明实施例的冗余度机械臂关节角无偏移规划的示意图。
具体实施方式
下面结合实施例及附图对本发明作进一步详细的描述,但本发明的实施方式不限于此。
实施例:
本实施例提供了一种快速求解冗余度机械臂关节角偏移问题的方法,流程图如图1所示,包括以下步骤:
1)将冗余度机械臂关节角速度层的逆运动学问题设计为考虑反馈的关节角无偏移规划;
2)将步骤1)的关节角无偏移规划写成一个标准的二次规划;
3)将步骤2)中标准的二次规划通过拉格朗日乘子法转化为时变矩阵等式的求解问题;
4)将步骤3)的时变矩阵等式用变参收敛微分神经网络来求解。
图2为机械臂出现关节角偏移问题的示意图,给定末端任务为一个闭合的桃心形曲线,由图中可看出,当机械臂完成闭合路径的任务后,机械臂的末状态和初始状态不重合,出现了关节角偏移问题。经过本实施例的改进后,实现了机械臂关节角的无偏移规划,示意图如图3所示。
所述方法的具体过程如下:将冗余度机械臂关节角速度层的逆运动学问题设计为考虑反馈的关节角无偏移规划,即将冗余度机械臂关节角速度层无偏移性能指标设计为最小化,受约束于其中,θ(t)表示t时刻的关节角度矢量,表示t时刻的关节角速度矢量,W(t)表示θ(0)表示关节角度的初始状态,为(θ(t)-θ(0))的二范数的平方,I为单位矩阵,r(t)表示机械臂末端执行器位置矢量,r(t)表示机械臂末端执行器位置速度矢量,J(θ)表示雅可比矩阵c(t)为k(θ(t)-θ(0)),k用来控制关节偏移的收敛系数,上标T表示转置,在约束等式中,为机械臂关节角速度层的逆运动学方程,K(r(t)-f(θ))表示添加反馈控制,K表示正定对称的反馈增益矩阵,f(·)表示机械臂末端执行器位置矢量关于关节角度矢量的非线性关系;
将上述关节角无偏移规划写成一个标准的二次规划,即设计性能指标为最小化(xT(t)W(t)x(t))/2+cT(t)x(t),受约束于J(θ)x(t)=b(t),其中 c(t)=k(θ(t)-θ(0)),
通过拉格朗日乘子法构造拉格朗日函数:
L(x(t),λ(t),t)=(xT(t)W(t)x(t))/2+cT(t)x(t)+λT(t)(J(θ)x(t)-b(t))
其中λ(t)为拉格朗日因子,拉格朗日函数分别对x(t)和λ(t)求偏导并令其等于零得:
写为一个时变矩阵等式:A(t)y(t)=g(t),其中:
定义矢量误差函数:ε(t)=A(t)y(t)-g(t),为了让矢量误差函数趋近于零,根据神经动力学的设计方法,需要矢量误差函数有负的时间倒数,则可以设计如下负的时间倒数:(dε(t))/dt=-(γ+tγ)Φ(ε(t)),其中:(γ+tγ)为变参收敛微分神经网络的收敛速度参数,Φ(·)为激活函数矢量,由确定数量的标量的单调递增的奇的激活函数子函数φ(·)组成,将矢量误差函数代入设计的负的时间导数得到如下隐式动力学方程:由于此种设计方法是基于微分方程理论,并且设计参数(γ+tγ)是随时间变化的,所以称为变参收敛微分神经网络。
以上所述,仅为本发明专利较佳的实施例,但本发明专利的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明专利所公开的范围内,根据本发明专利的技术方案及其发明专利构思加以等同替换或改变,都属于本发明专利的保护范围。
Claims (5)
1.一种快速求解冗余度机械臂关节角偏移问题的方法,其特征在于,所述方法包括以下步骤:
1)将冗余度机械臂关节角速度层的逆运动学问题设计为考虑反馈的关节角无偏移规划;
2)将步骤1)的关节角无偏移规划写成一个标准的二次规划;
3)将步骤2)中标准的二次规划通过拉格朗日乘子法转化为时变矩阵等式的求解问题;
4)将步骤3)的时变矩阵等式用变参收敛微分神经网络来求解。
2.根据权利要求1所述的一种快速求解冗余度机械臂关节角偏移问题的方法,其特征在于:所述步骤1)的将冗余度机械臂关节角速度层的逆运动学问题设计为考虑反馈的关节角无偏移规划,即将冗余度机械臂关节角速度层无偏移性能指标设计为最小化,受约束于其中,θ(t)表示关节角度矢量,表示关节角速度矢量,W(t)表示I为单位矩阵,r(t)表示机械臂末端执行器位置矢量,表示机械臂末端执行器位置速度矢量,J(θ)表示雅可比矩阵c(t)为k(θ(t)-θ(0)),k为用来控制关节偏移的收敛系数,上标T表示转置,在约束等式中,为机械臂关节角速度层的逆运动学方程,K(r(t)-f(θ))表示添加反馈控制,K表示正定对称的反馈增益矩阵,f(·)表示机械臂末端执行器位置矢量关于关节角度矢量的非线性关系。
3.根据权利要求1所述的一种快速求解冗余度机械臂关节角偏移问题的方法,其特征在于:所述步骤2)的将关节角无偏移规划写成一个标准的二次规划,即设计性能指标为最小化(xT(t)W(t)x(t))/2+cT(t)x(t),受约束于J(θ)x(t)=b(t),其中 c(t)=k(θ(t)-θ(0)),
4.根据权利要求1所述的一种快速求解冗余度机械臂关节角偏移问题的方法,其特征在于:所述步骤3)将标准的二次规划通过拉格朗日乘子法L(x(t),λ(t),t)=(xT(t)W(t)x(t))/2+cT(t)x(t)+λT(t)(J(θ)x(t)-b(t))转化为时变矩阵等式A(t)y(t)=g(t)的求解问题,其中λ(t)为拉格朗日因子,
5.根据权利要求1所述的一种快速求解冗余度机械臂关节角偏移问题的方法,其特征在于:所述步骤4)将时变矩阵等式用变参收敛微分神经网络来求解,即其中(γ+tγ)为变参收敛微分神经网络的收敛速度参数,Φ(·)为激活函数矢量,由确定数量的标量单调递增的奇的激活函数子函数φ(·)组成。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710499338.XA CN107255926B (zh) | 2017-06-27 | 2017-06-27 | 一种快速求解冗余度机械臂关节角偏移问题的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710499338.XA CN107255926B (zh) | 2017-06-27 | 2017-06-27 | 一种快速求解冗余度机械臂关节角偏移问题的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107255926A true CN107255926A (zh) | 2017-10-17 |
CN107255926B CN107255926B (zh) | 2019-08-20 |
Family
ID=60023373
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710499338.XA Active CN107255926B (zh) | 2017-06-27 | 2017-06-27 | 一种快速求解冗余度机械臂关节角偏移问题的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107255926B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109086557A (zh) * | 2018-09-26 | 2018-12-25 | 华南理工大学 | 一种基于欧拉型离散周期节律神经网络的冗余度机械臂重复运动规划方法 |
CN109190085A (zh) * | 2018-07-27 | 2019-01-11 | 华南理工大学 | 一种实数域光滑时变矩阵pxq=w系统的求解设计方法 |
CN110076770A (zh) * | 2019-03-28 | 2019-08-02 | 陕西理工大学 | 一种用于冗余机械臂的自运动方法 |
CN111037550A (zh) * | 2019-12-03 | 2020-04-21 | 华南理工大学 | 一种冗余度机械臂运动控制的解决方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100229669A1 (en) * | 2009-03-16 | 2010-09-16 | Korea Advanced Institute Of Science And Technology | Manipulator with distributed actuation mechanism |
US20110093119A1 (en) * | 2009-10-16 | 2011-04-21 | Samsung Electronics Co., Ltd. | Teaching and playback method based on control of redundancy resolution for robot and computer-readable medium controlling the same |
CN105538327A (zh) * | 2016-03-03 | 2016-05-04 | 吉首大学 | 一种基于突加度的冗余度机械臂重复运动规划方法 |
CN106426164A (zh) * | 2016-09-27 | 2017-02-22 | 华南理工大学 | 一种冗余度双机械臂的多指标协调运动规划方法 |
CN106842907A (zh) * | 2017-02-16 | 2017-06-13 | 香港理工大学深圳研究院 | 一种多冗余度机械臂系统的协同控制方法与装置 |
-
2017
- 2017-06-27 CN CN201710499338.XA patent/CN107255926B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100229669A1 (en) * | 2009-03-16 | 2010-09-16 | Korea Advanced Institute Of Science And Technology | Manipulator with distributed actuation mechanism |
US20110093119A1 (en) * | 2009-10-16 | 2011-04-21 | Samsung Electronics Co., Ltd. | Teaching and playback method based on control of redundancy resolution for robot and computer-readable medium controlling the same |
CN105538327A (zh) * | 2016-03-03 | 2016-05-04 | 吉首大学 | 一种基于突加度的冗余度机械臂重复运动规划方法 |
CN106426164A (zh) * | 2016-09-27 | 2017-02-22 | 华南理工大学 | 一种冗余度双机械臂的多指标协调运动规划方法 |
CN106842907A (zh) * | 2017-02-16 | 2017-06-13 | 香港理工大学深圳研究院 | 一种多冗余度机械臂系统的协同控制方法与装置 |
Non-Patent Citations (2)
Title |
---|
CHAN T F: "A weighted least-norm solution based scheme for aviding joint limits for redundant manipulators", 《PROC. OF IEEE INT.CONF.ON R.& A》 * |
余轩峰: "有限时间收敛神经网络及其相关应用", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109190085A (zh) * | 2018-07-27 | 2019-01-11 | 华南理工大学 | 一种实数域光滑时变矩阵pxq=w系统的求解设计方法 |
CN109190085B (zh) * | 2018-07-27 | 2022-04-22 | 华南理工大学 | 一种实数域光滑时变矩阵pxq=w系统的求解设计方法 |
CN109086557A (zh) * | 2018-09-26 | 2018-12-25 | 华南理工大学 | 一种基于欧拉型离散周期节律神经网络的冗余度机械臂重复运动规划方法 |
CN109086557B (zh) * | 2018-09-26 | 2022-05-24 | 华南理工大学 | 一种基于欧拉型离散周期节律神经网络的冗余度机械臂重复运动规划方法 |
CN110076770A (zh) * | 2019-03-28 | 2019-08-02 | 陕西理工大学 | 一种用于冗余机械臂的自运动方法 |
CN111037550A (zh) * | 2019-12-03 | 2020-04-21 | 华南理工大学 | 一种冗余度机械臂运动控制的解决方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107255926B (zh) | 2019-08-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107255926A (zh) | 一种快速求解冗余度机械臂关节角偏移问题的方法 | |
WO2018176854A1 (zh) | 一种冗余度机械臂重复运动规划方法 | |
CN106985138B (zh) | 基于终态吸引优化指标的冗余机械臂轨迹规划方法 | |
AU2021103765A4 (en) | Robotic arm motion programming method based on fixed-parameter neural network | |
CN108015765B (zh) | 一种机器人运动规划的拓展解集对偶神经网络解决方法 | |
CN107160401A (zh) | 一种解决冗余度机械臂关节角偏移问题的方法 | |
CN104950678B (zh) | 一种柔性机械臂系统的神经网络反演控制方法 | |
Lai et al. | Asymmetric actuator backlash compensation in quantized adaptive control of uncertain networked nonlinear systems | |
CN107962566A (zh) | 一种移动机械臂重复运动规划方法 | |
CN101520857B (zh) | 一种基于神经网络的永磁球形电动机逆运动学求解方法 | |
CN107972031A (zh) | 一种冗余机械臂可重复运动的初始位置定位方法 | |
CN105137999A (zh) | 一种具有输入饱和的飞行器跟踪控制直接法 | |
CN105549395B (zh) | 保证瞬态性能的机械臂伺服系统死区补偿控制方法 | |
CN106406085A (zh) | 基于跨尺度模型的空间机械臂轨迹跟踪控制方法 | |
CN106774379A (zh) | 一种智能超螺旋强鲁棒姿态控制方法 | |
CN110977988A (zh) | 基于有限时间命令滤波的多关节机械臂阻抗控制方法 | |
CN104991444B (zh) | 基于跟踪微分器的非线性pid自适应控制方法 | |
CN103399488B (zh) | 基于自学习的多模型控制方法 | |
CN107807522A (zh) | 水下机器人轨迹跟踪反步控制方法 | |
CN110076770A (zh) | 一种用于冗余机械臂的自运动方法 | |
CN110362110A (zh) | 一种固定时自适应神经网络无人机航迹角控制方法 | |
CN106099921A (zh) | 一种电力系统时滞稳定裕度快速求解方法 | |
CN106168762A (zh) | 一种基于模糊聚类逆模型的残余振动抑制方法 | |
CN109176529A (zh) | 一种空间机器人协调运动的新型自适应模糊控制方法 | |
CN104749952A (zh) | 一种自适应动态面控制器结构及设计方法 |
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 |