CN113043269A - 一种基于机器人模型的机器人接触力观测系统 - Google Patents

一种基于机器人模型的机器人接触力观测系统 Download PDF

Info

Publication number
CN113043269A
CN113043269A CN201911373056.0A CN201911373056A CN113043269A CN 113043269 A CN113043269 A CN 113043269A CN 201911373056 A CN201911373056 A CN 201911373056A CN 113043269 A CN113043269 A CN 113043269A
Authority
CN
China
Prior art keywords
robot
contact force
model
joint
torque
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
Application number
CN201911373056.0A
Other languages
English (en)
Other versions
CN113043269B (zh
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.)
Shenzhen Hui Zhi Xing Chen Technology Co ltd
Original Assignee
Shenzhen Hui Zhi Xing Chen Technology Co ltd
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 Shenzhen Hui Zhi Xing Chen Technology Co ltd filed Critical Shenzhen Hui Zhi Xing Chen Technology Co ltd
Priority to CN201911373056.0A priority Critical patent/CN113043269B/zh
Publication of CN113043269A publication Critical patent/CN113043269A/zh
Application granted granted Critical
Publication of CN113043269B publication Critical patent/CN113043269B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/081—Touching devices, e.g. pressure-sensitive
    • B25J13/084—Tactile sensors
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/085—Force or torque sensors
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Feedback Control In General (AREA)
  • Manipulator (AREA)

Abstract

本发明公开了一种基于机器人模型的机器人接触力观测系统。系统由一个机器人控制器、一个工业机械臂、和上位机控制系统组成。此方法包括以下步骤：(1)设计出工业机械臂各关节的运动轨迹，使得机器人的动力学参数能够被识别出；(2)命令机器人按照(1)中设计的参考轨迹进行运动，记录下机器人各关节的位置、速度和扭矩(电流)；(3)将(2)中获得的机器人各关节的的位置、速度和扭矩(电流)，进行机器人动力学参数识别；(4)采集更多的机器人各关节在其它的命令轨迹下的位置、速度和扭矩(电流)；(5)将(3)中获得的动力学参数，和(4)中的新的命令轨迹，基于机器人的逆向动力学参数模型，计算出各关节的扭矩冗差；(6)将(4)和(5)中作为输入输出训练一个神经网络；(7)步骤(6)中的神经网络将作为机器人动力学不确定性补偿器；(8)基于高阶滑模观测器和(7)中的动力学不确定性补偿器，对机器人的末端接触力进行观测。

Description

一种基于机器人模型的机器人接触力观测系统
技术领域
本发明涉及一种基于机器人模型的接触力观测算法，属于机器人模型建立、模型识别和动力学控制领域。
背景技术
传统的工业机器人运动控制系统，大多是基于位置控制的，即机器人接受位置命令，运动控制单元克服外界干扰，到达指定的位置。机器人在执行某些任务时，会与外界发生接触。仅仅使用位置控制的机器人，在遇到外界障碍物的情况下，由于是完全基于位置控制的，会将接触力当成为外界干扰。运动控制系统将克服此干扰，而不关注实际接触力的大小。在某些应用中，会使得接触力过大。因此，在机器人与外界有接触的应用中，应该将接触力作为一个待监控的变量。
在机器人与外界有接触的情况下，机器人与外界的接触力是反映接触状态的最直接的状态量。通过对已公开的文献、专利和工业产品调研发现，机器人末端接触力探测的方式分为三种：基于力传感器的直接探测方式、基于触觉传感器的探测方式和基于软件重构的探测力重构算法。
基于力传感器的直接探测方式，通常是将接触力传感器安装在机器人本体的末端与夹具之间，实际探测到的接触力为机器人本体与夹具之间的接触力和力矩。
基于力传感器的直接探测方式存在以下不足：
1、实际探测到的接触力为机器人本体与夹具之间的接触力和力矩，要得到末端的接触力和力矩，需要进行相应的标定和补偿。在标定和补偿的过程中，将不可避免的引入误差。
2、由于接触力传感器多为柔性环节，会使得整个机器人控制系统的带宽下降。
3、接触力传感器的测量结果中有不可避免的噪声。
4、接触力传感器的成本较高等，增加了整个机器人系统的成本。
基于触觉传感器的探测方式，通过在夹具上面安装触觉传感器，能够直接探测到夹具与外界的接触力。然而，该种接触力探测方式的缺点为：
1、接触面中有多个触觉传感器的接触力信息，如何解读这些接触力信息，需要很复杂的算法。
2、触觉传感器的价格较高，安装及使用难度较大。
基于软件重构的探测力重构算法，能够通过模型等方法间接地推算出末端接触力，从而能够降低成本。该算法的基本思想是，找出机器人在有外界接触力和无外界接触力时各关节扭矩的不同，从而反推出外界接触力。然而传统的基于软件重构的接触力重构算法有以下不足：
1、需要精确的机器人动力学模型，然而由于机器人动力学参数的不确定性，使得精确的动力学模型难获得。
2、机器人动力学模型中难以建模的部分，例如每个关节的摩擦力等，大部分能获得的文献、专利中均采用了简化的线性模型，从而导致名义模型与实际模型之间误差较大。
3、当前基于模型的接触力观测算法中，接触力的观测是作为外界扰动或者未知输入进行观测的，进而对接触力的观测是渐近收敛的，收敛时间较长。
4、观测到的接触力往往要用于某种力控制框架下，在大部分的力控制框架下，往往需要机器人的状态量。现有的基于模型的接触力重构算法，往往仅能对接触力进行观测，而无法同时对机器人的状态进行观测。本发明专利中的有关接触力观测算法，能在软件重构出接触力的同时，对机器人的状态进行观测，从而使其便利地被使用到某些力控制框架下。
发明内容
本发明需要解决机器人接触力探测的问题，研制一种基于机器人模型，无需硬件传感器的低成本接触力观测算法，可以用于机器人接触力探测应用。
1、一种基于机器人模型的机器人接触力观测系统。系统由一个机器人控制器、一个工业机械臂、和上位机控制系统组成。机器人控制器与工业机械臂和上位机控制系统进行通讯，基于机器人模型的接触力观测系统运行在上位机软件。
2、根据权利要求1所述的基于机器人模型的接触力观测算法，其特征在于该方法基于机器人动力学模型及相应的模型不确定性补偿器，该接触力观测算法具有在有限时间内收敛的特性，而且能够同时观测出接触力和系统的状态。
3、根据权利要求1所述的机器人接触力观测系统，其特征在于对接触力的观测分为如下几个步骤：
S1,设计出工业机械臂各关节的运动轨迹，使得机器人的动力学参数能够被识别出；
S2,命令机器人按照(1)中设计的参考轨迹进行运动，记录下机器人各关节的位置、速度和扭矩(电流)；
S3,将S2中获得的机器人各关节的的位置、速度和扭矩(电流)，进行机器人动力学参数识别；
S4,采集更多的机器人各关节在其它的命令轨迹下的位置、速度和扭矩(电流)；
S5,将S3中获得的动力学参数，和S4中的新的命令轨迹，基于机器人的逆向动力学参数模型，并计算出各关节的扭矩冗差；
S6，将S4和S5中作为输入输出训练一个神经网络，进行学习；
S7，步骤S6中的神经网络将作为机器人动力学不确定性补偿器；
S8，基于高阶滑模观测器和S7中的动力学不确定性补偿器，对机器人的末端接触力进行观测。
本发明所涉及的基于机器人模型的接触力观测算法，精度高，成本低，而且能够同时对系统的状态进行观测，从而适用于机器人的力控框架，可以广泛地应用于工业机器人，手术机器人等需要观测与监控机器人接触力的应用中。
附图说明
图1为本发明实施中基于机器人模型的接触力观测流程图；
图2为机器人动力学模型补偿器神经网络图(以两自由度为例)；
图3机器人动力学模型补偿器神经网络图辅助的机器人驱动力预测框架；
具体实施方式
下面结合附图和具体实施方式对本发明作进一步详细描述。
S1，建立出机器人动力学的显示模型
Figure BDA0002339711340000031
q，
Figure BDA0002339711340000032
-机器人关节位置、速度和加速度向量
M(q)-机器人动力学模型惯性张量矩阵
Figure BDA0002339711340000033
-机器人动力学模型哥氏力和离心力矩阵
FV-粘性摩擦力矩阵
FC-Coulomb摩擦力矩阵
Figure BDA0002339711340000041
-符号函数组成的向量
G(q)-重力矩阵
τ-关节驱动力/力矩向量
J(q)-Jacobian矩阵
Fe-外界接触力向量
S2，设计出工业机械臂各关节的运动轨迹，使得机器人的动力学参数能够被识别出；
S3，命令机器人按照S2中设计的参考轨迹进行运动，记录下机器人各关节的位置、速度和扭矩(电流)；
S4，将S3中获得的机器人各关节的的位置、速度和扭矩(电流)，进行机器人动力学参数识别；
S5，采集更多的机器人各关节在其它的命令轨迹下的位置、速度和扭矩(电流)；
S6，将S4中获得的动力学参数，和S5中的新的命令轨迹，基于机器人的逆向动力学参数模型，并计算出各关节的扭矩冗差；
S7，将S5和S6中作为输入输入一个神经网络，进行学习；
S8，步骤S7中的神经网络将作为机器人动力学不确定性补偿器；
S9，基于高阶滑模观测器和S8中的动力学不确定性补偿器，对机器人的末端接触力进行观测。
将机器人的动力学模型写成状态空间的表达形式x1＝q，
Figure BDA0002339711340000042
u＝τ.机器人关节空间的动力学模型可以改写为，
Figure BDA0002339711340000043
y＝x1
其中
f(t，x1，x2，u)＝-M-1(x1)[C(x1，x2)x2+FVx2+FC sgn(x2)+G(x1)-u]
ξ(t，x1，x2，u)＝-M-1(x1)[Δτ+JT(x1)Fe]
f(t，x1，x2，u)∈Rn表示的是机器人名义机器人动力学模型；ξ(t，x1，x2，u)则代表的是机器人模型不确定性分量Δτ及外界接触力Fe的和。
f(t，x1，x2，u)∈Rn和ξ(t，x1，x2，u)可以表达为
Figure BDA0002339711340000051
同步的外界接触力和系统状态观测器为
Figure BDA0002339711340000052
Figure BDA0002339711340000053
其中
Figure BDA0002339711340000054
z1和z2的第i-个分量定义为
Figure BDA0002339711340000055
Figure BDA0002339711340000056
其中
Figure BDA0002339711340000057
是一个合理的假设，因为在实际中机器人的初始位置和速度可以设定为0。λi是待确定的观测器的参数。
定于状态观测误差为
Figure BDA0002339711340000058
则误差动力学可以被描述为
Figure BDA0002339711340000059
Figure BDA00023397113400000510
Figure BDA00023397113400000511
被定义为
Figure BDA00023397113400000512
观测器的系数可以按照如下原则进行选择：
Figure BDA00023397113400000513
其中pi∈(0，1).该基于超螺旋算法的二阶观测器能够在有限时间Ti内使相应的状态观测误差到零。假定T＝max(Ti).则在T后，所有的状态都收敛到了相应的真值，无论外界是否有扰动.在这种情况下，误差动力学方程可以写成
Figure BDA0002339711340000061
当状态估计误差收敛为零时,
Figure BDA0002339711340000062
Figure BDA0002339711340000063
由于实际物理系统的有限带宽，实际的控制输入无法无限快地切换。实际的物理系统对控制输入有某种低通滤波效果。在滑模控制中，这被称为等价输出进入，其中包含了系统未知输入等重要信息。在这种情况下，系统的未知输入可以重构为
Figure BDA0002339711340000064
可以通过低通滤波
Figure BDA0002339711340000065
得到.该滤波器可以表达为
Figure BDA0002339711340000066
其中Ti是滤波器的时间常数,该参数是一个需要慎重选择的重要参数。重构出的力在获得的输出平滑性和时间滞后方面有一个妥协，通常Ti被选择为Ts≤Ti≤1,其中Ts为控制系统的采样周期。
接触力在此观测器下可以被重构为
Figure BDA0002339711340000067

Claims (3)

1.一种基于机器人模型的机器人接触力观测系统。系统由一个机器人控制器、一个工业机械臂、和上位机控制系统组成。机器人控制器与工业机械臂和上位机控制系统进行通讯，基于机器人模型的接触力观测系统运行在上位机软件。
2.根据权利要求1所述的基于机器人模型的接触力观测算法，其特征在于该方法基于机器人动力学模型及相应的模型不确定性补偿器，该接触力观测算法具有在有限时间内收敛的特性，而且能够同时观测出接触力和系统的状态。
3.根据权利要求1所述的机器人接触力观测系统，其特征在于对接触力的观测分为如下几个步骤：
S1,设计出工业机械臂各关节的运动轨迹，使得机器人的动力学参数能够被识别出；
S2,命令机器人按照(1)中设计的参考轨迹进行运动，记录下机器人各关节的位置、速度和扭矩(电流)；
S3,将S2中获得的机器人各关节的的位置、速度和扭矩(电流)，进行机器人动力学参数识别；
S4,采集更多的机器人各关节在其它的命令轨迹下的位置、速度和扭矩(电流)；
S5,将S3中获得的动力学参数，和S4中的新的命令轨迹，基于机器人的逆向动力学参数模型，并计算出各关节的扭矩冗差；
S6,将S4和S5中作为输入输入一个神经网络，进行学习；
S7,步骤S6中的神经网络将作为机器人动力学不确定性补偿器；
S8,基于高阶滑模观测器和S7中的动力学不确定性补偿器，对机器人的末端接触力和系统状态进行观测。
CN201911373056.0A 2019-12-27 2019-12-27 一种基于机器人模型的机器人接触力观测系统 Active CN113043269B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911373056.0A CN113043269B (zh) 2019-12-27 2019-12-27 一种基于机器人模型的机器人接触力观测系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911373056.0A CN113043269B (zh) 2019-12-27 2019-12-27 一种基于机器人模型的机器人接触力观测系统

Publications (2)

Publication Number Publication Date
CN113043269A true CN113043269A (zh) 2021-06-29
CN113043269B CN113043269B (zh) 2024-04-05

Family

ID=76506250

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911373056.0A Active CN113043269B (zh) 2019-12-27 2019-12-27 一种基于机器人模型的机器人接触力观测系统

Country Status (1)

Country Link
CN (1) CN113043269B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113878587A (zh) * 2021-11-10 2022-01-04 天津大学 水下游动机械臂旋转壳体的能量优化控制方法及装置

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040260481A1 (en) * 2003-02-01 2004-12-23 Peter Heiligensetzer Method for monitoring a machine and such a machine, particularly a robot
CN103878791A (zh) * 2014-04-12 2014-06-25 福州大学 工业机器人无外部传感器的外力检测方法
CN108000521A (zh) * 2017-12-06 2018-05-08 天津大学 一种无传感器式协作机器人碰撞检测方法
CN108772838A (zh) * 2018-06-19 2018-11-09 河北工业大学 一种基于外力观测器的机械臂安全碰撞策略

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040260481A1 (en) * 2003-02-01 2004-12-23 Peter Heiligensetzer Method for monitoring a machine and such a machine, particularly a robot
CN103878791A (zh) * 2014-04-12 2014-06-25 福州大学 工业机器人无外部传感器的外力检测方法
CN108000521A (zh) * 2017-12-06 2018-05-08 天津大学 一种无传感器式协作机器人碰撞检测方法
CN108772838A (zh) * 2018-06-19 2018-11-09 河北工业大学 一种基于外力观测器的机械臂安全碰撞策略

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
冯春成等: "工业机器人机械臂加工目标定位控制研究", 《计算机仿真》 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113878587A (zh) * 2021-11-10 2022-01-04 天津大学 水下游动机械臂旋转壳体的能量优化控制方法及装置

Also Published As

Publication number Publication date
CN113043269B (zh) 2024-04-05

Similar Documents

Publication Publication Date Title
CN109940622B (zh) 一种基于电机电流的机器人机械臂无传感碰撞检测方法
Gautier Dynamic identification of robots with power model
CN106994686B (zh) 关节外力力矩的计算方法及装置、机器人
CN108058188B (zh) 机器人健康监测和故障诊断系统的控制方法
Pham et al. Identification of joint stiffness with bandpass filtering
CN108582078A (zh) 一种面向直接示教的机械臂零力控制方法
CN112743541B (zh) 一种无力/力矩传感器机械臂软浮动控制方法
CN105196294A (zh) 采用位置测量的可重构机械臂分散控制系统及控制方法
CN113146640A (zh) 一种考虑执行器故障的机械臂分散最优容错控制方法
CN111531548A (zh) 一种多轴串联机械臂的自抗扰控制方法
CN114589702B (zh) 基于动力学参数辨识和导纳控制的协作机器人拖动方法
CN113051673A (zh) 一种机器人改进Stribeck摩擦模型辨识方法
CN109483542A (zh) 一种基于非线性运动学模型的机器人控制方法
CN113043269A (zh) 一种基于机器人模型的机器人接触力观测系统
CN113664869A (zh) 机械臂、机械臂控制方法及系统
Han et al. External force estimation method for robotic manipulator based on double encoders of joints
Aghili et al. Adaptive control of manipulators using uncalibrated joint-torque sensing
Rodriguez-Fortun et al. Model-free control of a 3-DOF piezoelectric nanopositioning platform
CN114516050B (zh) 基于位形雅可比条件数优化的机器人外力估计方法及系统
CN215825344U (zh) 机械臂
Susanto et al. Adaptive friction compensation: application to a robotic manipulator
Khosla et al. An algorithm to estimate manipulator dynamics parameters
Li et al. End-effector force estimation for robotic manipulators from motor current measurements
Chen et al. Robot Zero-Moment Control Algorithm Based on Parameter Identification of Low-Speed Dynamic Balance
CN114800620B (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