CN109159151B - 一种机械臂空间轨迹跟踪动态补偿方法和系统 - Google Patents
一种机械臂空间轨迹跟踪动态补偿方法和系统 Download PDFInfo
- Publication number
- CN109159151B CN109159151B CN201811236824.3A CN201811236824A CN109159151B CN 109159151 B CN109159151 B CN 109159151B CN 201811236824 A CN201811236824 A CN 201811236824A CN 109159151 B CN109159151 B CN 109159151B
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- joint
- pose
- current
- matrix
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
-
- 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
-
- 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
Abstract
本申请实施例提供了一种机械臂空间轨迹跟踪动态补偿方法和系统,其中,所述方法步骤包括:S1、根据机械臂末端期望位姿矩阵T1和机械臂末端当前位姿矩阵T0,计算机械臂末端位姿误差δ;S2、利用当前机械臂末端位姿下的雅克比矩阵J(q)、位姿误差δ和当前关节角q,计算关节目标角q*;S3、根据当前机械臂末端位姿下的雅克比矩阵J(q)和机械臂末端的期望速度v*,计算关节目标角速度S4、将关节目标角速度与关节位置控制器输出量相加,得到关节速度指令,驱动机械臂各关节运动。本方案计算复杂度低,占用资源少;不需要考虑复杂的动力学模型,简单实用,易于实施;通过末端轨迹规划输出的空间速度直接得到各关节目标速度作为前馈量,不存在滞后,实时性好。
Description
技术领域
本申请涉及机械臂空间轨迹跟踪补偿领域,特别涉及一种六自由度机械臂空间轨迹跟踪动态补偿方法和系统。
背景技术
机械臂尤其是六自由度机械臂在工业生产领域已经得到了广泛的应用,机械臂控制技术是机械臂系统的重要部分,决定着机械臂的性能,随着现代工业的迅速发展,对机械臂的精度、稳定性、快速性提出了更高的要求。
机械臂空间轨迹跟踪是实现末端执行器沿着给定的连续轨迹运动,整个运动轨迹都需要严格控制,机械臂空间轨迹跟踪精度是其控制性能的重要指标。弧焊、喷漆等应用都对机械臂的空间轨迹跟踪精度有很高的要求。现有技术中,针对机械臂空间轨迹跟踪控制,一般采用两种方法:第一种方法是在关节控制中直接将关节目标角差分得到目标速度,作为速度前馈给到关节速度控制器进行动态补偿,这种方法实施简单但是会存在滞后特性;第二种方法是根据机械臂的动力学模型进行控制,但是六自由度机械臂的动力学模型复杂,难以得到精确的动力学模型,导致控制效果不理想。
发明内容
为解决上述问题之一,本申请提供了一种六自由度机械臂空间轨迹跟踪动态补偿方法和系统。
根据本申请实施例的第一个方面,提供了一种机械臂空间轨迹跟踪动态补偿方法,其特征在于,该方法的步骤包括:
S1、根据机械臂末端期望位姿矩阵T1和机械臂末端当前位姿矩阵T0,计算机械臂末端位姿误差δ;
S2、利用当前机械臂末端位姿下的雅克比矩阵J(q)、位姿误差δ和当前关节角q,计算关节目标角q*;
根据本申请实施例的第二个方面,提供了一种机械臂空间轨迹跟踪动态补偿系统,其特征在于,该系统包括:
位姿误差计算模块,根据机械臂末端期望位姿矩阵T1和机械臂末端当前位姿矩阵T0,计算机械臂末端位姿误差δ;
关节目标角度计算模块,利用当前机械臂末端位姿下的雅克比矩阵J(q)、位姿误差δ和当前关节角q,计算关节目标角q*;
本申请所述技术方案计算复杂度低,占用资源少;不需要考虑复杂的动力学模型,简单实用,易于实施;通过末端轨迹规划输出的空间速度直接得到各关节目标速度作为前馈量,不存在滞后,实时性好。
附图说明
此处所说明的附图用来提供对本申请的进一步理解,构成本申请的一部分,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:
图1示出本方案所述一种机械臂空间轨迹跟踪动态补偿方法的示意图;
图2示出本方案所述一种机械臂空间轨迹跟踪动态补偿方法的控制原理图。
具体实施方式
为了使本申请实施例中的技术方案及优点更加清楚明白,以下结合附图对本申请的示例性实施例进行进一步详细的说明,显然,所描述的实施例仅是本申请的一部分实施例,而不是所有实施例的穷举。需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。
本方案的核心思路是通过末端轨迹规划输出的空间速度直接得到各关节目标速度作为前馈量,不存在滞后,实时性好。
如图1和图2所示,本方案公开了一种机械臂空间轨迹跟踪动态补偿方法,该方法不需考虑六自由度机械臂的动力学模型,能够简单有效的实施六自由度机械臂空间轨迹的跟踪动态补偿。该方法的步骤具体包括:
步骤一、根据六自由度机械臂的D-H参数构建其运动学模型,并根据当前关节角q计算出机械臂末端当前位姿矩阵,记为T0;
步骤二、根据六自由度机械臂当前关节角与运动学模型计算末端在当前位姿下的雅可比矩阵,记为J(q);
步骤三、根据轨迹规划器输出的机械臂末端期望位置,得到机械臂末端期望位姿矩阵,记为T1;
步骤四、计算机械臂末端期望位姿矩阵T1与机械臂末端当前位姿矩阵T0的位姿误差,记为δ;所述位姿误差的计算公式为:
其中,为位姿误差,为机械臂末端当前位姿矩阵,为机械臂末端期望位姿矩阵。为机械臂末端当前姿态的旋转矩阵,为机械臂末端当前空间位置坐标向量,为机械臂末端期望姿态的旋转矩阵,为机械臂末端期望空间位置的坐标向量。对于斜对称矩阵
步骤五、根据当前位姿下的雅可比矩阵J(q),位姿误差δ,当前关节角q,计算得到关节目标角q*,给到关节位置控制器;所述机械臂各关节目标角度计算公式为:
q*=q+J-1(q)δ
本方案进一步公开了一种机械臂空间轨迹跟踪动态补偿系统,该系统包括:
矩阵构建模块,根据利用机械臂D-H参数构建的运动学模型和当前关节角 q,计算机械臂末端当前位姿矩阵T0;和当前位置下的雅克比矩阵J(q);
位姿误差计算模块,根据机械臂末端期望位姿矩阵T1和机械臂末端当前位姿矩阵T0,计算机械臂末端位姿误差δ;
关节目标角度计算模块,利用当前机械臂末端位姿下的雅克比矩阵J(q)、位姿误差δ和当前关节角q,计算关节目标角q*;
本方案中,所述机械臂空间轨迹跟踪动态补偿方法也可以通过例如关节位置控制器等电子设备实现其控制功能,所述电子设备包括:存储器,一个或多个处理器;存储器与处理器通过通信总线相连;处理器被配置为执行存储器中的指令;所述存储介质中存储有用于执行如上所述方法中各个步骤的指令。
本方案中,所述机械臂空间轨迹跟踪动态补偿方法也可以记载于计算机可读存储介质中,通过计算机可读存储介质上存储有计算机程序实现控制功能,该程序被处理器执行时实现如上所述方法的步骤。
综上所述,本方案计算复杂度低,占用资源少;不需要考虑复杂的动力学模型,简单实用,易于实施;通过末端轨迹规划输出的空间速度直接得到各关节目标速度作为前馈量,不存在滞后,实时性好。
本申请是参照根据本申请实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和 /或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/ 或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
以上仅为本发明的实施例而已,并不用于限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均包含在申请待批的本发明的权利要求范围之内。
Claims (8)
1.一种机械臂空间轨迹跟踪动态补偿方法,其特征在于,该方法的步骤包括:
S1、根据机械臂末端期望位姿矩阵T1和机械臂末端当前位姿矩阵T0,计算机械臂末端位姿误差δ;
S2、利用当前机械臂末端位姿下的雅克比矩阵J(q)、位姿误差δ和当前关节角q,计算关节目标角q*;
其中,所述位姿误差的计算公式为:
2.根据权利要求1所述的补偿方法,其特征在于,所述步骤S1中,根据利用机械臂D-H参数构建的运动学模型和当前关节角q,计算机械臂末端当前位姿矩阵T0;和当前位置下的雅克比矩阵J(q)。
5.一种机械臂空间轨迹跟踪动态补偿系统,其特征在于,该系统包括:
位姿误差计算模块,根据机械臂末端期望位姿矩阵T1和机械臂末端当前位姿矩阵T0,计算机械臂末端位姿误差δ;
关节目标角度计算模块,利用当前机械臂末端位姿下的雅克比矩阵J(q)、位姿误差δ和当前关节角q,计算关节目标角q*;
其中,所述位姿误差的计算公式为:
6.根据权利要求5所述的补偿系统,其特征在于,该系统还包括:
矩阵构建模块,根据利用机械臂D-H参数构建的运动学模型和当前关节角q,计算机械臂末端当前位姿矩阵T0;和当前位置下的雅克比矩阵J(q)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811236824.3A CN109159151B (zh) | 2018-10-23 | 2018-10-23 | 一种机械臂空间轨迹跟踪动态补偿方法和系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811236824.3A CN109159151B (zh) | 2018-10-23 | 2018-10-23 | 一种机械臂空间轨迹跟踪动态补偿方法和系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109159151A CN109159151A (zh) | 2019-01-08 |
CN109159151B true CN109159151B (zh) | 2021-12-10 |
Family
ID=64879056
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811236824.3A Active CN109159151B (zh) | 2018-10-23 | 2018-10-23 | 一种机械臂空间轨迹跟踪动态补偿方法和系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109159151B (zh) |
Families Citing this family (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110181509A (zh) * | 2019-05-14 | 2019-08-30 | 浙江树人学院(浙江树人大学) | 一种基于误差补偿的工业机器人运动控制方法 |
CN111053613B (zh) * | 2019-12-10 | 2020-10-13 | 联博智能科技有限公司 | 一种运动追踪方法、装置、机械臂及计算机可读存储介质 |
CN110977992B (zh) * | 2020-01-02 | 2020-10-16 | 中山大学 | 一种面向机械臂的无运动学模型轨迹跟踪方法及一种机械臂系统 |
CN111230860B (zh) * | 2020-01-02 | 2022-03-01 | 腾讯科技(深圳)有限公司 | 机器人控制方法、装置、计算机设备及存储介质 |
CN111546334B (zh) * | 2020-04-28 | 2023-02-03 | 中国科学院沈阳自动化研究所 | 一种减小轮廓误差的工业机器人在线位姿误差补偿方法 |
CN111590568B (zh) * | 2020-05-14 | 2023-05-16 | 平安科技(深圳)有限公司 | 机器臂信号处理方法、装置、计算机设备及存储介质 |
CN111890349A (zh) * | 2020-05-25 | 2020-11-06 | 北京空间飞行器总体设计部 | 一种四自由度机械臂运动规划方法 |
CN111590592A (zh) * | 2020-06-05 | 2020-08-28 | 中科新松有限公司 | 机械臂的控制方法及装置、电子设备、存储介质 |
CN111753374B (zh) * | 2020-06-26 | 2023-08-25 | 北京百度网讯科技有限公司 | 速度确定方法、装置、设备和计算机存储介质 |
CN112171673B (zh) * | 2020-09-24 | 2022-03-29 | 哈尔滨工业大学(深圳) | 机械臂作业控制方法、控制设备及计算机可读存储介质 |
CN113305838B (zh) * | 2021-05-26 | 2022-04-29 | 深圳市优必选科技股份有限公司 | 按摩运动控制方法、装置、机器人控制设备及存储介质 |
CN113561183B (zh) * | 2021-07-26 | 2023-09-22 | 上海大学 | 一种基于位姿跟踪系统机械臂目标点在线追踪方法及系统 |
CN113650014B (zh) * | 2021-08-18 | 2022-05-17 | 中山大学 | 一种基于回声状态网络的冗余机械臂追踪控制方法 |
CN113799127B (zh) * | 2021-09-15 | 2023-05-23 | 华南理工大学 | 光学双目定位系统下六自由度机械臂无标定位姿定位方法 |
CN114227685B (zh) * | 2021-12-28 | 2023-09-22 | 深圳市优必选科技股份有限公司 | 机械臂控制方法、装置、计算机可读存储介质及机械臂 |
CN114504385A (zh) * | 2022-01-18 | 2022-05-17 | 上海术航机器人有限公司 | 手术机器人末端姿态调整方法、系统、设备和介质 |
CN114378827B (zh) * | 2022-01-26 | 2023-08-25 | 北京航空航天大学 | 一种基于移动机械臂整体控制的动态目标跟踪抓取方法 |
CN114505863B (zh) * | 2022-03-09 | 2024-01-26 | 国汽朴津智能科技(合肥)有限公司 | 一种智能机器人的转速控制方法及装置 |
CN114770459B (zh) * | 2022-05-18 | 2023-12-08 | 佗道医疗科技有限公司 | 一种主控制臂运动控制方法 |
CN114800523B (zh) * | 2022-05-26 | 2023-12-01 | 江西省智能产业技术创新研究院 | 机械臂轨迹修正方法、系统、计算机及可读存储介质 |
CN114800527A (zh) * | 2022-06-06 | 2022-07-29 | 山东大学 | 一种移动作业机械臂末端施力控制方法及系统 |
CN115008468A (zh) * | 2022-07-04 | 2022-09-06 | 中国科学院沈阳自动化研究所 | 一种机械臂姿态速度规划控制方法 |
CN116117799B (zh) * | 2022-12-19 | 2023-08-04 | 广东建石科技有限公司 | 机器视觉跟踪补偿方法、装置、电子设备及存储介质 |
CN116512278B (zh) * | 2023-06-26 | 2023-12-01 | 极限人工智能(北京)有限公司 | 基于虚拟目标点的机械臂末端直线运动控制方法及系统 |
CN116494250B (zh) * | 2023-06-26 | 2023-11-03 | 极限人工智能(北京)有限公司 | 基于速度补偿的机械臂控制方法、控制器、介质及系统 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6024603A (ja) * | 1983-07-20 | 1985-02-07 | Hitachi Ltd | ロボツトの制御方法 |
WO2009034957A1 (ja) * | 2007-09-14 | 2009-03-19 | Kabushiki Kaisha Yaskawa Denki | ロボットの力制御方法、制御装置およびロボットシステム |
KR20120040297A (ko) * | 2010-10-19 | 2012-04-27 | 현대중공업 주식회사 | 산업용 다관절 로봇의 제어 장치 및 방법 |
CN103009389A (zh) * | 2012-11-30 | 2013-04-03 | 北京控制工程研究所 | 一种冗余空间机械臂在轨抓捕的轨迹规划方法 |
CN104015191A (zh) * | 2014-06-03 | 2014-09-03 | 哈尔滨工业大学 | 基于基座卫星角速度的空间机械臂工具坐标下的运动补偿方法 |
JP6044511B2 (ja) * | 2013-11-05 | 2016-12-14 | トヨタ自動車株式会社 | ロボットの制御方法及びロボットシステム |
CN106313044A (zh) * | 2016-09-20 | 2017-01-11 | 华南理工大学 | 一种工业机器人前馈力矩补偿方法 |
CN106514636A (zh) * | 2016-12-16 | 2017-03-22 | 宁波帝洲自动化科技有限公司 | 一种机器人末端位姿分析方法 |
CN108621162A (zh) * | 2018-05-09 | 2018-10-09 | 广西科技大学 | 一种机械臂运动规划方法 |
-
2018
- 2018-10-23 CN CN201811236824.3A patent/CN109159151B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6024603A (ja) * | 1983-07-20 | 1985-02-07 | Hitachi Ltd | ロボツトの制御方法 |
WO2009034957A1 (ja) * | 2007-09-14 | 2009-03-19 | Kabushiki Kaisha Yaskawa Denki | ロボットの力制御方法、制御装置およびロボットシステム |
KR20120040297A (ko) * | 2010-10-19 | 2012-04-27 | 현대중공업 주식회사 | 산업용 다관절 로봇의 제어 장치 및 방법 |
CN103009389A (zh) * | 2012-11-30 | 2013-04-03 | 北京控制工程研究所 | 一种冗余空间机械臂在轨抓捕的轨迹规划方法 |
JP6044511B2 (ja) * | 2013-11-05 | 2016-12-14 | トヨタ自動車株式会社 | ロボットの制御方法及びロボットシステム |
CN104015191A (zh) * | 2014-06-03 | 2014-09-03 | 哈尔滨工业大学 | 基于基座卫星角速度的空间机械臂工具坐标下的运动补偿方法 |
CN106313044A (zh) * | 2016-09-20 | 2017-01-11 | 华南理工大学 | 一种工业机器人前馈力矩补偿方法 |
CN106514636A (zh) * | 2016-12-16 | 2017-03-22 | 宁波帝洲自动化科技有限公司 | 一种机器人末端位姿分析方法 |
CN108621162A (zh) * | 2018-05-09 | 2018-10-09 | 广西科技大学 | 一种机械臂运动规划方法 |
Non-Patent Citations (1)
Title |
---|
六自由度机械臂轨迹跟踪控制策略研究;鲁彩丽;《中国优秀硕士学位论文全文数据库》;20181015;正文第8-19页,第35-36页,图4-5 * |
Also Published As
Publication number | Publication date |
---|---|
CN109159151A (zh) | 2019-01-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109159151B (zh) | 一种机械臂空间轨迹跟踪动态补偿方法和系统 | |
CN110421547B (zh) | 一种基于估计动力学模型的双臂机器人协同阻抗控制方法 | |
CN111360827B (zh) | 一种视觉伺服切换控制方法及系统 | |
CN110039542B (zh) | 具有速度方向控制的视觉伺服跟踪控制方法及机器人系统 | |
US9764462B2 (en) | Robot apparatus and robot controlling method | |
CN111553239B (zh) | 一种机器人关节视觉伺服控制方法、终端设备及存储介质 | |
Wen et al. | Elman fuzzy adaptive control for obstacle avoidance of mobile robots using hybrid force/position incorporation | |
US20060195228A1 (en) | Robot locus control method and apparatus and program of robot locus control method | |
CN112757306A (zh) | 一种机械臂逆解多解选择和时间最优轨迹规划算法 | |
CN109358507B (zh) | 一种时变性能边界约束的视觉伺服自适应跟踪控制方法 | |
CN107457783B (zh) | 基于pd控制器的六自由度机械臂自适应智能检测方法 | |
CN108927801B (zh) | 一种机械臂末端姿态调整方法及装置 | |
CN114952868B (zh) | 7自由度srs型机械臂控制方法及装置、弹琴机器人 | |
CN108189034B (zh) | 一种机器人连续轨迹实现方法 | |
CN111515928B (zh) | 机械臂运动控制系统 | |
CN113352327A (zh) | 五自由度机械臂关节变量确定方法 | |
CN114055467B (zh) | 基于五自由度机器人的空间位姿在线仿真系统 | |
CN111168680A (zh) | 一种基于神经动力学方法的软体机器人控制方法 | |
CN113219825B (zh) | 一种四足机器人单腿轨迹跟踪控制方法及系统 | |
CN116494250B (zh) | 基于速度补偿的机械臂控制方法、控制器、介质及系统 | |
CN112847373B (zh) | 一种机器人轨迹同步控制方法、计算机可读存储介质 | |
CN110026986B (zh) | 多臂协同作业柔顺控制方法 | |
Tangpattanakul et al. | Optimal trajectory of robot manipulator using harmony search algorithms | |
CN115890735B (zh) | 机械臂系统、机械臂及其控制方法、控制器和存储介质 | |
CN109648563B (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 |