CN109648567A - 一种具有容噪特性的冗余度机械臂高精度规划方法 - Google Patents
一种具有容噪特性的冗余度机械臂高精度规划方法 Download PDFInfo
- Publication number
- CN109648567A CN109648567A CN201910074362.8A CN201910074362A CN109648567A CN 109648567 A CN109648567 A CN 109648567A CN 201910074362 A CN201910074362 A CN 201910074362A CN 109648567 A CN109648567 A CN 109648567A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- precision
- indicates
- uproar
- planning
- 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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
Abstract
本发明提供了一种具有容噪特性的冗余度机械臂高精度规划方法,包括:根据机械臂运动规划的要求,考虑规划过程中噪声的干扰,通过引入位置误差及其积分信息的反馈,设计噪声环境下的运动规划方案;采用高阶数值差分公式对其进行离散化处理,建立具有容噪特性的高精度规划方案;下位机控制器根据高精度规划方案的求解结果,驱动机械臂使其有效准确地完成给定的末端规划任务。本发明的基于误差反馈和差分公式设计的高精度规划方法,使得机械臂在存在噪声的情况下仍然能够精准地完成给定的末端规划任务,从而有效提高机械臂在实际应用中的规划精度。
Description
技术领域
本发明涉及冗余度机械臂的规划及控制领域,具体涉及一种具有容噪特性的冗余度机械臂高精度规划方法。
背景技术
冗余度机械臂是一种末端能动且其所拥有的自由度要多于执行末端规划任务所需自由度的机械装置;已广泛应用于工业自动化等生产活动中。冗余度机械臂的运动规划是机械臂应用研究中的一个重要问题,即,给定机械臂末端执行器期望的运动轨迹(或称,末端规划任务),我们需要实时求解得到机械臂相应的关节变量轨迹。目前已有多种有效的方案被提出并用于机械臂的运动规划中。然而,大部分方案都不考虑噪声的干扰;一旦遇到噪声的干扰,那么方案将失效,机械臂成功完成给定的末端规划任务也无从说起。另外,虽然有部分方案具有抗噪特性,但其并不考虑噪声干扰下运动规划的精度(即,仅考虑抗噪,不考虑规划精度),从而使得方案在冗余度机械臂的实际应用中难以取得理想的规划效果。
发明内容
本发明的目的在于克服现有方法的不足,提供一种具有容噪特性的冗余度机械臂高精度规划方法。
为了实现上述发明目的,采用的技术方案如下:
一种具有抗噪特性的冗余度机械臂重复运动规划方法,包括以下步骤:
S101,根据机械臂运动规划的要求,考虑规划过程中噪声的干扰,通过引入位置误差及其积分信息的反馈,设计噪声环境下的运动规划方案;
S102,采用高阶数值差分公式对其进行离散化处理,建立具有容噪特性的高精度规划方案;
S103,下位机控制器根据方案的求解结果,驱动机械臂使其有效精准地完成给定的末端规划任务。
上述技术方案中,所述噪声环境下的运动规划方案表示为:
其中,设计参数kP>0,kI>0,且两者满足θ(t)表示机械臂关节角度,表示机械臂关节速度,J+(θ(t))表示机械臂的雅可比矩阵J(θ(t))的伪逆;e(t)表示机械臂运动规划过程中的位置误差且定义为e(t)=rd(t)-f(θ(t)),f(·)表示一个非线性映射函数,rd(t)表示机械臂末端执行器期望的运动轨迹;表示rd(t)的时间导数;y(t)表示位置误差e(t)的积分信息且定义为δ(t)表示机械臂运动规划过程中所遇到的噪声信息;t表示时间;τ表示积分变量。
所述高阶数值差分公式表示为:
其中,k表示迭代次数且k=4,5,…,σ表示采样间隔。
所述具有容噪特性的高精度规划方案表示为:
其中,
由上述对本发明的描述可知,与现有技术相比,本发明具有如下有益效果:
本发明能有效克服现有方法的不足,提供了一种使得机械臂在存在噪声的情况下仍然能够精准地完成给定的末端规划任务的高精度规划方法;从而有效提高机械臂在实际应用中的规划精度。
附图说明
图1为本发明的流程图。
具体实施方式
下面结合附图对本发明做进一步的说明。
参见图1所示,本发明一种具有抗噪特性的冗余度机械臂重复运动规划方法,主要由引入位置误差及其积分信息的反馈1、设计噪声环境下的运动规划方案2、采用高阶数值差分公式进行离散化3、建立具有容噪特性的高精度规划方案4、下位机控制器5、冗余度机械臂6这六个部分组成。
首先根据机械臂运动规划的要求,考虑规划过程中噪声的干扰,通过引入位置误差及其积分信息的反馈,设计噪声环境下的运动规划方案;然后采用高阶数值差分公式对上述方案进行离散化处理,从而建立具有容噪特性的高精度规划方案;最后下位机控制器将高精度规划方案的求解结果用于驱动机械臂的各个关节以使机械臂精准地完成给定的末端规划任务。
根据机械臂运动规划的要求,考虑规划过程中噪声的干扰,通过引入位置误差及其积分信息的反馈,噪声环境下的运动规划方案可表示为:
其中,设计参数kP>0,kI>0,且两者满足θ(t)表示机械臂关节角度,表示机械臂关节速度,J+(θ(t))表示机械臂的雅可比矩阵J(θ(t))的伪逆;e(t)表示机械臂运动规划过程中的位置误差且定义为e(t)=rd(t)-f(θ(t)),f(·)表示一个非线性映射函数,rd(t)表示机械臂末端执行器期望的运动轨迹;表示rd(t)的时间导数,y(t)表示位置误差e(t)的积分信息且定义为δ(t)表示机械臂运动规划过程中所遇到的噪声信息,t表示时间,τ表示积分变量。
对于所述运动规划方案,可采用如下的高阶数值差分公式进行离散化处理:
其中,k表示迭代次数且k=4,5,…,σ表示采样间隔。
基于高阶数值差分公式(2)和(3)来离散所述运动规划方案,便可建立如下具有容噪特性的高精度规划方案:
其中,
对于上述高精度规划方案,需要五个数值对,即{θ0,y0},{θ1,y1},{θ2,y2},{θ3,y3},{θ4,y4},来完成规划方案的初始化。在这种情况下,首先给定一个初始的数值对{θ0,y0},其余的四个数值对可根据如下公式计算:
基于上述计算所得的五个数值对,通过该高精度规划方案的不断迭代,便可得到用于冗余度机械臂在噪声环境下仍可实现高精度运动规划的各个时刻ti∈[0,T]的关节角度解,即{θi=θ(ti=iσ)|i=0,1,2,…,(T/σ)},其中T表示机械臂运动规划的周期。
在得到规划机械臂运动的关节角度解之后,再将结果传递给下位机控制器以驱动机械臂各个关节的运动,从而使得机械臂有效精准地完成所给定的末端规划任务。
上述仅为本发明的具体实施方式,但本发明的设计构思并不局限于此,凡利用此构思对本发明进行非实质性的改动,均应属于侵犯本发明保护范围的行为。
Claims (2)
1.一种具有容噪特性的冗余度机械臂高精度规划方法,其特征在于,包括如下步骤:
S101,通过引入位置误差及其积分信息的反馈,设计噪声环境下的运动规划方案;所述运动规划方案表示如下:
其中,设计参数kP>0,kI>0,且两者满足θ(t)表示机械臂关节角度,表示机械臂关节速度,J+(θ(t))表示机械臂的雅可比矩阵J(θ(t))的伪逆;e(t)表示机械臂运动规划过程中的位置误差,且e(t)=rd(t)-f(θ(t)),f(·)表示一个非线性映射函数,rd(t)表示机械臂末端执行器期望的运动轨迹;表示rd(t)的时间导数,y(t)表示位置误差e(t)的积分信息,且δ(t)表示机械臂运动规划过程中所遇到的噪声信息;t表示时间;τ表示积分变量。
S102,采高阶数值差分公式对所述运动规划方案进行离散化处理,建立具有容噪特性的高精度规划方案;
所述高阶数值差分公式表示如下:
其中,θk=θ(t=kσ),k表示迭代次数且k=4,5,…,σ表示采样间隔;
所建立的高精度规划方案表示如下:
其中,ek=e(t=kσ),δk=δ(t=kσ)。
2.根据权利要求1所述的具有容噪特性的冗余度机械臂高精度规划方法,其特征在于,所述方法还包括:
S103,下位机控制器根据所述高精度规划方案的求解结果,驱动机械臂完成给定的末端规划任务。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910074362.8A CN109648567B (zh) | 2019-01-25 | 2019-01-25 | 一种具有容噪特性的冗余度机械臂规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910074362.8A CN109648567B (zh) | 2019-01-25 | 2019-01-25 | 一种具有容噪特性的冗余度机械臂规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109648567A true CN109648567A (zh) | 2019-04-19 |
CN109648567B CN109648567B (zh) | 2021-08-03 |
Family
ID=66121625
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910074362.8A Active CN109648567B (zh) | 2019-01-25 | 2019-01-25 | 一种具有容噪特性的冗余度机械臂规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109648567B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110303501A (zh) * | 2019-07-25 | 2019-10-08 | 华侨大学 | 一种可容噪的冗余度机械臂加速度层避障规划方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130297069A1 (en) * | 2012-05-01 | 2013-11-07 | Canon Kabushiki Kaisha | Control apparatus, control method and storage medium |
CN103991074A (zh) * | 2014-05-21 | 2014-08-20 | 北京邮电大学 | 一种基于粒子滤波算法的空间机械臂控制方法及*** |
CN105598984A (zh) * | 2015-11-26 | 2016-05-25 | 华侨大学 | 一种冗余度机械臂加速度层运动规划的初始化方法 |
CN106625680A (zh) * | 2017-02-07 | 2017-05-10 | 华侨大学 | 一种冗余度机械臂加速度层容噪控制方法 |
CN106737670A (zh) * | 2016-12-15 | 2017-05-31 | 华侨大学 | 一种具有抗噪特性的冗余度机械臂重复运动规划方法 |
CN107351081A (zh) * | 2017-06-27 | 2017-11-17 | 华侨大学 | 具有速度优化特性的冗余度机械臂突加度层运动规划方法 |
CN108015763A (zh) * | 2017-11-17 | 2018-05-11 | 华南理工大学 | 一种抗噪声干扰的冗余度机械臂路径规划方法 |
CN108098777A (zh) * | 2018-01-12 | 2018-06-01 | 华侨大学 | 一种冗余度机械臂力矩层重复运动控制方法 |
CN109129487A (zh) * | 2018-09-26 | 2019-01-04 | 华南理工大学 | 在周期噪声下基于泰勒型离散周期节律神经网络的冗余度机械臂重复运动规划方法 |
CN109129486A (zh) * | 2018-09-26 | 2019-01-04 | 华南理工大学 | 一种抑制周期噪声的冗余度机械臂重复运动规划方法 |
-
2019
- 2019-01-25 CN CN201910074362.8A patent/CN109648567B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130297069A1 (en) * | 2012-05-01 | 2013-11-07 | Canon Kabushiki Kaisha | Control apparatus, control method and storage medium |
CN103991074A (zh) * | 2014-05-21 | 2014-08-20 | 北京邮电大学 | 一种基于粒子滤波算法的空间机械臂控制方法及*** |
CN105598984A (zh) * | 2015-11-26 | 2016-05-25 | 华侨大学 | 一种冗余度机械臂加速度层运动规划的初始化方法 |
CN106737670A (zh) * | 2016-12-15 | 2017-05-31 | 华侨大学 | 一种具有抗噪特性的冗余度机械臂重复运动规划方法 |
CN106625680A (zh) * | 2017-02-07 | 2017-05-10 | 华侨大学 | 一种冗余度机械臂加速度层容噪控制方法 |
CN107351081A (zh) * | 2017-06-27 | 2017-11-17 | 华侨大学 | 具有速度优化特性的冗余度机械臂突加度层运动规划方法 |
CN108015763A (zh) * | 2017-11-17 | 2018-05-11 | 华南理工大学 | 一种抗噪声干扰的冗余度机械臂路径规划方法 |
CN108098777A (zh) * | 2018-01-12 | 2018-06-01 | 华侨大学 | 一种冗余度机械臂力矩层重复运动控制方法 |
CN109129487A (zh) * | 2018-09-26 | 2019-01-04 | 华南理工大学 | 在周期噪声下基于泰勒型离散周期节律神经网络的冗余度机械臂重复运动规划方法 |
CN109129486A (zh) * | 2018-09-26 | 2019-01-04 | 华南理工大学 | 一种抑制周期噪声的冗余度机械臂重复运动规划方法 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110303501A (zh) * | 2019-07-25 | 2019-10-08 | 华侨大学 | 一种可容噪的冗余度机械臂加速度层避障规划方法 |
CN110303501B (zh) * | 2019-07-25 | 2022-05-03 | 华侨大学 | 一种可容噪的冗余度机械臂加速度层避障规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109648567B (zh) | 2021-08-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103085072B (zh) | 基于三维建模软件实现工业机器人离线编程的方法 | |
CN109483556B (zh) | 一种基于示教学习的机器人打磨***及方法 | |
Iqbal et al. | Modeling and analysis of a 6 DOF robotic arm manipulator | |
Sirouspour | Modeling and control of cooperative teleoperation systems | |
CN104858537B (zh) | 控制机器人切割工件坡口的方法及装置 | |
US8909376B2 (en) | Robot hand and method of controlling the same | |
CN109159151A (zh) | 一种机械臂空间轨迹跟踪动态补偿方法和*** | |
Neto et al. | High‐level robot programming based on CAD: dealing with unpredictable environments | |
Dinçer et al. | Improved trajectory planning of an industrial parallel mechanism by a composite polynomial consisting of Bézier curves and cubic polynomials | |
CN107351081B (zh) | 具有速度优化特性的冗余度机械臂突加度层运动规划方法 | |
KR20110041950A (ko) | 여유자유도 제어를 이용한 로봇의 교시 및 재현 방법 | |
KR102030141B1 (ko) | 로봇의 팔꿈치 제어시스템 및 그 제어방법 | |
Li et al. | Development of articulated robot trajectory planning | |
Rea Minango et al. | Combining the STEP-NC standard and forward and inverse kinematics methods for generating manufacturing tool paths for serial and hybrid robots | |
CN110014427A (zh) | 一种基于伪逆的冗余度机械臂高精度运动规划方法 | |
CN111515928B (zh) | 机械臂运动控制*** | |
CN109648567A (zh) | 一种具有容噪特性的冗余度机械臂高精度规划方法 | |
Huang et al. | A new method of inverse kinematics solution for industrial 7DOF robot | |
Ghavifekr et al. | A Modified biogeography based optimization (bbo) algorithm for time optimal motion planning of 5 dof pc-based gryphon robot | |
CN110434854A (zh) | 一种基于数据驱动的冗余度机械臂视觉伺服控制方法与装置 | |
Arthur et al. | Pose optimization and path improvement in robotic drilling through minimization of joint reversals | |
CN110303501B (zh) | 一种可容噪的冗余度机械臂加速度层避障规划方法 | |
AL-Tameemi et al. | Kinematics analysis of 5250 lab-volt 5-DoF robot arm | |
Santoso et al. | Analysis of 6-DOF robot trajectory planning for spray coating application based on workpiece orientation using blender open source software | |
Abaas et al. | Inverse kinematic analysis of lab-volt R5150 robot system |
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 |