CN103878791B - 工业机器人无外部传感器的外力检测方法 - Google Patents

工业机器人无外部传感器的外力检测方法 Download PDF

Info

Publication number
CN103878791B
CN103878791B CN201410144776.0A CN201410144776A CN103878791B CN 103878791 B CN103878791 B CN 103878791B CN 201410144776 A CN201410144776 A CN 201410144776A CN 103878791 B CN103878791 B CN 103878791B
Authority
CN
China
Prior art keywords
external force
joint
industrial robot
momentum
moment
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
CN201410144776.0A
Other languages
English (en)
Other versions
CN103878791A (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.)
Fuzhou University
Original Assignee
Fuzhou University
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 Fuzhou University filed Critical Fuzhou University
Priority to CN201410144776.0A priority Critical patent/CN103878791B/zh
Publication of CN103878791A publication Critical patent/CN103878791A/zh
Application granted granted Critical
Publication of CN103878791B publication Critical patent/CN103878791B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Manipulator (AREA)
  • Force Measurement Appropriate To Specific Purposes (AREA)

Abstract

本发明涉及一种工业机器人无外部传感器的外力检测方法,所述方法是依据动量偏差观测器算法获得外力在机器人各关节上的等效力矩,依据等效外力矩可以得出外力的大小、大致方向,以及所作用连杆;从工业机器人关节电机驱动器读取关节驱动力矩参数以及关节位置,并由位置参数通过微分获取速度参数,运用这三个参数即可利用动量偏差观测器算法获取作用于机器人的外力;所述算法无需添加外部传感器,无需对现有机器人进行大幅改动的前提下,即可实现工业机器人外力检测。本发明动量偏差观测器算法不使用加速度参数,大幅提高外力检测的可靠性和精度,对检测机器人碰撞,提高机器人安全性具有重要意义,且本发明实现方法较为简单,可靠性高。

Description

工业机器人无外部传感器的外力检测方法
技术领域
本发明涉及一种工业机器人无外部传感器的外力检测方法,可应用于机器人需要知道外部作用力信息情况下,特别是在机器人安全控制中碰撞力检测方面和人机交互时人的意图识别及安全保护方面具有很好的作用。
背景技术
工业机器人在制造业和服务领域的应用越来越广泛,同时对机器人外力的识别也越来越重要,例如,在机器人安全性研究中对碰撞力的检测需要对外力的识别,在机器人人机交互时不仅需要识别人的意图,还需要保证人的安全,而对机器人所受外力的识别则可以为它们提供方便。为了检测机器人所受外力,目前所采取的外力检测方法主要是在机器人外部添加力传感器,但这种方法仅限于安装了传感器的部位且增加了成本,增加了系统复杂度。此外,也有采用机器人内部传感器检测法,该法通过采集机器人各个关节力矩,并采集位置编码器的值,运用动力学方程计算在此运动状态下机器人所需的驱动力矩,将该力矩与实际采集的力矩对比以确定机器人外力在关节位置的等效外力矩,然而该法需要求解位置值的一阶、二阶导数,这会引入噪音干扰,影响检测的准确性。对于机器人外力的检测方法还有待于进一步的研究,以保证检测的准确性,同时又能减少对机器人的改动。
考虑到以上因素,本发明直接从工业机器人关节的伺服电机驱动器中实时读取力矩、位置参数,并基于这些参数设计力矩观测算法以求取外力矩。这样不仅可以求得碰撞力,并且无需添加传感器,无需对现有机器人进行改造,也无需使用加速度参数,提高了外力检测的准确性,避免了对机器人的改造并减少了系统的复杂性。这使得本发明可以很容易地移植到现有机器人上,使用起来较为方便,有较好的应用前景。
发明内容
本发明的目的在于提供一种无需额外添加传感器就可以检测机器人所受外力的工业机器人无外部传感器的外力检测方法。
为实现上述目的,本发明的技术方案是:一种工业机器人无外部传感器的外力检测方法,
提供一工业机器人,该工业机器人包括至少1个关节和控制器,每个关节均包括连杆、减速机、电机、驱动器和编码器,所述驱动器包括力矩检测单元;
所述外力检测方法为:所述控制器从所述驱动器中读取力矩参数和编码器位置参数,采用动量偏差观测器算法,得到外力在所述关节处的等效外力矩,依据所述等效外力矩得出外力的大小和方向,以及所作用连杆。
在本发明实施例中,所述的动量偏差观测器算法,是依据机械手广义动量与外力矩间具有解耦性,且工业机器人受到外力时,动量会发生变化的原理来设计动量偏差观测器。
在本发明实施例中,所述外力检测方法具体实施步骤如下,
S01:建立所述工业机器人的动力学方程,其中,为关节角位移,为关节角速度,为关节角加速度,为工业机器人的惯性矩阵,为工业机器人的哥氏矩阵,为作用于各关节的重力矩矢量,为关节的驱动力矩,为外部作用力等效到各关节的力矩;
S02:求取所述工业机器人的广义动量
S03:设计动量偏差观测器,,其中,为动量估计值,其具体形式为,依据动力学方程对所建动量偏差观测器展开,得到动量偏差观测器的具体形式r为所观测的动量偏差,在数值上等于作用于机器人上的外力在机器人关节处的等效力矩,p(t)为机器人的广义动量,的转置,K 1 K 2 为常数对角矩阵,具体数值可按步骤S05求得;
S04:对所述动量偏差观测器加入性能调整函数,得到动量偏差观测器的最终形式K 3 为常数对角矩阵,具体数值可按步骤S05求得;
S05:调整所述动量偏差观测器函数中,K 1 ,K 2 ,K 3 的值,使系统获得良好性能,其中,K 1 >0,K 2 >0,K 3 >0,均为系统的增益矩阵;动量偏差观测器为一改进型二阶系统,系统阻尼比,可先调整K 1 ,K 2 使系统处于过阻尼转态,再调整系数K 3 提高系统的实时性和准确性;
S06:从工业机器人中读取关节驱动力矩、关节位置参数,再有关节位置通过微分获得关节速度,代入所述动量偏差观测器函数,得到外力在关节上的等效外力矩r
S07:根据所述外力矩得到外力所作用工业机器人的连杆;所述外力矩r的形式为为不全为零的数,且,从右到左寻找第一个不为零的,则第i杆即为外力作用连杆;
S08:根据外力作用的具体位置,通过,求得外力的大小和具体方向,其中,F e 为外力,为外力作用位置的工业机器人雅可比矩阵,r为动量偏差观测器观测的外力矩。
在本发明实施例中,所述的动量偏差观测器算法只需采集工业机器人运行时的关节驱动力矩、关节位置两个参数,所需关节速度参数从所述关节位置微分得到,无需加速度信息,减小噪声干扰。
在本发明实施例中,所述外力检测方法无需添加外部传感器。
在本发明实施例中,所述检测算法在工业机器人控制器上实时运行。
相较于现有技术,本发明具有以下有益效果:
1、本发明直接从工业机器人关节的驱动器中实时读取力矩、位置参数,并基于这些参数设计力矩观测算法以求取外力矩,这样不仅可以求得碰撞力,并且无需添加传感器,无需对现有机器人进行改造,也无需使用加速度参数,提高了外力检测的准确性,避免了对机器人的改造并减少了系统的复杂性;这使得本发明可以很容易地移植到现有机器人上,使用起来较为方便,有较好的应用前景。
附图说明
图1是工业机器人系统。
图2是工业机器人关节组成图。
图3是本发明动量偏差观测器的控制框图。
具体实施方式
下面结合附图,对本发明的技术方案进行具体说明。
本发明一种工业机器人无外部传感器的外力检测方法,
提供一工业机器人,该工业机器人包括至少1个关节和控制器,每个关节均包括连杆、减速机、电机、驱动器和编码器,所述驱动器包括力矩检测单元;
所述外力检测方法为:所述控制器从所述驱动器中读取力矩参数和编码器位置参数,采用动量偏差观测器算法,得到外力在所述关节处的等效外力矩,依据所述等效外力矩得出外力的大小和方向,以及所作用连杆。
为让本领域技术人员更加了解本发明方法,以下为本发明的具体实施例。
如图1所示为通常工业机器人系统,由机器人本体11和控制器12组成,在控制器上设有计算机或者工控机,可用于数据处理、轨迹规划等功能,可以很容易地添加程序。在图1通用机器人系统的基础上,本发明提供一种机器人无外部传感器的外力检测方法,所述的工业机器人由至少1个关节和控制器组成,每个关节由连杆、减速机、电机、驱动器和编码器组成,如图2所示。所述驱动器具有力矩检测单元,编码器与电机同步转动,编码器连接到驱动器,从驱动器中能够获取编码器对应的电机轴角位移信息。所述的无外部传感器外力检测方法,是所述的工业机器人控制器只需从驱动器中读取力矩参数和编码器位置参数,采用动量偏差观测器算法,得到外力在机器人关节处的等效外力矩,依据所述等效外力矩可以得出外力的大小、方向,以及作用于机器人哪一连杆上。
所述的动量偏差观测器算法,是依据机械手广义动量与外力矩间具有解耦性,且工业机器人受到外力时,动量会发生变化的原理来设计动量偏差观测器。
所述的动量偏差观测器算法只需采集工业机器人运行时的关节驱动力矩、关节位置参数,在由关节位置通过微分获取关节速度参数,无需加速度信息,减小噪声干扰。
所述外力检测方法无需添加外部传感器。
所述检测算法在工业机器人控制器上实时运行。
所述外力检测方法具体实施步骤如下,
S01:建立所述工业机器人的动力学方程,其中,为关节角位移,为关节角速度,为关节角加速度,为工业机器人的惯性矩阵,为工业机器人的哥氏矩阵,为作用于各关节的重力矩矢量,为关节的驱动力矩,为外部作用力等效到各关节的力矩;
S02:求取所述工业机器人的广义动量
S03:设计动量偏差观测器,,其中,为动量估计值,其具体形式为,依据动力学方程对所建动量偏差观测器展开,得到动量偏差观测器的具体形式r为所观测的动量偏差,在数值上等于作用于机器人上的外力在机器人关节处的等效力矩,p(t)为机器人的广义动量,的转置,K 1 K 2 为常数对角矩阵,具体数值可按步骤S05求得;
S04:对所述动量偏差观测器加入性能调整函数,得到动量偏差观测器的最终形式K 3 为常数对角矩阵,具体数值可按步骤S05求得;
S05:调整所述动量偏差观测器函数中,K 1 ,K 2 ,K 3 的值,使系统获得良好性能,其中,K 1 >0,K 2 >0,K 3 >0,均为系统的增益矩阵;动量偏差观测器为一改进型二阶系统,系统阻尼比,可先调整K 1 ,K 2 使系统处于过阻尼转态,再调整系数K 3 提高系统的实时性和准确性;
S06:从工业机器人中读取关节驱动力矩、关节位置参数,再有关节位置通过微分获得关节速度,代入所述动量偏差观测器函数,得到外力在关节上的等效外力矩r
S07:根据所述外力矩得到外力所作用工业机器人的连杆;所述外力矩r的形式为为不全为零的数,且,从右到左寻找第一个不为零的,则第i杆即为外力作用连杆(i为整数);
S08:根据外力作用的具体位置,通过,求得外力的大小和具体方向,其中,F e 为外力,为外力作用位置的工业机器人雅可比矩阵,r为动量偏差观测器观测的外力矩;
在本实施例中,所述动量偏差观测器实质上为一改进型的二阶系统,对其微分后进行拉普拉斯变换可得,因此力矩观测值可以准确跟踪外力矩,其控制系统框图如附图3所示。
基于上述步骤,即可完成对机器人外力的检测,所述检测方法无需添加传感器,无需加速度信息,无需对现有机器人进行大幅改造,可靠性高,具有较好的实时性和准确性。
上列较佳实施例,对本发明的目的、技术方案和优点进行了进一步详细说明,所应理解的是,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

Claims (5)

1.一种工业机器人无外部传感器的外力检测方法,其特征在于:
提供一工业机器人,该工业机器人包括至少1个关节和控制器,每个关节均包括连杆、减速机、电机、驱动器和编码器,所述驱动器包括力矩检测单元;
所述外力检测方法为:所述控制器从所述驱动器中读取力矩参数和编码器位置参数,采用动量偏差观测器算法,得到外力在所述关节处的等效外力矩,依据所述等效外力矩得出外力的大小和方向,以及所作用连杆;
所述外力检测方法具体实施步骤如下,
S01:建立所述工业机器人的动力学方程,其中,为关节角位移,为关节角速度,为关节角加速度,为工业机器人的惯性矩阵,为工业机器人的哥氏矩阵,为作用于各关节的重力矩矢量,为关节的驱动力矩,为外部作用力等效到各关节的力矩;
S02:求取所述工业机器人的广义动量
S03:设计动量偏差观测器,,其中,为动量估计值,动量估计值的微分满足:,依据动力学方程对所建动量偏差观测器展开,得到动量偏差观测器的具体形式r为所观测的动量偏差,在数值上等于作用于机器人上的外力在机器人关节处的等效力矩,p(t)为机器人的广义动量,的转置,K 1 K 2 为常数对角矩阵,具体数值可按步骤S05求得;
S04:对所述动量偏差观测器加入性能调整函数,得到动量偏差观测器的最终形式K 3 为常数对角矩阵,具体数值可按步骤S05求得;
S05:调整所述动量偏差观测器函数中,K 1 ,K 2 ,K 3 的值,使系统获得良好性能,其中,K 1 >0,K 2 >0,K 3 >0,均为系统的增益矩阵;动量偏差观测器为一改进型二阶系统,系统阻尼比,可先调整K 1 ,K 2 使系统处于过阻尼转态,再调整系数K 3 提高系统的实时性和准确性;
S06:从工业机器人中读取关节驱动力矩、关节位置参数,再有关节位置通过微分获得关节速度,代入所述动量偏差观测器函数,得到外力在关节上的等效外力矩r
S07:根据所述外力矩得到外力所作用工业机器人的连杆;所述外力矩r的形式为为不全为零的数,且,从右到左寻找第一个不为零的,则第i杆即为外力作用连杆;
S08:根据外力作用的具体位置,通过,求得外力的大小和具体方向,其中,F e 为外力,为外力作用位置的工业机器人雅可比矩阵,r为动量偏差观测器观测的外力矩。
2.根据权利要求1所述的工业机器人无外部传感器的外力检测方法,其特征在于:所述的动量偏差观测器算法,是依据机械手广义动量与外力矩间具有解耦性,且工业机器人受到外力时,动量会发生变化的原理来设计动量偏差观测器。
3.根据权利要求1所述的工业机器人无外部传感器的外力检测方法,其特征在于:所述的动量偏差观测器算法只需采集工业机器人运行时的关节驱动力矩、关节位置两个参数,所述关节速度从所述关节位置微分得到,无需加速度信息,减小噪声干扰。
4.根据权利要求1所述的工业机器人无外部传感器的外力检测方法,其特征在于:所述外力检测方法无需添加外部传感器。
5.根据权利要求1所述的工业机器人无外部传感器的外力检测方法,其特征在于:所述检测算法在工业机器人控制器上实时运行。
CN201410144776.0A 2014-04-12 2014-04-12 工业机器人无外部传感器的外力检测方法 Expired - Fee Related CN103878791B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410144776.0A CN103878791B (zh) 2014-04-12 2014-04-12 工业机器人无外部传感器的外力检测方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410144776.0A CN103878791B (zh) 2014-04-12 2014-04-12 工业机器人无外部传感器的外力检测方法

Publications (2)

Publication Number Publication Date
CN103878791A CN103878791A (zh) 2014-06-25
CN103878791B true CN103878791B (zh) 2016-03-09

Family

ID=50948072

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410144776.0A Expired - Fee Related CN103878791B (zh) 2014-04-12 2014-04-12 工业机器人无外部传感器的外力检测方法

Country Status (1)

Country Link
CN (1) CN103878791B (zh)

Families Citing this family (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015217451A (ja) * 2014-05-14 2015-12-07 ファナック株式会社 外力監視機能を有するワーク搬送方法システム
CN105643641B (zh) * 2014-11-11 2017-08-11 沈阳新松机器人自动化股份有限公司 力传感器标定装置、标定方法及力控制机器人
CN104985598B (zh) * 2015-06-24 2016-11-23 南京埃斯顿机器人工程有限公司 一种工业机器人碰撞检测方法
CN107009390A (zh) * 2017-04-21 2017-08-04 大连理工大学 一种服务机器人运动功能自动测试系统
CN107263478B (zh) * 2017-07-11 2020-03-17 西南科技大学 遥操作机器人机械手爪夹持力的计算方法及其控制方法
CN108015774B (zh) * 2017-12-15 2020-10-13 北京艾利特科技有限公司 一种无需传感器的机械臂碰撞检测方法
CN108582070A (zh) * 2018-04-17 2018-09-28 上海达野智能科技有限公司 机器人碰撞检测系统和方法、存储介质、操作系统
CN108582069A (zh) * 2018-04-17 2018-09-28 上海达野智能科技有限公司 机器人拖动示教系统和方法、存储介质、操作系统
EP3880412A1 (en) 2018-11-12 2021-09-22 Obshchestvo S Ogranichennoy Otvetstvennostyu "Tra Robotics" Sensor-free force/torque sensing in an articulated electromechanical actuator-driven robot
CN109483597A (zh) * 2018-11-22 2019-03-19 库曼机器人(武汉)有限公司 一种基于双光电编码器检测外力的方法
CN111347416B (zh) * 2018-12-24 2021-10-22 核动力运行研究所 一种无外部传感器的检查机器人碰撞检测方法
CN111103846A (zh) * 2019-12-26 2020-05-05 熵智科技(深圳)有限公司 一种基于时间序列的数控机床状态预测方法
CN113043269B (zh) * 2019-12-27 2024-04-05 深圳慧智星晨科技有限公司 一种基于机器人模型的机器人接触力观测系统
CN113561170B (zh) * 2020-04-29 2023-01-24 北京配天技术有限公司 机器人力矩补偿方法、机器人、设备及存储介质
CN112847345B (zh) * 2020-12-30 2022-04-15 上海节卡机器人科技有限公司 一种机器人拖动示教的方式确定方法和装置
CN114800620B (zh) * 2022-06-13 2023-12-12 湖南科技大学 一种无力传感器的机器人外力检测方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0232424B1 (en) * 1985-07-26 1993-09-29 Matsushita Electric Industrial Co., Ltd. Industrial robot
DE69411130T2 (de) * 1993-11-15 1999-02-11 Asea Brown Boveri Ab, Vaesteraas Verfahren und Vorrichtung zum Eichen der Bewegungsachsen eines Industrierobotors
CN101602208A (zh) * 2008-06-11 2009-12-16 松下电器产业株式会社 机械手、机械手的碰撞检测方法以及机械手的控制方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1142577A (ja) * 1997-07-28 1999-02-16 Matsushita Electric Ind Co Ltd ロボットの制御方法および装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0232424B1 (en) * 1985-07-26 1993-09-29 Matsushita Electric Industrial Co., Ltd. Industrial robot
DE69411130T2 (de) * 1993-11-15 1999-02-11 Asea Brown Boveri Ab, Vaesteraas Verfahren und Vorrichtung zum Eichen der Bewegungsachsen eines Industrierobotors
CN101602208A (zh) * 2008-06-11 2009-12-16 松下电器产业株式会社 机械手、机械手的碰撞检测方法以及机械手的控制方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
《无外部传感器的机器人碰撞检测》;马志举等;《测试技术学报》;20130331;第27卷(第3期);第254-259页 *
《空间机器人动力学参数辨识及其软件设计》;夏丹;《中国优秀硕士学位论文全文数据库 信息科技辑》;20111231(第14期);第24-47页 *

Also Published As

Publication number Publication date
CN103878791A (zh) 2014-06-25

Similar Documents

Publication Publication Date Title
CN103878791B (zh) 工业机器人无外部传感器的外力检测方法
CN107729585B (zh) 一种对无人机的噪声协方差进行估算的方法
CN106426174B (zh) 一种基于力矩观测和摩擦辨识的机器人接触力检测方法
CN103034123B (zh) 基于动力学模型参数辨识的并联机器人控制方法
CN107813345B (zh) 机器人碰撞检测方法及装置
US8583285B2 (en) Method and device for stopping a manipulator
CN108015774B (zh) 一种无需传感器的机械臂碰撞检测方法
CN106346513B (zh) 一种六自由度机器人末端负载动力学参数辨识装置及方法
CN108000521A (zh) 一种无传感器式协作机器人碰撞检测方法
Shang et al. Motion control of parallel manipulators using acceleration feedback
CN104626171A (zh) 基于六维力传感器的机械臂碰撞检测与响应方法
CN110666794B (zh) 一种机器人末端工具负载力和力矩补偿的方法
CN111496791A (zh) 一种基于串联机器人的整体动力学参数辨识方法
CN111267105A (zh) 一种六关节机器人的动力学参数辨识及碰撞检测方法
Lendek et al. Application of Takagi-Sugeno observers for state estimation in a quadrotor
Tian et al. Sensorless collision detection and contact force estimation for collaborative robots based on torque observer
Marwan et al. Calibration method for articulated industrial robots
CN103412487B (zh) 一种基于模糊滑模控制器的球形机器人坡面运动控制方法
CN114800519B (zh) 一种考虑摩擦的六自由度工业机器人动力学参数辨识方法
KR101487624B1 (ko) 로봇 머니퓰레이터 제어 방법
CN110682290B (zh) 一种基于动量观测器的闭环机械臂系统碰撞检测方法
US20150377726A1 (en) Method for indentifying friction parameter for linear module
US20170261529A1 (en) Method for identifying friction parameter for linear module
CN111168660A (zh) 一种冗余自由度液压重载机器臂主动安全系统
CN113246137A (zh) 基于外力矩估计模型的机器人碰撞检测方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20160309

CF01 Termination of patent right due to non-payment of annual fee