CN107290959B - 一种基于位移等效的机器人笛卡尔空间速度优化方法 - Google Patents
一种基于位移等效的机器人笛卡尔空间速度优化方法 Download PDFInfo
- Publication number
- CN107290959B CN107290959B CN201710428954.6A CN201710428954A CN107290959B CN 107290959 B CN107290959 B CN 107290959B CN 201710428954 A CN201710428954 A CN 201710428954A CN 107290959 B CN107290959 B CN 107290959B
- Authority
- CN
- China
- Prior art keywords
- acceleration
- interpolation
- deceleration
- section
- displacement
- 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
- 238000006073 displacement reaction Methods 0.000 title claims abstract description 38
- 238000005457 optimization Methods 0.000 title claims abstract description 16
- 238000000034 method Methods 0.000 title claims abstract description 12
- 230000001133 acceleration Effects 0.000 claims abstract description 61
- 230000035772 mutation Effects 0.000 claims abstract description 6
- 239000003638 chemical reducing agent Substances 0.000 claims 1
- 239000012636 effector Substances 0.000 description 11
- 238000010586 diagram Methods 0.000 description 3
- 230000036544 posture Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000005507 spraying Methods 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
Images
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
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种基于位移等效的机器人笛卡尔空间速度优化方法,采用直线加减速控制,在含有匀速段和不含匀速段两种情况下,保证插补前后位移长度相等,通过调整加速度和减速度的大小来消除和减小由于插补位移方程离散化引起的轨迹运行速度突变。本发明解决了由于插补方程离散化引起的机器人末端轨迹在加减速点的速度突变问题,有效的提高了机器人运动的柔性,减小了机器人振动。
Description
技术领域
本发明涉及一种基于位移等效的机器人笛卡尔空间速度优化方法。应用在工业机器人末端执行器在直线加减速控制下的轨迹运动,尤其是在直线插补和圆弧插补中的应用。
背景技术
在焊接、喷涂、冲压等行业中,要求机器人在作业时其末端执行器需按给定的轨迹运行(如直线、圆弧轨迹)。机器人末端轨迹在笛卡尔空间中规划的方法通常是在示教点之间进行插补。插补时需控制插补速度曲线以防止机器人运行过程中速度不连续引起机器人的振动。但是由于机器人末端执行器运动的轨迹长度是任意实数,而计算机控制***本质上是离散控制,在直线加减速控制下对曲线进行插补时,会引起加速点和减速点处速度的突变。
发明内容
本发明的目的是针对现有技术状况而提供一种基于位移等效的机器人笛卡尔空间速度优化方法,本发明解决了由于插补方程离散化引起的机器人末端轨迹在加减速点的速度突变问题,有效的提高了机器人运动的柔性,减小了机器人振动。
本发明为了解决上述技术问题所采用的技术方案是:
一种基于位移等效的机器人笛卡尔空间速度优化方法,采用直线加减速控制,在含有匀速段和不含匀速段两种情况下,保证插补前后位移长度相等,通过调整加速度和减速度的大小来消除和减小由于插补位移方程离散化引起的轨迹运行速度突变;首先设L为插补轨迹的位移,La为插补轨迹加速段位移,V为插补轨迹最大运行速度,ΔT为插补周期,a1为插补运动的加速度,a2为插补运动的减速度,初始时刻为a,且初始时刻a=a1=a2,Li为按照直线加减速控制的插补轨迹各中间点距离插补起点的位移;所述插补位移方程为含有匀速段时,以取整后的加速段插补步数[Na]代入得到新的加速度公式为:以调整后新的加速度得到新的加速段长度公式为: La_new=a1_new([Na]·ΔT)2/2,再以新计算的加速段长度和取整后的减速段插补步数[Nd]得到新的减速度公式为:所述插补位移方程不含匀速段时, La=L/2,以取整后的加速段插补步数[Na]代入得到新的加速度采用对称的直线加减速,减速段参数和加速段参数相同然后将得到的新加速度和减速度代入按直线加减速控制的插补位移方程得到优化后的插补位移方程然后采用所述优化后的插补位移方程进行插补计算插补点的位置和姿态,利用机器人正逆运动学方程(本方法适用任何款机器人)即可得到优化后按直线加减速控制的轨迹;优化后的插补位移方程在不含匀速段时速度变化连续,含有匀速段时,在加速点处速度连续,减速点处速度存在较小的突变,误差值为ΔV=a2_new·Na·ΔT-V。
本发明的有益效果为:本发明解决了由于插补方程离散化引起的机器人末端轨迹在加减速点的速度突变问题,有效的提高了机器人运动的柔性,减小了机器人振动。
附图说明
图1为算法优化前含匀速段直线插补时末端执行器沿x、y、z方向的速度变化图;
图2为算法优化前不含匀速段直线插补时末端执行器沿x、y、z方向的速度变化图;
图3为算法优化后含匀速段直线插补时末端执行器沿x、y、z方向的速度变化图;
图4为算法优化后不含匀速段直线插补时末端执行器沿x、y、z方向的速度变化图。
具体实施方式
以下结合实施例说明,但不限制本发明。
实施例1
本实施例的一种基于位移等效的机器人笛卡尔空间速度优化方法,以机器人直线插补为例,第一组运动参数为含有匀速段的直线插补,L=244.19,ΔT=2ms,V=650mm/s,a1=a2=a=4000mm/s2。第二组为不含匀速段的直线插补,改变上述含匀速段直线插补参数a1=a2=a= 1000mm/s2,其它参数不变。
第一组插补位移方程含有匀速段时,以取整后的加速段插补步数 [Na]=81代入计算得到新的加速度以调整后新的加速度计算新的加速段长度 La_new=a1_new([Na]·ΔT)2/2=52.65mm,再以新计算的加速段长度和取整后的减速段插补步数[Nd]=187计算新的减速度
以四自由度工业机器人为例,分别采用优化前后的插补位移方程计算插补点的位置和姿态,利用机器人正逆运动学方程得到按直线加减速控制的直线轨迹。仿真得到插补位移方程优化前后的末端执行器速度曲线对比图,如图1、2、3、4所示。由图1和图3可以看出,含有匀速段时,优化后的算法在加速点处速度连续,减速点处速度突变明显减小。由图2和图4可以看出,在不含匀速段时,优化后的算法速度变化连续,在加减速点处没有速度突变。图中圈出的点表示速度突变的点。
含匀速段时,算法优化前末端执行器在加速点处的速度误差ΔV1= a·ΔT(Na 2-[Na]2)/2=162.25mm/s,在减速点处的速度误差ΔV2=V·(Nd -[Nd])=546mm/s,算法优化后在加速点没有突变,在减速点处的速度误差ΔV=a2_new·Na·ΔT-V=13.4224mm/s。
不含匀速段时,算法优化前末端执行器在加速点(减速点)处的速度误差ΔV=75.46mm/s,算法优化后在加速点(减速点)没有突变。优化后的算法在不含匀速段时速度变化连续,含有匀速段时在加速点处速度连续,减速点处速度突变明显减小。
本实施例解决了由于插补方程离散化引起的机器人末端轨迹在加减速点的速度突变问题,有效的提高了机器人运动的柔性,减小了机器人振动。
Claims (1)
1.一种基于位移等效的机器人笛卡尔空间速度优化方法,其特征在于,采用直线加减速控制,在含有匀速段和不含匀速段两种情况下,保证插补前后位移长度相等,通过调整加速度和减速度的大小来消除和减小由于插补位移方程离散化引起的轨迹运行速度突变;首先设L为插补轨迹的位移,La为插补轨迹加速段位移,V为插补轨迹最大运行速度,ΔT为插补周期,a1为插补运动的加速度,a2为插补运动的减速度,初始时刻为a,且初始时刻a=a1=a2,Li为按照直线加减速控制的插补轨迹各中间点距离插补起点的位移;所述插补位移方程为含有匀速段时,以取整后的加速段插补步数[Na]代入得到新的加速度公式为:以调整后新的加速度得到新的加速段长度公式为:La_new=a1_new([Na]·ΔT)2/2,再以新计算的加速段长度和取整后的减速段插补步数[Nd]得到新的减速度公式为:所述插补位移方程不含匀速段时,La=L/2,以取整后的加速段插补步数[Na]代入得到新的加速度采用对称的直线加减速,减速段参数和加速段参数相同然后将得到的新加速度和减速度代入按直线加减速控制的插补位移方程得到优化后的插补位移方程然后采用所述优化后的插补位移方程进行插补计算插补点的位置和姿态,利用机器人正逆运动学方程即可得到优化后按直线加减速控制的轨迹;优化后的插补位移方程在不含匀速段时速度变化连续,含有匀速段时,在加速点处速度连续,减速点处速度存在较小的突变,误差值为ΔV=a2_new·Na·ΔT-V。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710428954.6A CN107290959B (zh) | 2017-06-08 | 2017-06-08 | 一种基于位移等效的机器人笛卡尔空间速度优化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710428954.6A CN107290959B (zh) | 2017-06-08 | 2017-06-08 | 一种基于位移等效的机器人笛卡尔空间速度优化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107290959A CN107290959A (zh) | 2017-10-24 |
CN107290959B true CN107290959B (zh) | 2020-06-02 |
Family
ID=60096121
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710428954.6A Active CN107290959B (zh) | 2017-06-08 | 2017-06-08 | 一种基于位移等效的机器人笛卡尔空间速度优化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107290959B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108189038A (zh) * | 2018-01-18 | 2018-06-22 | 广东工业大学 | 一种实用的工业六轴机械臂直线运动轨迹规划方法及*** |
CN109542134A (zh) * | 2018-10-24 | 2019-03-29 | 广州霞光技研有限公司 | 一种解决机构间隙引起抖动的速度控制算法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5434489A (en) * | 1993-07-30 | 1995-07-18 | Fanuc Robotics North America, Inc. | Method and system for path planning in cartesian space |
CN1971457A (zh) * | 2005-11-25 | 2007-05-30 | 中国科学院沈阳计算技术研究所有限公司 | 一种用于数控机床的加减速控制方法 |
CN102510793A (zh) * | 2010-06-04 | 2012-06-20 | 中国科学院自动化研究所 | 加速度连续的机器人轨迹生成***和方法 |
CN105500354A (zh) * | 2016-02-02 | 2016-04-20 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人应用的过渡轨迹规划方法 |
CN106113034A (zh) * | 2016-06-12 | 2016-11-16 | 哈尔滨工程大学 | 一种六自由度机械臂考虑力约束的轨迹规划方法 |
-
2017
- 2017-06-08 CN CN201710428954.6A patent/CN107290959B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5434489A (en) * | 1993-07-30 | 1995-07-18 | Fanuc Robotics North America, Inc. | Method and system for path planning in cartesian space |
CN1971457A (zh) * | 2005-11-25 | 2007-05-30 | 中国科学院沈阳计算技术研究所有限公司 | 一种用于数控机床的加减速控制方法 |
CN102510793A (zh) * | 2010-06-04 | 2012-06-20 | 中国科学院自动化研究所 | 加速度连续的机器人轨迹生成***和方法 |
CN105500354A (zh) * | 2016-02-02 | 2016-04-20 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人应用的过渡轨迹规划方法 |
CN106113034A (zh) * | 2016-06-12 | 2016-11-16 | 哈尔滨工程大学 | 一种六自由度机械臂考虑力约束的轨迹规划方法 |
Non-Patent Citations (1)
Title |
---|
关节型机器手臂笛卡尔空间轨迹规划;王涛;《功能材料与器件学报》;20151031;第21卷(第5期);第118-123页 * |
Also Published As
Publication number | Publication date |
---|---|
CN107290959A (zh) | 2017-10-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110799309B (zh) | 具有配置相关动力学的***的振动控制 | |
US11188056B2 (en) | Feedrate scheduling method for five-axis dual-spline curve interpolation | |
CN111791236B (zh) | 一种工业机器人笛卡尔空间轨迹过渡方法 | |
US8774965B2 (en) | Method and device for controlling a manipulator | |
CN110497411B (zh) | 一种工业机器人协同运动控制方法 | |
EP2022608B1 (en) | Improved blending algorithm for trajectory planning | |
JP5327722B2 (ja) | ロボットの負荷推定装置及び負荷推定方法 | |
CN107160394B (zh) | 一种直线运动模组精确控制方法 | |
CN109968361B (zh) | 一种基于实时力反馈的变阻抗遥操作控制装置及方法 | |
CN109605369B (zh) | 机械臂奇异点控制方法及*** | |
CN107290959B (zh) | 一种基于位移等效的机器人笛卡尔空间速度优化方法 | |
JP2009053926A (ja) | 経路計画装置及び経路計画方法 | |
CN115502966B (zh) | 用于机器人的可变导纳控制方法 | |
JP5642214B2 (ja) | 多関節ロボットの弾性変形補償制御装置 | |
JP2014208400A (ja) | ロボットの制御装置及びロボットの姿勢補間方法 | |
JPH04111006A (ja) | ロボットの経路補間方法 | |
Porawagama et al. | Reduced jerk joint space trajectory planning method using 5-3-5 spline for robot manipulators | |
Xu et al. | Trajectory planning with Bezier curve in Cartesian space for industrial gluing robot | |
CN109176480B (zh) | 一种并联机器人的滑模控制方法及*** | |
CN111496798B (zh) | 机器人传送带跟踪方法、设备及存储装置 | |
Tangpattanakul et al. | Optimal trajectory of robot manipulator using harmony search algorithms | |
CN107645979B (zh) | 用于使机器人手臂的运动同步的机器人*** | |
CN109129470B (zh) | 机器人直线路径的规划方法及*** | |
CN110362040B (zh) | 基于b样条的机器人运动轨迹规划方法 | |
JP2012069169A (ja) | ロボットの動作制御装置及びその動作制御方法 |
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 |