CN110977992B - 一种面向机械臂的无运动学模型轨迹跟踪方法及一种机械臂系统 - Google Patents
一种面向机械臂的无运动学模型轨迹跟踪方法及一种机械臂系统 Download PDFInfo
- Publication number
- CN110977992B CN110977992B CN202010003310.4A CN202010003310A CN110977992B CN 110977992 B CN110977992 B CN 110977992B CN 202010003310 A CN202010003310 A CN 202010003310A CN 110977992 B CN110977992 B CN 110977992B
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- obtaining
- sensor
- controller
- error function
- 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
- 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
-
- 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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1607—Calculation of inertia, jacobian matrixes and inverses
-
- 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
-
- 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- 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
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/32—Operator till task planning
- G05B2219/32335—Use of ann, neural network
-
- 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
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39001—Robot, manipulator control
-
- 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
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39219—Trajectory tracking
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明公开一种面向机械臂的无运动学模型轨迹跟踪方法,包括以下步骤:根据传感器得到关于机械臂在时间t的实际轨迹方程ra(t),结合预定的目标轨迹方程rd(t),得到第一个误差函数e(t);将误差函数e(t)通过应用梯度神经网络得到关于机械臂驱动器状态变化率的微分方程根据传感器得到关于末端执行器的实际速度和雅可比矩阵和驱动器速率之积得到第二个误差函数ε(t);将误差函数ε(t)通过应用梯度神经网络得到将和联合求解,得到机械臂的关节状态向量θ(t);控制器根据机械臂的关节状态向量θ(t)来驱动机械臂的运动,完成轨迹跟踪。本发明还公开了基于上述方法的机械臂系统,包括机械臂、控制器和传感器,传感器与控制器电连接;控制器与机械臂电连接。
Description
技术领域
本发明涉及机械臂的控制领域,更具体地,涉及一种面向机械臂的无运动学模型轨迹跟踪方法及一种机械臂系统。
背景技术
工业机器人,又称机械臂,在现代化工业生产中有着广泛的应用和发挥着巨大作用。机器人技术是一种多学科交叉、综合而形成的智能化技术。同时,机器人的诞生和机器人学的建立与发展是现代科学技术发展中重要成果的体现。雅可比矩阵在机器人的运动学及实时控制中具有重要地位,作为驱动关节速度与末端执行器速度之间的映射,雅可比矩阵在机器人的分析、控制与性能评价等方面都起着重要作用。现有的大多数机械臂控制技术依赖其运动学模型,即基于雅可比矩阵及其伪逆来进行控制。然而,在实际中,机械臂的模型往往是未知的;或者,即使理论模型基本已知,但是由于参数不确定性的存在,实际的模型也很难精确得到,由此导致机械臂对目标轨迹的精确度不高。
发明内容
为克服上述现有技术与方法的不足,本发明提出了一种面向机械臂的无运动学模型轨迹跟踪方法及一种机械臂系统。本发明可以在工业机器人模型参数未知的情况下,仅依靠目标轨迹信息和传感器的测量结果完成跟踪任务,并且可以通过改变方程参数大小来控制轨迹跟踪的精确度。
为解决上述技术问题,本发明的技术方案如下:
一种面向机械臂的无运动学模型轨迹跟踪方法,包括以下步骤:
根据传感器得到关于机械臂在时间t的实际轨迹方程ra(t),结合预定的目标轨迹方程rd(t),得到第一个误差函数e(t);
控制器根据机械臂的关节状态向量θ(t)来驱动机械臂的运动,完成轨迹跟踪。
本发明中应用梯度神经网络是基于梯度下降法的一种递归神经网络,常用于求矩阵的逆和解线性方程。
本发明可以在工业机器人模型参数未知的情况下,仅依靠目标轨迹信息和传感器的测量结果完成跟踪任务,并且可以通过改变方程参数大小来控制轨迹跟踪的精确度。
在一种优选的方案中,所述的e(t)通过下式进行表达:
其中,所述的rd(t)表示在时间t的预定的目标轨迹方程。
在一种优选的方案中,所述的ε(t)通过下式进行表达:
在一种优选的方案中,所述的γ=500。
在一种优选的方案中,所述的μ=500。
本发明还公开了基于上述方法的一种机械臂系统,包括机械臂、控制器和传感器,其中,
所述的传感器用测采集机械臂的工作数据,传感器设置在机械臂上,传感器与控制器电连接;
所述的控制器根据传感器采集的工作数据,控制机械臂的工作,控制器与机械臂电连接。
与现有技术相比,本发明技术方案的有益效果是:
本发明在工业机器人模型参数未知的情况下,仅依靠目标轨迹信息和传感器的测量结果完成跟踪任务,并且可以通过改变方程参数大小来控制轨迹跟踪的精确度。
附图说明
图1为实施例的流程图;
图2为实施例的期望轨迹和实际轨迹跟踪示意图;
图3为实施例的轨迹跟踪对应的X,Y,Z三个坐标误差示意图。
具体实施方式
附图仅用于示例性说明,不能理解为对本专利的限制;为了更好说明本实施例,附图某些部件会有省略、放大或缩小,并不代表实际产品的尺寸;
对于本领域技术人员来说,附图中某些公知结构及其说明可能省略是可以理解的。下面结合附图和实施例对本发明的技术方案做进一步的说明。
实施例
如图1所示,一种面向机械臂的无运动学模型轨迹跟踪方法,包括以下步骤:
根据传感器得到关于机械臂在时间t的实际轨迹方程ra(t),结合预定的目标轨迹方程rd(t),得到第一个误差函数e(t);
控制器根据机械臂的关节状态向量θ(t)驱动机械臂的运动,完成轨迹跟踪。
本发明可以在工业机器人模型参数未知的情况下,仅依靠目标轨迹信息和传感器的测量结果完成跟踪任务,并且可以通过改变方程参数大小来控制轨迹跟踪的精确度。
在实施例的基础上,还可以进行以下改进:e(t)通过下式进行表达:
其中,rd(t)表示在时间t的预定的目标轨迹方程。
在实施例及改进实施例的基础上,还可以进行以下改进:ε(t)通过下式进行表达:
在实施例及改进实施例的基础上,还可以进行以下改进:γ=500。
在实施例及改进实施例的基础上,还可以进行以下改进:μ=500。
本实施例还公开了基于上述方法的一种机械臂系统,包括机械臂、控制器和传感器,其中,
传感器用测采集机械臂的工作数据,传感器设置在机械臂上,传感器与控制器电连接;
控制器根据传感器采集的工作数据,控制机械臂的工作,控制器与机械臂电连接。
测试环境:
使用PA10机械臂来验证本实施例,该机械臂共有7个自由度,各个关节的初始值:q(0)=[0;π/4;0;π/2;0;-π/4;0],其对应的雅可比矩阵初值为:
首先根据目标轨迹rd(t)和传感器测得的连续体机器人末端执行器的实际轨迹ra(t)定义一个误差函数:
应用梯度神经网络求解方法:
γ是一个调整误差收敛速度的正参数,本次测试中γ=500;
应用梯度神经网络求解方法
最后运用数值方法,运用给定的初始值,对上述两个误差微分方程组成的方程组进行求解,即可得到所需的驱动机械臂的信号θ(t)。期望轨迹和实际轨迹跟踪示意图如图2所示,轨迹跟踪对应的X,Y,Z三个坐标误差如图3所示。由此可以发现,本实施例可以在工业机器人模型参数未知的情况下,仅依靠目标轨迹信息和传感器的测量结果完成高精确度的跟踪任务。
在上述具体实施方式的具体内容中,各技术特征可以进行任意不矛盾的组合,为使描述简洁,未对上述各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
附图中描述位置关系的用语仅用于示例性说明,不能理解为对本专利的限制;
显然,本发明的上述实施例仅是为清楚地说明本发明所作的举例,而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。因此无法对所有的实施方式予以穷举。凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明权利要求的保护范围之内。
Claims (6)
1.一种面向机械臂的无运动学模型轨迹跟踪方法,其特征在于,包括以下步骤:
根据传感器得到关于机械臂在时间t的实际轨迹方程ra(t),结合预定的目标轨迹方程rd(t),得到第一个误差函数e(t);
控制器根据机械臂的关节状态向量θ(t)来驱动机械臂的运动,完成轨迹跟踪;
所述的e(t)通过下式进行表达:
其中,所述的rd(t)表示在时间t的预定的目标轨迹方程,||·||2表示向量的二范数;
4.根据权利要求3所述的无运动学模型轨迹跟踪方法,其特征在于,所述的μ=500。
5.根据权利要求1~4中任一权利要求所述的无运动学模型轨迹跟踪方法,其特征在于,所述的γ=500。
6.基于权利要求1~5中任一权利要求所述的一种无运动学模型轨迹跟踪方法的一种机械臂系统,其特征在于,包括机械臂、控制器和传感器,其中,
所述的传感器用于测量采集机械臂的工作数据,传感器设置在机械臂上,传感器与控制器电连接;
所述的控制器根据传感器采集的工作数据,控制机械臂的工作,控制器与机械臂电连接。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010003310.4A CN110977992B (zh) | 2020-01-02 | 2020-01-02 | 一种面向机械臂的无运动学模型轨迹跟踪方法及一种机械臂系统 |
US17/642,237 US20220314445A1 (en) | 2020-01-02 | 2020-09-18 | Kinematics model-free trajectory tracking method for robotic arms and robotic arm system |
PCT/CN2020/116186 WO2021135405A1 (zh) | 2020-01-02 | 2020-09-18 | 一种面向机械臂的无运动学模型轨迹跟踪方法及一种机械臂系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010003310.4A CN110977992B (zh) | 2020-01-02 | 2020-01-02 | 一种面向机械臂的无运动学模型轨迹跟踪方法及一种机械臂系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110977992A CN110977992A (zh) | 2020-04-10 |
CN110977992B true CN110977992B (zh) | 2020-10-16 |
Family
ID=70080829
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010003310.4A Active CN110977992B (zh) | 2020-01-02 | 2020-01-02 | 一种面向机械臂的无运动学模型轨迹跟踪方法及一种机械臂系统 |
Country Status (3)
Country | Link |
---|---|
US (1) | US20220314445A1 (zh) |
CN (1) | CN110977992B (zh) |
WO (1) | WO2021135405A1 (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110977992B (zh) * | 2020-01-02 | 2020-10-16 | 中山大学 | 一种面向机械臂的无运动学模型轨迹跟踪方法及一种机械臂系统 |
CN111890350A (zh) * | 2020-06-12 | 2020-11-06 | 深圳先进技术研究院 | 机器人及其控制方法、计算机可读存储介质 |
CN111872937B (zh) * | 2020-07-23 | 2022-04-19 | 西华大学 | 一种任务空间中不确定机械臂的控制方法 |
CN112518753B (zh) * | 2020-12-04 | 2022-02-01 | 浙江理工大学 | 一种神经网络迭代补偿的工业机器人轨迹跟踪系统和方法 |
CN112706165A (zh) * | 2020-12-22 | 2021-04-27 | 中山大学 | 一种面向轮式移动机械臂的跟踪控制方法及系统 |
CN112817231B (zh) * | 2020-12-31 | 2022-06-03 | 南京工大数控科技有限公司 | 一种具有强鲁棒性的机械臂高精度跟踪控制方法 |
CN112894812A (zh) * | 2021-01-21 | 2021-06-04 | 中山大学 | 一种面向机械臂的视觉伺服轨迹跟踪控制方法及系统 |
CN113650014B (zh) * | 2021-08-18 | 2022-05-17 | 中山大学 | 一种基于回声状态网络的冗余机械臂追踪控制方法 |
CN113787501B (zh) * | 2021-09-28 | 2023-02-07 | 千翼蓝犀智能制造科技(广州)有限公司 | 一种基于梯度下降的轮式移动机器人状态调整方法 |
CN114643582B (zh) * | 2022-05-05 | 2022-12-27 | 中山大学 | 一种面向冗余机械臂的无模型关节容错控制方法及装置 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5216342A (en) * | 1989-05-12 | 1993-06-01 | Fanuc Ltd | Sliding mode control method with a feedforward compensation function |
CN105598968A (zh) * | 2016-01-26 | 2016-05-25 | 中山大学 | 一种并联机械臂的运动规划与控制方法 |
CN107984472A (zh) * | 2017-11-13 | 2018-05-04 | 华南理工大学 | 一种用于冗余度机械臂运动规划的变参神经求解器设计方法 |
CN108621162A (zh) * | 2018-05-09 | 2018-10-09 | 广西科技大学 | 一种机械臂运动规划方法 |
CN109159151A (zh) * | 2018-10-23 | 2019-01-08 | 北京无线电测量研究所 | 一种机械臂空间轨迹跟踪动态补偿方法和系统 |
CN110103226A (zh) * | 2019-06-06 | 2019-08-09 | 燕山大学 | 一种辅助机器人控制方法及系统 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4074638B2 (ja) * | 2006-01-31 | 2008-04-09 | ファナック株式会社 | 電動機の制御装置 |
CN110434851B (zh) * | 2019-06-24 | 2020-11-27 | 浙江工业大学 | 一种5自由度机械臂逆运动学求解方法 |
CN110977992B (zh) * | 2020-01-02 | 2020-10-16 | 中山大学 | 一种面向机械臂的无运动学模型轨迹跟踪方法及一种机械臂系统 |
-
2020
- 2020-01-02 CN CN202010003310.4A patent/CN110977992B/zh active Active
- 2020-09-18 US US17/642,237 patent/US20220314445A1/en active Pending
- 2020-09-18 WO PCT/CN2020/116186 patent/WO2021135405A1/zh active Application Filing
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5216342A (en) * | 1989-05-12 | 1993-06-01 | Fanuc Ltd | Sliding mode control method with a feedforward compensation function |
CN105598968A (zh) * | 2016-01-26 | 2016-05-25 | 中山大学 | 一种并联机械臂的运动规划与控制方法 |
CN107984472A (zh) * | 2017-11-13 | 2018-05-04 | 华南理工大学 | 一种用于冗余度机械臂运动规划的变参神经求解器设计方法 |
CN108621162A (zh) * | 2018-05-09 | 2018-10-09 | 广西科技大学 | 一种机械臂运动规划方法 |
CN109159151A (zh) * | 2018-10-23 | 2019-01-08 | 北京无线电测量研究所 | 一种机械臂空间轨迹跟踪动态补偿方法和系统 |
CN110103226A (zh) * | 2019-06-06 | 2019-08-09 | 燕山大学 | 一种辅助机器人控制方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
US20220314445A1 (en) | 2022-10-06 |
CN110977992A (zh) | 2020-04-10 |
WO2021135405A1 (zh) | 2021-07-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110977992B (zh) | 一种面向机械臂的无运动学模型轨迹跟踪方法及一种机械臂系统 | |
Zhao et al. | System identification of the nonlinear residual errors of an industrial robot using massive measurements | |
CN109822574B (zh) | 一种工业机器人末端六维力传感器标定的方法 | |
Elatta et al. | An overview of robot calibration | |
CN104057290B (zh) | 一种基于视觉和力反馈控制的机器人装配方法与系统 | |
CN110228067B (zh) | 一种基于激光跟踪仪的双臂机器人组合操作测试方法 | |
CN105773622B (zh) | 一种基于iekf的工业机器人绝对精度校准方法 | |
CN107703748B (zh) | 一种基于偏置板设计的重载机器人静态刚度辨识方法 | |
CN111300406B (zh) | 基于运动学分析的工业机器人轨迹精度补偿系统和方法 | |
CN105643641A (zh) | 力传感器标定装置、标定方法及力控制机器人 | |
CN102768006B (zh) | 一种用于大曲率曲面零件法向自动测量和调整的方法 | |
WO2018196232A1 (zh) | 机器人和末端执行器的自动标定方法及系统 | |
CN205734940U (zh) | 一种应用于工业机器人的tcp在线快速标定装置 | |
CN111347431A (zh) | 一种手持工具示教的机器人示教喷涂方法和装置 | |
CN110815190A (zh) | 一种工业机器人拖动示教方法及系统 | |
CN109746901B (zh) | 一种用于外骨骼机器人的动态负载信息计算方法 | |
CN111639749A (zh) | 一种基于深度学习的工业机器人摩擦力辨识方法 | |
Marwan et al. | Calibration method for articulated industrial robots | |
CN111515928B (zh) | 机械臂运动控制系统 | |
CN115229796A (zh) | 一种面向航空大构件铣削的机器人末端位姿跟踪补偿方法 | |
CN113319855B (zh) | 一种多关节诊疗机器人柔顺力控制模式下的重力补偿方法 | |
CN110900608B (zh) | 基于最优测量构型选择的机器人运动学标定方法 | |
CN110238848B (zh) | 一种机器人坐标系下重力矢量的计算方法 | |
CN113927603B (zh) | 机械臂拖动控制方法、装置、计算机设备以及存储介质 | |
CN113650014B (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 |