CN113172621B - 一种面向scara机械臂的动力学参数辨识方法 - Google Patents
一种面向scara机械臂的动力学参数辨识方法 Download PDFInfo
- Publication number
- CN113172621B CN113172621B CN202110393184.2A CN202110393184A CN113172621B CN 113172621 B CN113172621 B CN 113172621B CN 202110393184 A CN202110393184 A CN 202110393184A CN 113172621 B CN113172621 B CN 113172621B
- Authority
- CN
- China
- Prior art keywords
- robot
- parameters
- parameter identification
- mechanical arm
- scara
- 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
- 238000000034 method Methods 0.000 title claims abstract description 35
- 239000011159 matrix material Substances 0.000 claims abstract description 18
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 13
- 230000005284 excitation Effects 0.000 claims abstract description 11
- 230000009467 reduction Effects 0.000 claims abstract description 6
- 238000004364 calculation method Methods 0.000 claims abstract description 4
- 238000005259 measurement Methods 0.000 claims abstract description 4
- 238000005457 optimization Methods 0.000 claims description 6
- 230000035772 mutation Effects 0.000 claims description 5
- 238000003379 elimination reaction Methods 0.000 claims description 4
- 230000007246 mechanism Effects 0.000 claims description 2
- 108090000623 proteins and genes Proteins 0.000 claims description 2
- 230000007547 defect Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000002474 experimental method Methods 0.000 description 2
- 230000036039 immunity Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 240000006927 Foeniculum vulgare Species 0.000 description 1
- 235000004204 Foeniculum vulgare Nutrition 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000008030 elimination Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011946 reduction process Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
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
- B25J17/00—Joints
- B25J17/02—Wrist joints
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J18/00—Arms
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明涉及本发明提出一种面向SCARA机械臂的动力学参数辨识方法,通过动力学参数辨识对机器人的模型进行校正,从而得到精确的动力学模型用来实现机器人的精准控制。属于系统辨识以及机器人控制领域,该方法包括以下步骤:S1、对机器人进行D‑H建模,获取各轴参数,建立机器人动力学模型并进行线性化;S2、确定最小惯性参数集,得到由观测矩阵、待辨识参数和力矩构成的矩阵方程;S3、设计一条具有良好性质的激励轨迹作用于机器人,测量相关数据并进行降噪处理;S4、将实际测量数据代入差分进化算法中进行动力学参数辨识。本方法收敛速度快,计算成本相对较小,可以一次辨识出全部关节摩擦和其他动力学参数,并且具有较高的辨识精度。
Description
技术领域
本发明涉及机器人控制以及系统辨识技术领域,特别涉及一种面向SCARA机械臂的动力学参数辨识方法。
背景技术
众所周知,自动化机器人系统已经被广泛运用在各种工业场所中,而当前机器人的各种应用场景也对控制精度提出了更高的要求,基于这种需求,我们便需要获取更为精确的机器人动力学参数,参数辨识正是解决此问题最为常用的方法。
据查,当前比较常用的机器人动力学参数辨识方法有物理实验法、CAD测量法和最小二乘法等等。
以上提到的物理实验法就是直接通过实验的方式对机器人参数进行测量,很明显这种方法对机器人内部的耦合以及摩擦等情况无法考虑,存在很大缺陷;而CAD图则只能给出机器人的理论参数,在机器人实际运行过程中,其与实际模型的参数必然存在很大误差;最小二乘法的缺点在于需要采集和处理的数据庞大,辨识成本高,并且不能根据辨识数据的增加而动态更新。
发明内容
本发明的目的是解决上述现有技术的不足,提供一种新型的SCARA机械臂动力学参数辨识方法以进一步改善当前的技术问题,本方法可以一次辨识出全部关节摩擦和其他动力学参数,具备较强的全局收敛能力和寻优能力并且具有较高的辨识精度。
本发明解决其技术问题所采用的技术方案是:
一种面向SCARA机械臂的动力学参数辨识方法,包括如下步骤:
S1、对机器人进行D-H建模,获取各轴参数,建立机器人动力学模型并进行线性化;
S2、确定最小惯性参数集,得到由观测矩阵、待辨识参数和力矩构成的矩阵方程;
S3、设计一条具有良好性质的激励轨迹作用于机器人,测量相关数据并进行降噪处理;
S4、将实际测量数据代入差分进化算法中进行动力学参数辨识。
优选的,所述步骤(1)具体是建立机器人的坐标系统,获得D-H参数,采用拉格朗日方法建立机器人的动力学模型。
优选的,所述D-H参数包括连杆转角、连杆距离、连杆长度和连杆扭角。
优选的,步骤(2)中通过把机器人的关节构型细分为七类来获取最小惯性参数,待辨识参数矩阵中就是这些最小惯性参数。
优选的,步骤(3)中的激励轨迹需要具备容易实现、抗噪声能力强、辨识效果好等特性,通常以观测矩阵的条件数作为优化准则。
优选的,步骤(3)中的降噪处理具体为移动平均方法。
优选的,步骤(4)中的差分进化算法如下:由随机产生的初始群体开始,通过变异和选择产生新的个体,之后比较新个体与同代中其他个体的适应度值,淘汰劣者。最后经过不断的重复以上的进化、比较和淘汰的过程,使个体最终趋于最优解。具体步骤为:
重复以上的进化、比较和淘汰的过程,使个体最终趋于最优解。具体步骤为:
优选的,步骤(4)中的差分进化算法提出了一种改进,使计算成本减小,并加快了算法的收敛速度,自适应调整机制如下:
由上述技术方案可知,本发明提出的这种机器人动力学参数辨识方法具有如下优点:
1.可以一次辨识出全部关节摩擦和其他动力学参数;
2.全局收敛能力较强,寻优能力较好,并且具有较高的辨识精度;
3.结构相对简单,容易实现,计算成本相对减少且收敛快速。
附图说明
图1为本发明一种面向SCARA机械臂的动力学参数辨识方法的流程图。
图2为本实施例所述差分进化算法的流程图。
图3为本发明一种面向SCARA机械臂的动力学参数辨识方法的D-H参数坐标系图。
具体实施方式
应当指出,以下实施例用于说明本发明,不应视为对于本发明的保护范围有限制作用。下面我将结合附图,对本发明的具体实施方式作进一步详细说明。
如图1所示,一种面向SCARA机械臂的动力学参数辨识方法,包括如下步骤:
S1、对机器人进行D-H建模,获取各轴参数,建立机器人动力学模型并进行线性化。具体是建立机器人的坐标系统,获得D-H参数,采用拉格朗日方法建立机器人的动力学模型。
S2、确定最小惯性参数集,得到由观测矩阵、待辨识参数和力矩构成的矩阵方程。通过把机器人的关节构型细分为七类来获取最小惯性参数,待辨识参数矩阵中就是这些最小惯性参数。
S3、设计一条具有良好性质的激励轨迹作用于机器人,测量相关数据并进行降噪处理。激励轨迹需要具备容易实现、抗噪声能力强、辨识效果好等特性,通常以观测矩阵的条件数作为优化准则;降噪处理具体为移动平均方法。
S4、将实际测量数据代入差分进化算法中进行动力学参数辨识。差分进化算法如下:由随机产生的初始群体开始,通过变异和选择产生新的个体,之后比较新个体与同代中其他个体的适应度值,淘汰劣者。最后经过不断的重复以上的进化、比较和淘汰的过程,使个体最终趋于最优解。
如图3所示,以三自由度SCARA机械臂机器人为例详述动力学参数辨识方案。
首先建立三自由度SCARA机械臂坐标系统,以得到D-H参数,本实施例具体D-H参数值如下表所示。
D-H参数包括连杆转角、连杆距离、连杆长度和连杆扭角。
对于一根杆件,共需如下十个经典参数进行描述:惯性张量矩阵,共六个参数;质量;三维质心,共三个参数。
但并不是所有参数都对动力学特性有影响,例如:
垂直面的单杆摆动,根据其动力学方程的特性,可知其最小惯性参数为3个;
水平面的单杆运动,根据其动力学方程的特性,可知其最小惯性参数为1个。
把机器人的关节构型细分为七类来获取最小惯性参数,待辨识参数矩阵中就是这些最小惯性参数。
进一步,得到了用最小惯性参数表示的动力学方程:
下面选取激励轨迹,考虑到傅里叶级数轨迹具有抗噪声能力强、数据处理简便等优点,选择其作为激励轨迹:
根据先前机械臂动力学模型的相关参数确定观测矩阵具体形式,以观测矩阵的条件数作为优化目标,进行轨迹优化,这一步需要考虑各个关节的位置、角速度和角加速度的限制范围。
确定参数,使达到最小,进而得到激励轨迹具体形式。
将激励轨迹施加给机器人,采集各关节位置上的力矩,对采集到的信号进行降噪处理,具体为采用移动平均方法。
将处理完的数据代入到优化算法中进行参数辨识,便可得到机器人的动力学参数。具体参数辨识流程如图2所示,在该算法中,不同的个体通过比较适应度的值来确定进化方向,本文定义适应度函数为:
进行模型验证,在机器人工作空间中生成一条测试轨迹,将该轨迹输入至辨识算法得到的动力学参数构成的模型中进行仿真,输出估计的关节转矩;另一方面,将此测试轨迹作用于机器人控制系统,采集关节转矩的实际值,进行比较。
最后需要阐明的是:以上实施例仅为本发明较佳的实施方式,而非对其限制;任何在本发明揭露的技术范围内的修改或者替换,并没有使其本质脱离本发明的保护范围。
Claims (3)
1.一种面向SCARA机械臂的动力学参数辨识方法,其特征在于,包括以下步骤: (1)对机器人进行D-H建模,获取各轴参数,采用拉格朗日方法建立机器人动力学模型并进行线性化;(2)确定最小惯性参数集,得到由观测矩阵、待辨识参数和力矩构成的矩阵方程;(3)设计一条具有良好性质的激励轨迹作用于机器人,测量相关数据并采用移动平均方法进行降噪处理; (4)将实际测量数据代入差分进化算法中进行动力学参数辨识,由随机产生的初始群体开始,通过变异和选择产生新的个体,之后比较新个体与同代中其他个体的适应度值,淘汰劣者;最后经过不断的重复以上的 进化、比较和淘汰的过程,使个体最终趋于最优解,具体步骤为:
其中i=1,2,...,NP;j=1,2,...,D,NP表示种群大小,D表示解空间的维数;表示第0代的第i个个体的第个j基因;rand(0,1)是[0 ,1]区间的随机数;和分别表示第i个个体的上界和下界,
其中fit表示适应度函数,由公式(4)可以看出,将会选择适应度较低的个体进入下一代,在达到终止的条件之前,需要一直执行变异和选择的操作;
为了减少计算成本,加快算法收敛,引入一种自动调整机制如下:
2.根据权利要求1所述的一种面向SCARA机械臂的动力学参数辨识方法,其特征在于:所述D-H参数包括连杆转角、连杆距离、连杆长度和连杆扭角。
3.根据权利要求1所述的一种面向SCARA机械臂的动力学参数辨识方法,其特征在于:步骤(3)中的激励轨迹以观测矩阵的条件数作为优化准则。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110393184.2A CN113172621B (zh) | 2021-04-13 | 2021-04-13 | 一种面向scara机械臂的动力学参数辨识方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110393184.2A CN113172621B (zh) | 2021-04-13 | 2021-04-13 | 一种面向scara机械臂的动力学参数辨识方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113172621A CN113172621A (zh) | 2021-07-27 |
CN113172621B true CN113172621B (zh) | 2023-05-09 |
Family
ID=76923559
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110393184.2A Active CN113172621B (zh) | 2021-04-13 | 2021-04-13 | 一种面向scara机械臂的动力学参数辨识方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113172621B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113977578B (zh) | 2021-10-26 | 2022-10-18 | 华东交通大学 | 一种液压机械臂末端力软测量方法 |
CN114179126B (zh) * | 2021-12-07 | 2024-06-18 | 广东盈峰智能环卫科技有限公司 | 机械臂在线动力学辨识的方法、设备及存储介质 |
CN115157250A (zh) * | 2022-07-11 | 2022-10-11 | 中国地质大学(武汉) | 一种七自由度机械臂动力学参数辨识方法 |
CN116079742B (zh) * | 2023-03-13 | 2024-07-26 | 合肥合滨智能机器人有限公司 | 基于机械臂的观测矩阵求解方法及动力学参数获取方法 |
CN116968037B (zh) * | 2023-09-21 | 2024-01-23 | 杭州芯控智能科技有限公司 | 一种多机械臂协同任务调度方法 |
CN117549300B (zh) * | 2023-11-22 | 2024-10-11 | 哈尔滨工业大学 | 一种电流层面机械臂动力学参数辨识方法 |
CN118123846B (zh) * | 2024-05-06 | 2024-06-28 | 佛山华数机器人有限公司 | 一种机器人摩擦力矩和惯性关联力矩的快速分离方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2009147875A1 (ja) * | 2008-06-04 | 2009-12-10 | 国立大学法人 東京大学 | 力学パラメータの同定法 |
CN108121206A (zh) * | 2017-12-21 | 2018-06-05 | 扬州大学 | 基于高效改进型差分进化算法的复合自适应内模控制优化方法 |
CN108890650A (zh) * | 2018-08-30 | 2018-11-27 | 无锡信捷电气股份有限公司 | 基于动力学参数辨识的ptp加速度优化方法及装置 |
CN108994829A (zh) * | 2017-06-06 | 2018-12-14 | 精工爱普生株式会社 | 控制装置及机器人系统 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005074593A (ja) * | 2003-09-02 | 2005-03-24 | Sony Corp | ロボット制御装置および方法、記録媒体、並びにプログラム |
US20070094161A1 (en) * | 2005-07-27 | 2007-04-26 | Stmicroelectronics S.R.L. | Hardware device for genetic algorithms |
CN103862474B (zh) * | 2012-12-12 | 2016-08-31 | 北京赛佰特科技有限公司 | 机器人关节初始参数的辨识方法 |
CN103624784B (zh) * | 2013-11-06 | 2015-10-21 | 北京控制工程研究所 | 一种空间多臂复杂连接联合体自适应控制方法 |
CN103927451B (zh) * | 2014-04-21 | 2017-03-22 | 西北工业大学 | 一种空间机器人系统参数在轨辨识方法 |
CN106570562A (zh) * | 2016-11-14 | 2017-04-19 | 南京邮电大学 | 一种基于自适应de算法的桥式吊车模糊建模方法 |
CN107199569B (zh) * | 2017-06-22 | 2020-01-21 | 华中科技大学 | 一种基于关节能量均衡分配的关节机器人轨迹规划方法 |
JP6873941B2 (ja) * | 2018-03-02 | 2021-05-19 | 株式会社日立製作所 | ロボット作業システム、及びロボット作業システムの制御方法 |
CN111496791B (zh) * | 2020-04-27 | 2023-05-02 | 无锡信捷电气股份有限公司 | 一种基于串联机器人的整体动力学参数辨识方法 |
-
2021
- 2021-04-13 CN CN202110393184.2A patent/CN113172621B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2009147875A1 (ja) * | 2008-06-04 | 2009-12-10 | 国立大学法人 東京大学 | 力学パラメータの同定法 |
CN108994829A (zh) * | 2017-06-06 | 2018-12-14 | 精工爱普生株式会社 | 控制装置及机器人系统 |
CN108121206A (zh) * | 2017-12-21 | 2018-06-05 | 扬州大学 | 基于高效改进型差分进化算法的复合自适应内模控制优化方法 |
CN108890650A (zh) * | 2018-08-30 | 2018-11-27 | 无锡信捷电气股份有限公司 | 基于动力学参数辨识的ptp加速度优化方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN113172621A (zh) | 2021-07-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113172621B (zh) | 一种面向scara机械臂的动力学参数辨识方法 | |
CN108656117B (zh) | 一种多约束条件下最优时间的机械臂空间轨迹优化方法 | |
CN112297013B (zh) | 一种基于数字孪生和深度神经网络的机器人智能抓取方法 | |
CN112025772B (zh) | 一种基于视觉测量的机械臂自主标定方法 | |
CN108297093A (zh) | 一种机械臂动力学参数的分步辨识方法 | |
CN114398049B (zh) | 一种离散制造车间数字孪生模型自适应动态更新方法 | |
CN112497216B (zh) | 一种基于深度学习的工业机器人位姿精度补偿方法 | |
CN106584489A (zh) | 具备计算传感器的位置和方向的功能的机器人系统 | |
CN111496791A (zh) | 一种基于串联机器人的整体动力学参数辨识方法 | |
CN108427282A (zh) | 一种基于示教学习的机器人逆运动学求解方法 | |
CN112720480B (zh) | 一种基于分级误差的机器人轨迹修正方法及系统 | |
CN110543727A (zh) | 一种基于改进粒子群算法的全向移动智能轮椅机器人参数辨识方法 | |
CN113051673A (zh) | 一种机器人改进Stribeck摩擦模型辨识方法 | |
CN110802589A (zh) | 一种工业机器人单关节伺服控制的迟滞补偿方法 | |
Gao et al. | Kinematic calibration for industrial robots using articulated arm coordinate machines | |
CN117840986A (zh) | 一种机器人定位误差分级标定补偿方法及系统 | |
CN114800519A (zh) | 一种考虑摩擦的六自由度工业机器人动力学参数辨识方法 | |
CN114474004A (zh) | 一种多因素耦合车载建筑机器人误差补偿规划控制策略 | |
Luo et al. | End‐Effector Pose Estimation in Complex Environments Using Complementary Enhancement and Adaptive Fusion of Multisensor | |
CN117350096A (zh) | 一种粒子群优化算法驱动下载荷性能评价的多类型传感器布局优化方法 | |
CN113705865B (zh) | 一种基于深度神经网络的汽车稳定性因数预测方法 | |
CN110788859B (zh) | 一种控制器参数全域自适应调节系统 | |
Hlavac | Kinematics control of a redundant planar manipulator with a MLP neural network | |
CN111775140A (zh) | 一种多关节机械臂动力学参数辨识激励轨迹的优化方法 | |
CN115098969B (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 | ||
PP01 | Preservation of patent right | ||
PP01 | Preservation of patent right |
Effective date of registration: 20240819 Granted publication date: 20230509 |