CN114800620B - 一种无力传感器的机器人外力检测方法 - Google Patents
一种无力传感器的机器人外力检测方法 Download PDFInfo
- Publication number
- CN114800620B CN114800620B CN202210664855.9A CN202210664855A CN114800620B CN 114800620 B CN114800620 B CN 114800620B CN 202210664855 A CN202210664855 A CN 202210664855A CN 114800620 B CN114800620 B CN 114800620B
- Authority
- CN
- China
- Prior art keywords
- robot
- external force
- friction
- force
- 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.)
- Active
Links
- 238000001514 detection method Methods 0.000 title claims abstract description 36
- 238000000034 method Methods 0.000 claims abstract description 22
- 238000000691 measurement method Methods 0.000 claims abstract description 7
- 230000001419 dependent effect Effects 0.000 claims abstract description 4
- 230000005540 biological transmission Effects 0.000 claims description 9
- 230000033001 locomotion Effects 0.000 claims description 8
- 230000003068 static effect Effects 0.000 claims description 3
- 230000001133 acceleration Effects 0.000 description 5
- 238000013461 design Methods 0.000 description 5
- 230000007246 mechanism Effects 0.000 description 5
- 230000008859 change Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 238000002955 isolation Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/0095—Means or methods for testing manipulators
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种无力传感器的机器人外力检测方法,包括以下步骤:步骤S1:建立所述的机器人的动力学方程;步骤S2:求取机器人的广义动量及其微分公式;步骤S3:建立新型二阶扩张状态观测器;步骤S4:确定关节等效控制力矩;步骤S5:设计频率相关的摩擦力测量方法;步骤S6:构建非线性摩擦模型。本发明的无力传感器的机器人外力检测方法,基于新型二阶扩张状态观测器与关节摩擦补偿的机器人外力检测方法,利用机器人广义动量与扩张状态观测方法设计了新型二阶扩张状态观测器,通过观测器内部的扰动变量对机器人所受外力作为系统扰动进行观测,实现机器人外力检测。
Description
技术领域
本发明涉及机器人安全控制领域,具体涉及一种无力传感器的机器人外力检测方法。
背景技术
机器人在工业生产、服务、医疗等领域应用不断增加,通过封闭机器人工作空间以实现人机隔离、保证人机安全的方法,已经不符合人机共融技术的新要求。机器人协作在各个生产领域广泛应用,机器人面临复杂且不确定的工作环境,机器人存在与人或环境发生碰撞的可能性。为确保人机安全,碰撞检测成为协作机器人不可或缺的功能模块。
人与机器人共存环境下的外力检测是确保人和设备安全的基础。目前,市场上大部分机器人的关节都伺服电机驱动控制,并通过编码器进行位置反馈。机器人本身提供的这些信息,特别是关节电机电流变化信号,为实现机器人碰撞检测提供了重要基础。基于测量电流的方法实现碰撞检测,一般都是利用机器人动力学方程构建外力检测模型。由于机器人关节不可避免地存在非线性摩擦,以及加速度参数需要通过编码器位置反馈信息的二阶求导和动力学逆运算等,会产生巨大的噪声和不准,致使其抗干扰能力差、外力检测阈值设定过程较为复杂,进而可能使机器人外力检测产生误判。
发明内容
本发明要解决的技术问题就在于:针对现有技术存在的技术问题,本发明提供一种无力传感器的机器人外力检测方法,可以利用机器人本身的位置传感器和关节驱动电流实现外力检测。
为解决上述技术问题,本发明提出的技术方案为:
一种无力传感器的机器人外力检测方法,包括以下步骤:
步骤S1:建立所述的机器人的动力学方程;
步骤S2:求取机器人的广义动量及其微分公式;
步骤S3:建立二阶扩张状态观测器;
步骤S4:确定关节等效控制力矩;
步骤S5:设计频率相关的摩擦力测量方法;
步骤S6:构建非线性摩擦模型。
作为上述技术方案的进一步改进:
上述方案中,优选地,所述步骤S2中,先推导广义动量与外部作用力的关系:
再建立基于广义动量的一阶系统:
上述方案中,优选地,所述步骤S3中,由常规的扩张状态观测方法可知,一个二阶系统的观测器至少为三阶,其扩张状态观测器可表示为:
其中,β01、β02、β03观测器参数,e0为观测误差,y为系统输出,z1、z2、z3为系统状态估计量,Bu为系统输入变量。
利用机器人广义动量,设计新型二阶扩张状态观测器为:
其中,e为机器人系统广义动量观测误差,β1、β2观测器参数,为广义动量的估计量,/>为系统扰动估计量,Bu为系统输入变量。
上述方案中,优选地,所述机器人受到外部作用力的τe后,观测器通过系统扰动估计量在线观测得到输出信号r的表达式:
r=[r1…ri,r(i+1)…rn]T
式中,i=1…n为机器人关节数,Ri为对应阈值。因此,从r1到rn逐个与对应阈值比较,当|ri|>Ri且|r(i+1)|≤R(i+1)时可判断第i连杆受力,并由Sign可以判断出受力的方向。
上述方案中,优选地,所述步骤S4中,采用测量电机电流的方法,算出关节等效控制力矩:
τ=NmKmim
其中,im为电机的电流,Km与电机本身电流转化为力矩的相关系数,Nm为电机到关节输出端的传动比。
上述方案中,优选地,所述步骤S5中,设计频率相关的摩擦力测量方法,列出机器人N组不同频率的正弦运动轨迹与对应速度公式,获取各关节速度与摩擦力的数据组合集。
上述方案中,优选地,所述步骤S6中,采用非线性模型摩擦模型,模型的表达式为:
其中,Fc为库伦摩擦系数,Fs静态摩擦系数,α1、α2和α3为粘性摩擦系数,Vs为Stribeck速度,σ0为与接触表面几何形状相关的参数;运用最小二乘法法对摩擦模型公式中的参数进行离线辨识:
本发明提供的无力传感器的机器人外力检测方法,与现有技术相比有以下优点:
(1)本发明的无力传感器的机器人外力检测方法,基于新型二阶扩张状态观测器与关节摩擦补偿的机器人外力检测方法,利用机器人广义动量与扩张状态观测方法设计了新型二阶扩张状态观测器,通过观测器内部的扰动变量对机器人所受外力作为系统扰动进行观测,实现机器人外力检测。
(2)本发明的无力传感器的机器人外力检测方法,观测器中通过采集关节伺服驱动的电流信息获取等效的关节控制力矩,设计频率相关的摩擦力测量方法,准确测量关节摩擦力,并采用非线性摩擦模型对关节摩擦进行辨识与补偿,提高机器人外力检测的准确度。
(3)本发明的无力传感器的机器人外力检测方法,无需机器人关节加速度信息,避免了因获取加速度而增加成本和增大计算误差的缺点,同时也无需安装专门的力传感器,有利于在常规的工业机器人系统中推广应用。
(4)本发明的无力传感器的机器人外力检测方法,针对实际机器人容易出现运动空间受限问题,设计了频率相关的关节运动轨迹与对应运动速度的摩擦力测量方法,避免惯性与重力等对摩擦参数辨识的影响。
附图说明
图1是本发明检测方法的流程图。
图2是本发明实施例的机器人关节控制力矩传递示意图。
图3是本发明实施例机器人单关节摩擦力的测量示意图。
图4是本发明实施例机器人外力检测实验结果图。
附图标号说明:
1、连杆;2、传动机构;3、电机;4、驱动控制器;5、关节。
具体实施方式
以下对本发明的具体实施方式进行详细说明。应当理解的是,此处所描述的具体实施方式仅用于说明和解释本发明,并不用于限制本发明。
如图1至图4所示,为了详细说明本发明一种无力传感器的机器人外力检测方法,采用简单的测试结构来具体说明本发明的检测方法。如图2所示,测试结构包括驱动控制器4、电机3、传动机构2和连杆1,电机驱动传动机构,传动机构带动连杆,连杆一端与传动机构连接,另一端形成机器人的关节。
本发明的一种无力传感器的机器人外力检测方法,具体包括以下步骤:
步骤S1:建立所述的机器人的动力学方程。
利用机器人三维模型或生产商提供的模型参数,也可通过参数辨识方法获取动力学模型基本参数,采用拉格朗日动力学方法,建立刚性机器人动力学方程如下:
式中,q、分别为机器人关节的位置、速度和加速度;M(q)为惯性矩阵;/>为哥氏力和离心力矩阵;G(q)为重力项;τF为摩擦力矩;τ为关节的控制力矩,τe为外部作用力。
步骤S2:求取机器人的广义动量及其微分公式。
推导广义动量与外部作用力的关系为:
建立基于广义动量的一阶系统:
步骤S3:由常规的扩张状态观测方法可知,一个二阶系统的观测器至少为三阶,其扩张状态观测器可表示为:
其中,β01、β02、β03观测器参数,e0为观测误差,y为系统输出,z1、z2、z3为系统状态估计量,Bu为系统输入变量。
利用机器人广义动量,设计新型二阶扩张状态观测器为:
其中,e为机器人系统广义动量观测误差,β1、β2观测器参数,为广义动量的估计量,/>为系统扰动估计量,Bu为系统输入变量。
机器人受到外部作用力的σe后,观测器通过系统扰动估计量z2在线观测得到输出信号r的表达式:
r=[r1…ri,r(i+1)…rn]T
式中,i=1…n为机器人关节数,Ri为对应阈值。因此,从r1到rn逐个与对应阈值比较,当|ri|>Ri且|r(i+1)|≤R(i+1)时可判断第i连杆受力,并由Sign可以判断出受力的方向。
步骤S4:采用测量关节电机3电流的方法,算出关节等效控制力矩:
τ=NmKmim
其中,im为电机的电流,Km与电机本身电流转化为力矩的相关系数,Nm为电机到关节输出端的传动比。
步骤S5:如图3所示,设计频率相关的摩擦力测量方法,通过单关节独立实验,减小惯性和重力的影响,控制机器人N组不同频率的正弦运动轨迹与对应速度公式为:
式中,v(t)=n受单位时间约束,/>Φ、V、N分别为与关节运动范围、最大速度、速度采集量相关的参数。对每一个设定速度的实验中选取实际接近该速度值/>的数据组求取均值,/>正反方向的摩擦力获取各关节实际运行速度与摩擦力的数据组合集为:
上述关节实际运行速度与摩擦力数据组合集只与实际机器人运行位置的摩擦力和速度有关,不受实际机器人位置和速度控制精度的影响。
步骤S6:采用非线性模型描述关节摩擦,模型的表达式为:
其中,Fc为库伦摩擦系数,Fs静态摩擦系数,α1、α2和α3为粘性摩擦系数,Vs为Stribeck速度,σ0为与接触表面几何形状相关的参数。运用最小二乘法法对摩擦模型公式中的参数进行离线辨识:
通过上述步骤可以辨识出机器人各关节摩擦参数。如图4所示实验结果,对机器人关节摩擦进行补偿后,可以减小外力检测的阈值,从而提高机器人外力检测的准确度。
本发明的检测方法,采用广义动量与扩张状态观测的方法,设计了新型二阶扩张状态观测器。该观测器将广义动量作为系统状态变量,当机器人受到外力作用力后,机器人系统的广义动量会实时发生变化,通过新型二阶扩张状态观测器内部的总扰动状态变量,对导致机器人系统广义动量发生变化的系统扰动(外力)进行观测,实现机器人外力检测。新型二阶扩张状态观测器采集机器人关节伺服驱动的电流信息计算获取等效控制力矩,并采用非线性摩擦模型对关节摩擦进行补偿,通过对实际机器人受限运动空间设计频率相关的摩擦力测量力方法,准确辨识非线性摩擦模型参数,减小关节摩擦对外力检测的影响,提高机器人外力检测的准确度。本发明的新型二阶扩张状态观测器不需要关节加速度信息和关节力传感器,只需获取常规机器人关节电流、位置和速度信息,其中速度信息可通过位置微分计算获取,无需对现有机器人进行大幅度改造,可以在常规的工业机器人系统是推广应用。
上述实施案例只是本发明的较佳实施例,并非对本发明作任何形式上的限制。虽然本发明已以较佳实施例揭露如上,然而并非用以限定本发明。因此,凡是未脱离本发明技术方案的内容,依据本发明技术实质对以上实施例所做的任何简单修改、等同变化及修饰,均应落在本发明技术方案保护的范围内。
Claims (4)
1.一种无力传感器的机器人外力检测方法,其特征在于,包括以下步骤:
步骤S1:建立所述的机器人的动力学方程;
步骤S2:求取机器人的广义动量及其微分公式;
步骤S3:建立二阶扩张状态观测器;
步骤S4:确定关节等效控制力矩;
步骤S5:设计频率相关的摩擦力测量方法;
步骤S6:构建非线性摩擦模型;
所述步骤S3中,二阶扩张状态观测器为:
其中,e为机器人系统广义动量观测误差,β1、β2观测器参数,为广义动量的估计量,/>为系统扰动估计量,Bu为系统输入变量;
所述机器人受到外部作用力的τe后,观测器通过系统扰动估计量在线观测得到输出信号r的表达式:
r=[r1…ri,r(i+1)…rn]T
式中,i=1…n为机器人关节数,Ri为对应阈值;因此,从r1到rn逐个与对应阈值比较,当|ri|>Ri且|r(i+1)|≤R(i+1)时可判断第i连杆受力,并由Sign可以判断出受力的方向;
所述步骤S4中,采用测量电机电流的方法,算出关节等效控制力矩:
τ=NmKmim
其中,im为电机的电流,Km与电机本身电流转化为力矩的相关系数,Nm为电机到关节输出端的传动比。
2.根据权利要求1所述的无力传感器的机器人外力检测方法,其特征在于,所述步骤S2中,先推导广义动量与外部作用力的关系:
再建立基于广义动量的一阶系统:
。
3.根据权利要求1所述的无力传感器的机器人外力检测方法,其特征在于,所述步骤S5中,设计频率相关的摩擦力测量方法,列出机器人N组不同频率的正弦运动轨迹与对应速度公式,获取各关节速度与摩擦力的数据组合集。
4.根据权利要求1所述的无力传感器的机器人外力检测方法,其特征在于,所述步骤S6中,采用非线性模型摩擦模型,模型的表达式为:
其中,Fc为库伦摩擦系数,Fs静态摩擦系数,α1、α2和α3为粘性摩擦系数,Vs为Stribeck速度,σ0为与接触表面几何形状相关的参数;运用最小二乘法法对摩擦模型公式中的参数进行离线辨识:
。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210664855.9A CN114800620B (zh) | 2022-06-13 | 2022-06-13 | 一种无力传感器的机器人外力检测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210664855.9A CN114800620B (zh) | 2022-06-13 | 2022-06-13 | 一种无力传感器的机器人外力检测方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114800620A CN114800620A (zh) | 2022-07-29 |
CN114800620B true CN114800620B (zh) | 2023-12-12 |
Family
ID=82522173
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210664855.9A Active CN114800620B (zh) | 2022-06-13 | 2022-06-13 | 一种无力传感器的机器人外力检测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114800620B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103192413A (zh) * | 2012-01-06 | 2013-07-10 | 沈阳新松机器人自动化股份有限公司 | 一种无传感器的机器人碰撞检测保护装置及方法 |
CN103878791A (zh) * | 2014-04-12 | 2014-06-25 | 福州大学 | 工业机器人无外部传感器的外力检测方法 |
CN106426174A (zh) * | 2016-11-05 | 2017-02-22 | 上海大学 | 一种基于力矩观测和摩擦辨识的机器人接触力检测方法 |
JP2018058181A (ja) * | 2016-10-07 | 2018-04-12 | 国立大学法人岐阜大学 | 外乱オブザーバ及びロボット制御装置 |
CN108000521A (zh) * | 2017-12-06 | 2018-05-08 | 天津大学 | 一种无传感器式协作机器人碰撞检测方法 |
CN108015774A (zh) * | 2017-12-15 | 2018-05-11 | 北京艾利特科技有限公司 | 一种无需传感器的机械臂碰撞检测方法 |
CN113459160A (zh) * | 2021-06-23 | 2021-10-01 | 佛山智能装备技术研究院 | 一种基于二阶广义动量观测器的机器人碰撞检测方法 |
-
2022
- 2022-06-13 CN CN202210664855.9A patent/CN114800620B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103192413A (zh) * | 2012-01-06 | 2013-07-10 | 沈阳新松机器人自动化股份有限公司 | 一种无传感器的机器人碰撞检测保护装置及方法 |
CN103878791A (zh) * | 2014-04-12 | 2014-06-25 | 福州大学 | 工业机器人无外部传感器的外力检测方法 |
JP2018058181A (ja) * | 2016-10-07 | 2018-04-12 | 国立大学法人岐阜大学 | 外乱オブザーバ及びロボット制御装置 |
CN106426174A (zh) * | 2016-11-05 | 2017-02-22 | 上海大学 | 一种基于力矩观测和摩擦辨识的机器人接触力检测方法 |
CN108000521A (zh) * | 2017-12-06 | 2018-05-08 | 天津大学 | 一种无传感器式协作机器人碰撞检测方法 |
CN108015774A (zh) * | 2017-12-15 | 2018-05-11 | 北京艾利特科技有限公司 | 一种无需传感器的机械臂碰撞检测方法 |
CN113459160A (zh) * | 2021-06-23 | 2021-10-01 | 佛山智能装备技术研究院 | 一种基于二阶广义动量观测器的机器人碰撞检测方法 |
Non-Patent Citations (2)
Title |
---|
Robot Collision Detection and Distinction Based on Convolution Filtering Dynamic Model;Zhijing Li, Jinhua Ye, and Haibin Wu;《Sensors and Materials》;第31卷(第12期);全文 * |
柔性关节机械臂的自适应命令滤波输出反馈控制;潘昌忠,费湘尹,周兰,熊培银,李智靖;《西安交通大学学报》;第56卷(第5期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN114800620A (zh) | 2022-07-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3351356B1 (en) | Robot collision detection method | |
Hoseinnezhad et al. | Calibration of resolver sensors in electromechanical braking systems: A modified recursive weighted least-squares approach | |
Bittencourt et al. | An extended friction model to capture load and temperature effects in robot joints | |
CN110460277A (zh) | 基于粒子群算法的单电机伺服系统摩擦非线性补偿方法 | |
KR101548945B1 (ko) | 탄성 로봇 구조를 위한 운동 제어기 | |
Jeon et al. | Benefits of acceleration measurement in velocity estimation and motion control | |
Wolf et al. | Extending a dynamic friction model with nonlinear viscous and thermal dependency for a motor and harmonic drive gear | |
Mitsantisuk et al. | Kalman filter-based disturbance observer and its applications to sensorless force control | |
CN110259879B (zh) | 用于电动Stewart结构的无力反馈隔振控制方法和系统 | |
Indri et al. | Friction modeling and identification for industrial manipulators | |
JP2016221615A (ja) | ロボット装置の診断方法、およびロボットシステム | |
CN113681567A (zh) | 一种新型无传感器机器人碰撞检测方法及其系统 | |
CN112677156A (zh) | 一种机器人关节摩擦力补偿方法 | |
CN114800620B (zh) | 一种无力传感器的机器人外力检测方法 | |
CN113664869A (zh) | 机械臂、机械臂控制方法及系统 | |
Bai et al. | Identification of generalized friction for an experimental planar two-link flexible manipulator using strong tracking filter | |
CN113711138B (zh) | 伺服控制装置 | |
WO2018077593A1 (en) | Method for determining a deadzone angle of a backlash in a mechanical drive-train system, method for controlling a drive motor controller as well as drive-train system | |
CN215825344U (zh) | 机械臂 | |
CN114700939B (zh) | 一种协作机器人关节负载转矩观测方法、系统及存储介质 | |
CN113043269B (zh) | 一种基于机器人模型的机器人接触力观测系统 | |
Marton et al. | Friction and backlash measurement and identification method for robotic arms | |
Hashemi et al. | Parameter identification of a robot arm using separable least squares technique | |
JP5473889B2 (ja) | 力制御装置 | |
CN113146641A (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 |