CN106903690A - 一种起重机运动轨迹识别方法 - Google Patents
一种起重机运动轨迹识别方法 Download PDFInfo
- Publication number
- CN106903690A CN106903690A CN201710134876.9A CN201710134876A CN106903690A CN 106903690 A CN106903690 A CN 106903690A CN 201710134876 A CN201710134876 A CN 201710134876A CN 106903690 A CN106903690 A CN 106903690A
- Authority
- CN
- China
- Prior art keywords
- crane
- mechanical arm
- kinematics
- space
- 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
- 238000000034 method Methods 0.000 title claims abstract description 21
- 239000013589 supplement Substances 0.000 claims abstract description 6
- 238000004422 calculation algorithm Methods 0.000 claims description 15
- 239000012636 effector Substances 0.000 claims description 13
- 230000002068 genetic effect Effects 0.000 claims description 12
- 238000004458 analytical method Methods 0.000 claims description 6
- 238000013528 artificial neural network Methods 0.000 claims description 3
- 238000007596 consolidation process Methods 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 230000000306 recurrent effect Effects 0.000 claims description 3
- 230000003252 repetitive effect Effects 0.000 claims description 3
- 238000012067 mathematical method Methods 0.000 abstract description 2
- 238000005259 measurement Methods 0.000 description 4
- 238000013461 design Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 241000208340 Araliaceae Species 0.000 description 2
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 2
- 235000003140 Panax quinquefolius Nutrition 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- 235000008434 ginseng Nutrition 0.000 description 2
- 230000001965 increasing effect Effects 0.000 description 2
- 239000000047 product Substances 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 208000008454 Hyperhidrosis Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 208000013219 diaphoresis Diseases 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000001939 inductive effect Effects 0.000 description 1
- 230000035772 mutation Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
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/1628—Programme controls characterised by the control loop
- B25J9/163—Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
-
- 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)
- Manipulator (AREA)
Abstract
本发明公开了一种起重机运动轨迹识别方法,包含建立运动结构模型、规划运动空间轨迹、补充运动学参数以及控制变量,本发明的起重机运动轨迹识别方法创新性地提出通过对起重机的机械臂进行分析,对结构模型进行构建,在此基础上构建空间运动轨迹,并进行补充,考虑全面,并应用了复杂的数学方法以保证过程的严谨性。
Description
技术领域
本发明涉及一种运动轨迹识别领域,涉及一种起重机运动轨迹识别方法。
背景技术
随着起重机的市场需求越来越大,各种类型的起重机层出不穷,挖掘机械臂的核心共性技术,探索起重机的机械臂存在的问题并提供有效的解决方案是一项十分紧迫的任务。运动轨迹作为机械臂的一个重要性能指标,是机械臂完成操作任务的重要保证。随着起重机的机械臂应用环境的逐步复杂化,人们对机械臂的运动轨迹提出了更高的要求。但由于机械臂几何误差、环境噪声、振动干扰等原因导致机械臂实际的运动轨迹与期望的运动轨迹相比还有较大的差距。因此,对运动轨迹的关键技术展开研究具有非常重要的意义。
发明内容
有鉴于此,本发明要解决的技术问题是提供一种起重机运动轨迹识别方法,用于解决上述提出的无法解决的问题。
为达到上述技术方案的效果,本发明的技术方案为:一种起重机运动轨迹识别方法,包含建立运动结构模型、规划运动空间轨迹、补充运动学参数以及控制变量;
建立运动结构模型,首先对起重机的机械臂进行运动学分析,求解起重机的机械臂中在不同的关节连接形式下,其相邻关节的齐次变换矩阵,并且计算起重机的机械臂的正运动学方程,再采用解析法和数值法完成起重机的机械臂的逆运动学求解,综合两者建立了起重机的运动结构模型;
规划运动空间轨迹,在起重机的运动结构模型的基础上,对起重机的机械臂的空间直线、圆弧等基本元素的参数进行记录,对起重机的机械臂在笛卡尔空间的运动轨迹进行规划,在获取任务空间的运动轨迹之后,将其转换至起重机的机械臂的关节空间,并通过逆运动学计算获取起重机的机械臂的关节空间中各关节位置相对应的时间序列值,采用五次多项式插值实现起重机的机械臂的关节空间中各关节的轨迹插值,在此基础上完成多关节轨迹规划;
补充运动学参数以及控制变量,首先采用遗传算法估算起重机的机械臂中各连杆的真实参数与其预先设计的理论参数的差值,使起重机的机械臂的绝对定位精度提升至其重复定位精度的程度,并对其进行补偿,将起重机的机械臂在固结的平面上形成可移动的封闭运动链,采用递归神经网络实现起重机的机械臂的运动学参数的标定,通过配对交叉实数编码遗传算法,优化起重机的机械臂的控制变量,对起重机的机械臂末端执行器的位姿误差进行补偿,减小由起重机的机械臂中连杆参数几何误差造成的积累误差。
本发明的优点为,本发明的起重机运动轨迹识别方法创新性地提出通过对起重机的机械臂进行分析,对结构模型进行构建,在此基础上构建空间运动轨迹,并进行补充,考虑全面,并应用了复杂的数学方法以保证过程的严谨性。
附图说明
图1为一种起重机运动轨迹识别方法的步骤图。
具体实施方式
为了使本发明所要解决的技术问题、技术方案及有益效果更加清楚明白,以下结合附图及实施例,对本发明进行详细的说明。应当说明的是,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明,能实现同样功能的产品属于等同替换和改进,均包含在本发明的保护范围之内。具体方法如下:
实施例一:
在机械臂控制中,关节旋转变量为控制变量,决定机械臂的末端执行器实际到达的位置和姿态。而在机械臂逆运动学求解过程中,由于真实旳运动学参数与设计的理论参数存在偏差,导致逆解计算出的关节旋转变量不能使末端执行器到达理想位姿。假设真实的运动学参数为设计值,位姿误差仅由旋转变量引起,拟采用遗传算法对旋转变量进行补偿,以提高机械臂的定位精度。机械臂位姿误差补偿过程分为以下几个步骤:
首先,确定六自由度机械臂运动学模型。
采集多组数据作为样本。在机械臂运动空间内随机选择多组位姿作为末端执行器的目标点,根据逆运动学求解计算各连杆的理论旋转变量,控制电机驱动,并采用三维动态位移测量系统采集末端执行器的位姿和关节旋转角度数据。采用遗传算法修正理论旋转变量,搜索各旋转变量的最佳补偿值。将搜索出的最佳补偿变量应用于六自由度机械臂控制系统。
通过测量补偿后的机械臂的位姿误差验证该变量补偿算法的可行性及有效性。应用的误差补偿算法将直接采用机械臂标定方法中记录的测量数据。
本发明所有的遗传算法具体步骤如下:
对给定的机械臂末端执行器的目标位姿,根据逆运动学解析解表达式计算出机械臂理论转动关节变量。将逆解得到的理论关节变量作为控制量,控制机械臂运行,采用系统测量末端执行器实际到达位姿,并计算实际位姿与理论位姿间的误差。采用机械臂六个关节旋转补偿量构成遗传算法的个体。随机产生个初始个体构成一个种群,遗传算法以该种群作为初始点开始迭代。将修正值代入表达式,求出机械臂末端执行器每组数据修正后的误差。并根据表达式,计算每个个体的适应度函数。当适应度函数运行足够时间停止运算。当适应度函数大于设定值时,根据遗传算法的选择、交叉、变异操作产生新一代个体。经过多次迭代进化直至满足迭代终止条件,得到最后的个体即为最优修正解。
本实施例二:
建立运动结构模型,首先对起重机的机械臂进行运动学分析,求解起重机的机械臂中在不同的关节连接形式下,其相邻关节的齐次变换矩阵,并且计算起重机的机械臂的正运动学方程,再采用解析法和数值法完成起重机的机械臂的逆运动学求解,综合两者建立了起重机的运动结构模型;
规划运动空间轨迹,在起重机的运动结构模型的基础上,对起重机的机械臂的空间直线、圆弧等基本元素的参数进行记录,对起重机的机械臂在笛卡尔空间的运动轨迹进行规划,在获取任务空间的运动轨迹之后,将其转换至起重机的机械臂的关节空间,并通过逆运动学计算获取起重机的机械臂的关节空间中各关节位置相对应的时间序列值,采用五次多项式插值实现起重机的机械臂的关节空间中各关节的轨迹插值,在此基础上完成多关节轨迹规划;
补充运动学参数以及控制变量,首先采用遗传算法估算起重机的机械臂中各连杆的真实参数与其预先设计的理论参数的差值,使起重机的机械臂的绝对定位精度提升至其重复定位精度的程度,并对其进行补偿,将起重机的机械臂在固结的平面上形成可移动的封闭运动链,采用递归神经网络实现起重机的机械臂的运动学参数的标定,通过配对交叉实数编码遗传算法,优化起重机的机械臂的控制变量,对起重机的机械臂末端执行器的位姿误差进行补偿,减小由起重机的机械臂中连杆参数几何误差造成的积累误差。
标定的目标是建立机械臂在笛卡尔空间的末端位姿与各关节变量之间的精确的函数关系。它是通过辨识出机械臂各连杆的真实的几何参数来完成的。由于采用方法建立了机械臂的运动学模型,因此需要对机械臂各连杆扭角、连杆长度、偏置及初始角度四个参数进行标定。分别釆用表示连杆的连杆扭角、连杆长度、偏置及初始角度的设计值与真实值之间的误差。这些几何参数的误差较大地影响机械臂末端执行器的绝对定位精度,通过标定方法辨识出各连杆真实的几何参数,并采用更准确的运动学函数关系来更新机器人的绝对定位计算软件,可以显著地提高机器人末端执行器的定位精度。标定方法是集建模、测量、参数识别和误差补偿为一体的,具体可分别以下四个步骤,
1)建立机械臂的运动学模型,包括正运动学模型和逆运动学模型。
2)通过检测技术采集一系列末端执行器的位姿与对应的关节变量的测量数据,作为实验样本。
3)应用优化算法辨识出运动学模型的真实参数。
4)将标定后的真实运动学模型应用于机械臂的控制器。
上述实施例对本发明进行详细的说明。应当说明的是,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明,能实现同样功能的产品属于等同替换和改进,均包含在本发明的保护范围之内。
Claims (1)
1.一种起重机运动轨迹识别方法,其特征在于,包含建立运动结构模型、规划运动空间轨迹、补充运动学参数以及控制变量;
所述建立运动结构模型,首先对起重机的机械臂进行运动学分析,求解所述起重机的机械臂中在不同的关节连接形式下,其相邻关节的齐次变换矩阵,并且计算所述起重机的机械臂的正运动学方程,再采用解析法和数值法完成所述起重机的机械臂的逆运动学求解,综合两者建立了起重机的运动结构模型;
所述规划运动空间轨迹,在所述起重机的运动结构模型的基础上,对所述起重机的机械臂的空间直线、圆弧等基本元素的参数进行记录,对所述起重机的机械臂在笛卡尔空间的运动轨迹进行规划,在获取任务空间的运动轨迹之后,将其转换至所述起重机的机械臂的关节空间,并通过逆运动学计算获取所述起重机的机械臂的关节空间中各关节位置相对应的时间序列值,采用五次多项式插值实现所述起重机的机械臂的关节空间中各关节的轨迹插值,在此基础上完成多关节轨迹规划;
所述补充运动学参数以及控制变量,首先采用遗传算法估算所述起重机的机械臂中各连杆的真实参数与其预先设计的理论参数的差值,使所述起重机的机械臂的绝对定位精度提升至其重复定位精度的程度,并对其进行补偿,将所述起重机的机械臂在固结的平面上形成可移动的封闭运动链,采用递归神经网络实现所述起重机的机械臂的运动学参数的标定,通过配对交叉实数编码遗传算法,优化所述起重机的机械臂的控制变量,对所述起重机的机械臂末端执行器的位姿误差进行补偿,减小由所述起重机的机械臂中连杆参数几何误差造成的积累误差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710134876.9A CN106903690B (zh) | 2017-03-08 | 2017-03-08 | 一种起重机运动轨迹识别方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710134876.9A CN106903690B (zh) | 2017-03-08 | 2017-03-08 | 一种起重机运动轨迹识别方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106903690A true CN106903690A (zh) | 2017-06-30 |
CN106903690B CN106903690B (zh) | 2019-05-28 |
Family
ID=59187330
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710134876.9A Active CN106903690B (zh) | 2017-03-08 | 2017-03-08 | 一种起重机运动轨迹识别方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106903690B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111051012A (zh) * | 2016-07-15 | 2020-04-21 | 快砖知识产权私人有限公司 | 用于末端执行器控制的机器人臂运动学 |
WO2020151406A1 (zh) * | 2019-01-21 | 2020-07-30 | 北京镁伽机器人科技有限公司 | 运动控制方法、装置和系统及存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1138867A1 (en) * | 2000-03-31 | 2001-10-04 | Iveco Magirus Ag | Turntable ladder |
US20080021635A1 (en) * | 2006-07-19 | 2008-01-24 | Eads Deutschland Gmbh | Method for establishing optimized paths of movement of vehicles |
KR20110026776A (ko) * | 2009-09-08 | 2011-03-16 | 부산대학교 산학협력단 | 실제 로봇의 다중 경로계획 방법 |
CN102646148A (zh) * | 2012-04-25 | 2012-08-22 | 浙江大学 | 仿人机器人机械臂避碰运动轨迹规划方法 |
CN103235513A (zh) * | 2013-04-24 | 2013-08-07 | 武汉科技大学 | 一种基于遗传算法的移动机械臂轨迹规划优化方法 |
CN106055522A (zh) * | 2016-06-30 | 2016-10-26 | 大连大学 | 冗余空间机械臂最小基座姿态扰动的轨迹规划方法 |
-
2017
- 2017-03-08 CN CN201710134876.9A patent/CN106903690B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1138867A1 (en) * | 2000-03-31 | 2001-10-04 | Iveco Magirus Ag | Turntable ladder |
US20080021635A1 (en) * | 2006-07-19 | 2008-01-24 | Eads Deutschland Gmbh | Method for establishing optimized paths of movement of vehicles |
KR20110026776A (ko) * | 2009-09-08 | 2011-03-16 | 부산대학교 산학협력단 | 실제 로봇의 다중 경로계획 방법 |
CN102646148A (zh) * | 2012-04-25 | 2012-08-22 | 浙江大学 | 仿人机器人机械臂避碰运动轨迹规划方法 |
CN103235513A (zh) * | 2013-04-24 | 2013-08-07 | 武汉科技大学 | 一种基于遗传算法的移动机械臂轨迹规划优化方法 |
CN106055522A (zh) * | 2016-06-30 | 2016-10-26 | 大连大学 | 冗余空间机械臂最小基座姿态扰动的轨迹规划方法 |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111051012A (zh) * | 2016-07-15 | 2020-04-21 | 快砖知识产权私人有限公司 | 用于末端执行器控制的机器人臂运动学 |
CN111051012B (zh) * | 2016-07-15 | 2024-02-02 | 快砖知识产权私人有限公司 | 用于末端执行器控制的机器人臂运动学 |
WO2020151406A1 (zh) * | 2019-01-21 | 2020-07-30 | 北京镁伽机器人科技有限公司 | 运动控制方法、装置和系统及存储介质 |
DE112019006713B4 (de) | 2019-01-21 | 2023-06-15 | Megarobo Technologies Co., Ltd. | Ein Verfahren zur Steuerung einer Bewegung, eine Bewegungssteuereinrichtung und ein System sowie ein Speichermedium desselben |
US11975452B2 (en) | 2019-01-21 | 2024-05-07 | Megarobo Technologies Co., Ltd. | Motion control method, device and system, and storage medium |
Also Published As
Publication number | Publication date |
---|---|
CN106903690B (zh) | 2019-05-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20190176325A1 (en) | An Error Modeling Method For End-Effector Space-Curve Trajectory Of Six Degree-of-Freedom Robots | |
CN103176409B (zh) | 一种快速准确实现混凝土泵车臂架运动轨迹的方法 | |
JPH07501643A (ja) | 制御パラメータに依存する実際値特性を有するシステムに対する制御パラメータの最適化方法 | |
JP2012149342A (ja) | コーティング経路生成の方法および装置 | |
CN108214476A (zh) | 基于改进型径向基神经网络的机械臂绝对定位精度标定方法 | |
CN104991448B (zh) | 一种基于构型平面的水下机械臂运动学的求解方法 | |
CN104890013A (zh) | 一种基于拉线编码器的工业机器人标定算法 | |
CN110815206A (zh) | 一种Stewart型并联机器人运动学标定方法 | |
CN109176487A (zh) | 一种联动关节段标定方法、系统、设备、存储介质 | |
CN106903690A (zh) | 一种起重机运动轨迹识别方法 | |
CN110154024A (zh) | 一种基于长短期记忆神经网络增量模型的装配控制方法 | |
CN113420403A (zh) | 一种液压支架与刮板输送机的推移机构运动规划方法 | |
Xiao et al. | Simulation research of a six degrees of freedom manipulator kinematics based On MATLAB toolbox | |
CN114800529A (zh) | 一种基于定长记忆窗口增量学习和增量模型重构的工业机器人定位误差在线补偿方法 | |
CN115213898A (zh) | 一种基于逆解多目标优化的焊接机器人笛卡尔空间轨迹规划方法 | |
CN113721626A (zh) | 一种制动盘补偿累计误差的机器人轨迹规划方法 | |
JP3840973B2 (ja) | ロボット教示データの補正方法 | |
CN113752300A (zh) | 一种工业机器人能耗预测方法 | |
CN112847351B (zh) | 一种基于指数趋近率的并联机器人轨迹跟踪控制方法 | |
Zhuo et al. | SCARA Modeling and Simulation based on SimMechanics and Solidworks | |
CN106598224A (zh) | 一种基于虚拟环境重建的增强遥操作临场感的方法 | |
CN113119123B (zh) | 一种办公转椅生产的运动控制方法 | |
Qi et al. | A lead-through robot programming approach using a 6-DOF wire-based motion tracking device | |
Lin et al. | Research and Analysis of Comprehensive Optimization Method for Energy Consumption and Trajectory Error of the Leg Structure Based on Virtual Model Control | |
Ramos et al. | Application of the Denavit-Hartenberg method to estimate the positioning errors of an automated XYZ cartesian table |
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 | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20190430 Address after: 221000 No. 2 Baolian Temple West Road, Xuzhou Economic and Technological Development Zone, Jiangsu Province Applicant after: Jiangsu Shanhe Electromechanical Technology Co., Ltd. Address before: 230601 No. 23 Beihai Road, Hefei Economic and Technological Development Zone, Anhui Province Applicant before: Pan Xiaosheng |
|
GR01 | Patent grant | ||
GR01 | Patent grant |