CN206216738U - 一种六自由度机器人末端负载动力学参数辨识装置 - Google Patents

一种六自由度机器人末端负载动力学参数辨识装置 Download PDF

Info

Publication number
CN206216738U
CN206216738U CN201621127259.3U CN201621127259U CN206216738U CN 206216738 U CN206216738 U CN 206216738U CN 201621127259 U CN201621127259 U CN 201621127259U CN 206216738 U CN206216738 U CN 206216738U
Authority
CN
China
Prior art keywords
real
load
robot end
identification
dynamic parameters
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.)
Expired - Fee Related
Application number
CN201621127259.3U
Other languages
English (en)
Inventor
张铁
覃彬彬
邹焱飚
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
South China University of Technology SCUT
Original Assignee
South China University of Technology SCUT
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by South China University of Technology SCUT filed Critical South China University of Technology SCUT
Priority to CN201621127259.3U priority Critical patent/CN206216738U/zh
Application granted granted Critical
Publication of CN206216738U publication Critical patent/CN206216738U/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Numerical Control (AREA)

Abstract

本实用新型公开了一种六自由度机器人末端负载动力学参数辨识装置，包括六轴工业机器人、可替换地设置在所述六轴工业机器人末端的若干不同质量的负载、实时控制***，所述的实时控制***用于对机器人实施毫秒级的实时运动数据采集；采集的实时运动数据包括编码器值，力矩值。本实用新型传感***采用高效实时控制***，可实现对机器人的毫秒级的实时数据采集，包括位移、电机输出等，采集数据量可扩展，具有可变性的特点，满足对工业机器人末端负载动力学参数的辨识。

Description

一种六自由度机器人末端负载动力学参数辨识装置
技术领域
本实用新型涉及应用于末端负载动力学参数辨识的方法及六自由度工业机器人装置，具体涉及一种六自由度机器人末端负载动力学参数辨识装置。
背景技术
当今，机器人动力学参数辨识的测试装置很多。包括四自由度的以及六自由度的工业机器人。工业机器人的仿真和控制都需要有一个精确的机器人动力学模型。目前，许多轻型高性能的机器人广泛采用具有相对柔性的谐波驱动器来驱动关节运动，关节柔性不可忽略。因此建立精确的柔性关节机器人动力学模型，需要有比较好的参数辨识方法。
对于工业机器人来说，通常只有电机位置和电机力矩数据可测。因此用于柔性关节机器人动力学参数辨识的外加传感器主要有加速度传感器，连杆位置和速度传感器，力矩传感器等。从实际应用的角度来说，因为对机器人来说，增加额外的内部传感器不但成本昂贵，而且有时是无法实现的。因此，许多学者提出了仅仅需要电机力矩和电机位置信息的辨识方法。在这些方法中，弹性偏差不是采用附加传感器测量的，而是通过解包含未知参数的运动方程得到的。
目前，末端负载动力学参数辨识的方法各不同。对于不同型号的工业机器人来说，建立的动力学模型以及最优的激励轨迹是不一样的。采用的传感***也有所差异，因而数据的采集途径也不相同。
然而，很多六自由度工业机器人末端负载动力学参数辨识的平台辨识效果不是很理想，因为所用的软硬件的兼容性不佳以及算法的选择不当，导致辨识的结果存在很大的误差。
实用新型内容
为解决对工业机器人末端负载动力学参数辨识的问题，本实用新型提供了一种六自由度机器人末端负载动力学参数辨识装置，利用机械结构上一系列不同的负载来设计辨识负载的实验方案，设计最优激励轨迹，从而用实时控制***采集数据，为辨识负载动力学参数结果提供了外在条件。
本实用新型的目的通过如下技术方案实现：
一种六自由度机器人末端负载动力学参数辨识装置，包括六轴工业机器人、可替换地设置在所述六轴工业机器人末端的若干不同质量的负载、实时控制***，所述的实时控制***用于对机器人实施毫秒级的实时运动数据采集。
进一步地，采集的实时运动数据包括编码器值，力矩值。
进一步地，所述的负载的材料为钢。
相对于现有技术，本实用新型的具有如下优点：
(1)本实用新型是通过配备一系列不同的负载，并可辨识到负载的动力学参数，验证参数由三维设计制图软件提供。
(2)本实用新型是通过称重实验法，检验辨识到的负载质量的准确性，也是验证模型准确度的证据。
(3)本实用新型通过采用高效实时控制***进行数据采样，实现了毫秒级实时数据采集，保证了采集样本的精度。采集数据包括位移以及电机输出等，数据量可扩展，从而提供了辨识的理论基础。
附图说明
图1是本实用新型六自由度工业机器人负载动力学参数辨识装置示意图。
图2是辨识对象第一负载。
图3是辨识对象第二负载。
图4参数辨识流程图。
图中所示为：1-负载；2-六轴工业机器人。
具体实施方式
为进一步理解本实用新型，下面结合附图和实施例对本实用新型做进一步说明，但是需要说明的是，本实用新型要求保护的范围并不局限于实施例表述的范围。
实施例一
如图1至图3所示，一种六自由度机器人末端负载动力学参数辨识装置，包括六轴工业机器人2、可替换地设置在所述六轴工业机器人末端的若干不同质量的负载1、实时控制***，所述的实时控制***用于对机器人实施毫秒级的实时运动数据采集。
具体而言，采集的实时运动数据包括编码器值，力矩值。
具体而言，所述的负载的材料为钢。
本实施例利用三维设计制图软件设计一系列不同配备的负载1，质量可自行设计，本实验设计有第一负载、第二负载；自行设计负载时采用钢材质，并加工出来。
实施例二
如图4所示，一种基于所述装置的六自由度机器人末端负载动力学参数辨识方法，包括步骤：
(1)根据拉格朗日方程建立动力学模型；
(2)设计激励轨迹；
(3)通过实时控制***对机器人实施毫秒级的实时数据采集，并对多次采样数据作平均以及中心差分法提高信噪比；采集数据量可扩展，既保证了采样数据的充足，也为辨识末端负载的动力学参数提供了数据基础。
(4)负载参数辨识，将参变量代入建好的动力学模型，然后估计出要辨识的动力学参数；
(5)模型验证，利用辨识到的负载动力学参数计算出力矩理论值与读取到的实际力矩值相比较，验证模型准确度。
具体而言，所述的步骤(1)具体包括：
(11)、选定广义坐标，建立有限维模型，选择关节变量和柔性连杆的模态坐标为广义坐标；
(12)、建立动能，势能和虚功表达式；
(13)、对拉格朗日方程进行推导和整理，推导出必要的惯性力项、科氏力和向心力项、重力项、摩擦力项；
(14)、将拉格朗日动力学方程整合成计算力矩的线性方程形式。
具体而言，所述的步骤(14)具体包括：
(141)根据：
推导后得出完整的动力学公式：
其中，计算的惯性参数项为：
Tp是坐标系P相对于基坐标系0的变换矩阵；qi为各个关节角度值；
JP是伪惯性矩阵：
计算的向心力和科氏力系数项为：
计算的重力项为
计算的摩擦力项：
Fvj,Fsj是粘性摩擦力，库伦摩擦力系数；
(142)最后将拉格朗日动力学方程化简，提取要辨识的基础动力学参数χ：
计算力矩的线性方程可化为：
τ＝Wχ+ρ。
具体而言，所述步骤(2)具体包括：
设计采用周期性轨迹，每个关节的激励轨迹是正弦和余弦函数的代数和，即有限的傅立叶级数函数，则机器人每个关节的关节位置qi,速度和加速度规划如下
具体而言，所述步骤(4)具体包括：
(41)结合三种不同的负载辨识方法对负载动力学参数进行辨识，第一负载辨识方法利用已经简化出来的基础动力学参数的耦合项进行差值相减，得到的差值再与三维制图软件得到的负载惯量数据进行误差分析进行辨识；第二负载辨识方法利用有无负载是读取的力矩数值进行辨识；第三负载辨识方法利用全局辨识机器人动力学参数与负载参数。
(42)从三种辨识结果中选取最优辨识结果。
具体而言，所述的步骤(41)中，
所述的第一负载辨识方法包括步骤：
(401)根据方程τ＝Wχ+ρ，用最小二乘法计算出估计值χ；
(402)选取最优的轨迹进行实验，先不装负载进行参数辨识，得到一组零负载时基础动力学参数χ0；
(403)然后再用相同的轨迹进行实验，用第一组负载进行参数辨识,得到第一组的负载基础动力学参数χ1；
(404)再换用第二组负载进行参数辨识，得到第二组负载基础动力学参数χ2；
(405)求取第一组负载的基础动力学参数：Δχ1＝χ1-χ0；
(406)求取第二组负载的基础动力学参数：Δχ2＝χ2-χ0；
所述的第二负载辨识方法包括步骤：
(411)不装负载的条件下读取力矩数值，记作YWL，再装上负载的条件下读取力矩数值，记作YT；
(412)求得辨识方程为
其中，W+＝(WTW)-1WT
YT-YWL为(6×ne)×1矩阵；
所述的第三负载辨识方法包括步骤：
(421)将零负载条件下的动力学方程和带上负载时候的动力学方程变形成矩阵相乘的形式：
其中：
Ya＝Waχ
Yb＝Wbχ+WLχ
(422)然后用加权最小二乘法WLS求解上述矩阵方程。
另外，所述的步骤(5)还包括步骤：
利用称重实验法对负载的质量数据进行检验和分析，可为辨识的准确性提供理论依据。用三维制图软件对不同的负载进行三维实体设计，可通过三维设计制图软件得出各个实体负载的惯性参数，与辨识出的实际负载动力学参数理论值进行误差分析。用上述所举出的三种负载动力学参数辨识方法辨识到的负载动力学参数用于线性方程τ＝Wχ+ρ的计算，计算出的力矩理论值与读取到的实际力矩值相比较，从而利用力矩误差百分比分析其模型的准确性与辨识参数结果的准确性与可行性。
本实施例在设计激励轨迹时，考虑机器人运动的一系列约束条件，比如关节角度范围，速度范围等等。在激励时，分别采用不同的速度对数据进行采样。
本实施例采用的传感***为实时控制***，针对机器人的运动，实现了毫秒级的实时数据采集，包括位移，电机输出等。设计的软件结构中采集数据量可扩展，既保证了采样数据的充足，也为辨识末端负载的动力学参数提供了数据基础。
如图1所示、图2所示：将第一负载装于机器人末端，然后用设计好的激励轨迹进行激励；数据采集与处理的工程中，一是将采集回来的关节位置信号经过良好的调谐带通滤波，从而用来计算出所需的角速度和角加速度，二是读取力矩值，然后经过数据处理，换算成需要的计算参数。
如图1所示、图3所示：将第二负载装于机器人末端，然后再用设计好的最优激励轨迹激励，数据采集与处理的工程中，一是将采集回来的关节位置信号经过良好的调谐带通滤波，从而用来计算所需的角速度和角加速度，采集二是读取力矩值，然后经过数据处理，换算成需要的计算参数。
经过一系列的辨识准备步骤之后，结合三种不同的负载辨识方法对负载动力学参数进行辨识，选取最优辨识结果。
本实用新型的上述实施例仅仅是为清楚地说明本实用新型所作的举例，而并非是对本实用新型的实施方式的限定。对于所属领域的普通技术人员来说，在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。凡在本实用新型的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本实用新型权利要求的保护范围之内。

Claims (3)

1.一种六自由度机器人末端负载动力学参数辨识装置，其特征在于：包括六轴工业机器人、可替换地设置在所述六轴工业机器人末端的若干不同质量的负载、实时控制***，所述的实时控制***用于对机器人实施毫秒级的实时运动数据采集。
2.根据权利要求1所述的六自由度机器人末端负载动力学参数辨识装置，其特征在于：采集的实时运动数据包括编码器值，力矩值。
3.根据权利要求1所述的六自由度机器人末端负载动力学参数辨识装置，其特征在于：所述的负载的材料为钢。
CN201621127259.3U 2016-10-17 2016-10-17 一种六自由度机器人末端负载动力学参数辨识装置 Expired - Fee Related CN206216738U (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201621127259.3U CN206216738U (zh) 2016-10-17 2016-10-17 一种六自由度机器人末端负载动力学参数辨识装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201621127259.3U CN206216738U (zh) 2016-10-17 2016-10-17 一种六自由度机器人末端负载动力学参数辨识装置

Publications (1)

Publication Number Publication Date
CN206216738U true CN206216738U (zh) 2017-06-06

Family

ID=58788372

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201621127259.3U Expired - Fee Related CN206216738U (zh) 2016-10-17 2016-10-17 一种六自由度机器人末端负载动力学参数辨识装置

Country Status (1)

Country Link
CN (1) CN206216738U (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106346513A (zh) * 2016-10-17 2017-01-25 华南理工大学 一种六自由度机器人末端负载动力学参数辨识装置及方法
CN112621748A (zh) * 2020-12-02 2021-04-09 法奥意威(苏州)机器人***有限公司 一种机器人负载辨识的方法
WO2021238049A1 (zh) * 2020-05-28 2021-12-02 杭州键嘉机器人有限公司 机械臂的多负载自适应重力补偿方法、装置及控制设备

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106346513A (zh) * 2016-10-17 2017-01-25 华南理工大学 一种六自由度机器人末端负载动力学参数辨识装置及方法
WO2021238049A1 (zh) * 2020-05-28 2021-12-02 杭州键嘉机器人有限公司 机械臂的多负载自适应重力补偿方法、装置及控制设备
CN112621748A (zh) * 2020-12-02 2021-04-09 法奥意威(苏州)机器人***有限公司 一种机器人负载辨识的方法

Similar Documents

Publication Publication Date Title
CN106346513B (zh) 一种六自由度机器人末端负载动力学参数辨识装置及方法
CN105196294B (zh) 采用位置测量的可重构机械臂分散控制***及控制方法
CN104985598B (zh) 一种工业机器人碰撞检测方法
CN108227492B (zh) 一种六自由度串联机器人末端负载动力学参数的辨识方法
CN104639003B (zh) 一种交流伺服***的转动惯量辨识方法
CN206216738U (zh) 一种六自由度机器人末端负载动力学参数辨识装置
CN103878791B (zh) 工业机器人无外部传感器的外力检测方法
CN106426174A (zh) 一种基于力矩观测和摩擦辨识的机器人接触力检测方法
CN110539302A (zh) 一种工业机器人整体动力学建模及动力学参数辨识方法
CN111618859A (zh) 一种对于静止或低速工况下机械臂高精度力反馈的方法
CN110103222A (zh) 一种工业机器人碰撞检测方法
CN109732644A (zh) 一种基于动量模型的机器人在线碰撞检测方法和***
CN110058523A (zh) 基于极大似然估计的scara机器人动力学参数辨识方法
Zweiri et al. Parameter estimation for excavator arm using generalized Newton method
CN111168660B (zh) 一种冗余自由度液压重载机器臂主动安全***
Quan et al. Agv motion balance and motion regulation under complex conditions
Sheng et al. Dynamic Model and Vibration Characteristics of Planar 3‐RRR Parallel Manipulator with Flexible Intermediate Links considering Exact Boundary Conditions
Liu et al. Vibration displacement measurement based on three axes accelerometer
CN107991049A (zh) 基于加速度传感器的六自由度振动测试方法及装置
WO2023155790A1 (zh) 机器人负载转动惯量的标定方法、装置及存储介质
Righettini et al. Experimental set-up for the investigation of transmissions effects on the dynamic performances of a linear PKM
CN101598540A (zh) 三维定位方法和三维定位***
Wiens et al. Characterization of PKM dynamics in terms of system identification
CN112948999A (zh) 一种空间机器人用关节可靠性验证方法
Lettieri et al. Experimental identification of a car dynamic model using the numerical algorithms for subspace state-space system identification

Legal Events

Date Code Title Description
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20170606

Termination date: 20201017