CN111230879A - 一种基于力传感器的机器人末端接触力补偿方法及系统 - Google Patents
一种基于力传感器的机器人末端接触力补偿方法及系统 Download PDFInfo
- Publication number
- CN111230879A CN111230879A CN202010105965.2A CN202010105965A CN111230879A CN 111230879 A CN111230879 A CN 111230879A CN 202010105965 A CN202010105965 A CN 202010105965A CN 111230879 A CN111230879 A CN 111230879A
- Authority
- CN
- China
- Prior art keywords
- force sensor
- dimensional force
- tool
- sensor
- dimensional
- 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
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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- 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)
- Force Measurement Appropriate To Specific Purposes (AREA)
- Manipulator (AREA)
Abstract
本发明涉及机器人控制技术领域,具体涉及一种基于力传感器的机器人末端接触力补偿方法及系统,所述方法为:首先计算六维力传感器的精度,判断六维力传感器的精度是否满足工艺需求;计算六维力传感器各轴力耦合度,判断六维力传感器各轴力耦合度是否满足工艺需求;当六维力传感器的精度和各轴力耦合度满足工艺需求时,获取不少于三组机器人工具末端在不同姿态下的六维力传感器读数,利用最小二乘法计算出工具重力和传感器零点;当六维力传感器与外界环境接触时,计算工具末端接触力;最后,将传感器零点、工具重力以及工具末端接触力作为六维力传感器的补偿量,本发明能够提高保障机器人操作的准确度。
Description
技术领域
本发明涉及机器人控制技术领域,具体涉及一种基于力传感器的机器人末端接触力补偿方法及系统。
背景技术
随着中国经济以及科学技术的快速发展,工业机器人用来代替人类完成简单,重复性高,危险的任务是大势所趋。机器人按所完成的任务类型可以将其分为与外部约束环境接触和不与外部环境接触两种。当涉及到工业生产中的产品抛光,打磨,装配等工作时,需要机器人与外部约束环境相接触,利用六维力传感器来感知接触力是当前常用的方法。
六维力传感器通常安装在机器人末端,能够检测大小和方向不断变化的三维力和三维力矩信息。但是,六维力传感器在随机器人运动的过程中,由于其位姿不断发生变化,同时受安装在传感器上的操作工具重力的影响,传感器的零点也会随之不断变化,这就导致传感器测量上产生一定偏差,降低了其测量精度,进而影响机器人的操作。
发明内容
为解决上述问题,本发明提供一种基于力传感器的机器人末端接触力补偿方法及系统,能够提高保障机器人操作的准确度。
为了实现上述目的,本发明提供以下技术方案:
根据本发明第一方面实施例提供的一种基于力传感器的机器人末端接触力补偿方法,包括:
步骤S100、计算六维力传感器的精度,判断六维力传感器的精度是否满足工艺需求;计算六维力传感器各轴力耦合度,判断六维力传感器各轴力耦合度是否满足工艺需求;
步骤S200、当六维力传感器的精度和各轴力耦合度满足工艺需求时,获取不少于三组机器人工具末端在不同姿态下的六维力传感器读数,利用最小二乘法计算出工具重力和传感器零点;
步骤S300、当六维力传感器与外界环境接触时,计算工具末端接触力;
步骤S400、将传感器零点、工具重力以及工具末端接触力作为六维力传感器的补偿量。
进一步,所述步骤S100中,计算六维力传感器的精度,判断六维力传感器的精度是否满足工艺需求,包括:
读取六维力传感器当前三维力和三维力矩读数;
将六维力传感器调整到设定位置上,并记录每个设定位置上的三维力Fx、Fy、Fz的稳定波形;其中,六维力传感器的设定位置分别为:第一设定位置:X+轴朝上,Z轴保持水平姿态;第二设定位置:X+轴朝下,Z轴保持水平姿态;第三设定位置:Y+轴朝上,Z轴保持水平姿态;第四设定位置:Y+轴朝上,Z轴保持水平姿态;第五设定位置:Z轴竖直朝上,X、Y轴保持水平姿态;第六设定位置:Z轴竖直朝下,X、Y轴保持水平姿态;
在六维力传感器处于第一设定位置、第三设定位置、第五设定位置时,不加任何外部力的情况下,通过每个姿态下的X、Y、Z三个轴的读数计算三轴之间的耦合度,最后将三个设定位置下的耦合度取平均值,得到平均耦合度;
根据平均耦合度判断六维力传感器的各轴力耦合度是否满足工艺生产要求。
进一步,所述步骤S100中,计算六维力传感器各轴力耦合度,判断六维力传感器各轴力耦合度是否满足工艺需求,包括:
通过以下公式计算6个设定位置在稳定姿态下三个方向力的平均值Fxa,Fya,Fza:
Fxa=(Fx1+Fx2+Fx3+Fx4+Fx5+Fx6)/6
Fya=(Fy1+Fy2+Fy3+Fy4+Fy5+Fy6)/6
Fza=(Fz1+Fz2+Fz3+Fz4+Fz5+Fz6)/6
取每个轴上最大值Fxmax、Fymax、Fzmax和最小值Fxmin、Fymin、Fzmin,通过以下公式计算得出FX、FY、FZ、Fx、Fy、Fz:
若精度偏差S在设定阈值以内,则判定六维力传感器精度满足工艺需求。
进一步,所述步骤S200包括:
通过以下公式计算在六维力传感器中的力/力矩与工具重心:
Mx'=Fz'*y-Fy'*z
My'=Fx'*z-Fz'*x
Mz'=Fy'*x-Fx'*y 1)
其中,Fx’、Fy’、Fz’是工具重力在六维力传感器中的三维力分量,Mx’、My’、Mz’是三维力所引起的三维力矩;
当机器人工具末端不受外力时,通过以下公式计算工具重力以及传感器零点:
Fx=Fx'+fx
Fy=Fy'+fy
Fz=Fz'+fz
Mx=Mx'+mx
My=My'+my
Mz=Mz'+mz 2)
其中,Fx,Fy,Fz为工具重力,fx,fy,fz为传感器零点;
将公式2)带入公式1)中得公式3);
Mx=Fz*y-Fy*z+kx
My=Fx*z-Fz*x+ky
Mz=Fy*x-Fx*y+kz 3)
其中:
kx=mx+fy*z-fz*y
ky=my+fz*x-fx*z
kz=mz+fx*y-fy*x 4)
将公式3)转换成矩阵形式:
记录不少于三个机器人末端不同姿态下的六维力传感器读数,利用最小二乘法计算出工具重心在六维力传感器中的坐标(x,y,z)以及常数kx,ky,kz;
选取不少于三组机器人工具末端的不同姿态,将公式4)转换成公式6)的矩阵形式,同样利用最小二乘法计算出六维力传感器自身零点(mx,my,mz),(fx,fy,fz);
进一步,所述步骤S300包括:
末端接触力在传感器坐标系[Fs,Ms]和工具坐标系中[Ft,Mt]通过公式7)表示:
根据本发明第二方面实施例提供的一种基于力传感器的机器人末端接触力补偿系统,所述系统包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述计算机程序被所述处理器执行时实现上述任一项所述的基于力传感器的机器人末端接触力补偿方法的步骤。
本发明的有益效果是:本发明公开一种基于力传感器的机器人末端接触力补偿方法及系统,所述方法为:首先计算六维力传感器的精度,判断六维力传感器的精度是否满足工艺需求;计算六维力传感器各轴力耦合度,判断六维力传感器各轴力耦合度是否满足工艺需求;当六维力传感器的精度和各轴力耦合度满足工艺需求时,获取不少于三组机器人工具末端在不同姿态下的六维力传感器读数,利用最小二乘法计算出工具重力和传感器零点;当六维力传感器与外界环境接触时,计算工具末端接触力;最后,将传感器零点、工具重力以及工具末端接触力作为六维力传感器的补偿量。本发明能够提高保障机器人操作的准确度。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1是本发明实施例一种基于力传感器的机器人末端接触力补偿方法的流程示意图;
图2是本发明实施例中六维力传感器与机器人末端法兰,工具与六维力传感器连接所用转接盘示意图;
图3是本发明实施例中工具重力在六维力传感器坐标系等效示意图;
图4是本发明实施例中六维力传感器与工具相对位姿示意图,其中,100,六维力传感器;200,转换盘;300,工具。
具体实施方式
以下将结合实施例和附图对本公开的构思、具体结构及产生的技术效果进行清楚、完整的描述,以充分地理解本公开的目的、方案和效果。需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。
参考图1,如图1所示为一种基于力传感器的机器人末端接触力补偿方法,包括以下步骤:
步骤S100、计算六维力传感器的精度,判断六维力传感器的精度是否满足工艺需求;计算六维力传感器各轴力耦合度,判断六维力传感器各轴力耦合度是否满足工艺需求;
步骤S200、当六维力传感器的精度和各轴力耦合度满足工艺需求时,获取不少于三组机器人工具末端在不同姿态下的六维力传感器读数,利用最小二乘法计算出工具重力和传感器零点;
步骤S300、当六维力传感器与外界环境接触时,计算工具末端接触力;
步骤S400、将传感器零点、工具重力以及工具末端接触力作为六维力传感器的补偿量。
在六维力传感器使用过程中,由于工艺的不同,对六维力传感器的检测精度也会有不同要求,但无论何种工艺,只要是使用到六维力传感器,都需要对进行工具重力补偿和传感器自身零点补偿。然而,在使用过程中,即使六维力传感器在进行工具重力补偿和传感器自身零点补偿后,得到的工具与外部约束环境接触力依然有误差存在的情况。
为解决上述技术问题,发明人在分析解决上述问题的过程中发现,这是由于不同使用场合对六维力传感器的精度要求不尽相同,本实施例中,首先验证六维力传感器各轴耦合情况,判断机械轴的耦合度是否满足工艺需求,其次对六维力传感器的精度进行检查,判断六维力传感器的检测精度是否满足工艺需求。
其中,六维力传感器各轴力耦合度及精度检测步骤如下:
一、通过转接盘将六维力传感器与机器人末端法兰盘连接固定,并将机器人控制器与六维力传感器模数转换模块连接好。六维力传感器上电初始化后,通过Codesys软件读取六维力传感器当前三维力和三维力矩读数。
二、通过机器人示教器,将六维力传感器调整到设定位置上,并记录每个设定位置上的三维力Fx、Fy、Fz的稳定波形。其中,六维力传感器的设定位置分别为:第一设定位置:X+轴朝上,Z轴保持水平姿态;第二设定位置:X+轴朝下,Z轴保持水平姿态;第三设定位置:Y+轴朝上,Z轴保持水平姿态;第四设定位置:Y+轴朝上,Z轴保持水平姿态;第五设定位置:Z轴竖直朝上,X、Y轴保持水平姿态;第六设定位置:Z轴竖直朝下,X、Y轴保持水平姿态;
三、在六维力传感器处于第一设定位置、第三设定位置、第五设定位置时,不加任何外部力的情况下,通过每个姿态下的X、Y、Z三个轴的读数计算三轴之间的耦合度,最后将三个设定位置下的耦合度取平均值,得到平均耦合度;
四、根据步骤3)计算的耦合度,结合工艺生产要求,判断六维力传感器的各轴力耦合度是否满足工艺生产要求。
五、通过以下公式计算6个设定位置在稳定姿态下三个方向力的平均值Fxa,Fya,Fza:
Fxa=(Fx1+Fx2+Fx3+Fx4+Fx5+Fx6)/6
Fya=(Fy1+Fy2+Fy3+Fy4+Fy5+Fy6)/6
Fza=(Fz1+Fz2+Fz3+Fz4+Fz5+Fz6)/6
取每个轴上最大值Fxmax、Fymax、Fzmax和最小值Fxmin、Fymin、Fzmin,通过以下公式计算得出FX、FY、FZ、Fx、Fy、Fz:
若精度偏差S在设定阈值以内,则判定六维力传感器精度满足工艺需求。
其中,设定阈值根据传感器的工艺需求进行设定,例如,在某系列的传感器中,其工艺需求为精度偏差不超过36N,则,当每次进行精度校准时,S的取值都应该在36N之内。
在一个优选的实施例中,所述步骤S200包括:
工具重力重心求解:
经过对六维力传感器各轴力耦合度以及精度检测后,若达到要求便可认为六维力传感器满足工艺需求,下一步便可对六维力传感器进行补偿。在机器人与外部约束环境接触时,六维力传感器器数值由传感器本身零点误差、工具重力以及工具与外界接触力三部分构成。工具通过转接盘与李传感器连接固定,如图2所示为六维力传感器与机器人末端法兰,工具与六维力传感器连接所用转接盘示意图,如图3所示为工具重力在六维力传感器坐标系等效示意图。
在如图3中,工具重力在六维力传感器中的力/力矩与工具重心可用公式1)表达:
Mx'=Fz'*y-Fy'*z
My'=Fx'*z-Fz'*x
Mz'=Fy'*x-Fx'*y 1)
其中,Fx’、Fy’、Fz’是工具重力在六维力传感器中的三维力分量,Mx’、My’、Mz’是三维力所引起的三维力矩。
在机器人工具末端没有与外部环境接触时,六维力传感器读数由工具重力以及传感器零点两部分组成。可以用公式2)进行表示:
Fx=Fx'+fx
Fy=Fy'+fy
Fz=Fz'+fz
Mx=Mx'+mx
My=My'+my
Mz=Mz'+mz 2)
其中Fx,Fy,Fz为六维力传感器读数,fx,fy,fz为传感器零点。
将公式2)带入公式1)中可得公式3)
Mx=Fz*y-Fy*z+kx
My=Fx*z-Fz*x+ky
Mz=Fy*x-Fx*y+kz 3)
其中:
kx=mx+fy*z-fz*y
ky=my+fz*x-fx*z
kz=mz+fx*y-fy*x 4)
由公式3)可写成矩阵形式:
记录不少于三个机器人末端不同姿态下的六维力传感器读数,利用最小二乘法便可计算出工具重心在六维力传感器中的坐标(x,y,z)以及常数kx,ky,kz。
接着,求解传感器零点及工具重力:
同理,选取不少于三组机器人工具末端的不同姿态,由公式4)可写成公式6)的矩阵形式,同样利用最小二乘法便可计算出六维力传感器自身零点(mx,my,mz),(fx,fy,fz)。
接着,求解机器人工具末端接触力:
由上述步骤便可求得在六维力传感器未受外力作用下的传感器零点,工具重力,当六维力传感器与外界环境接触时,六维力传感器读数由工具末端接触力、传感器零点、工具重力三部分组成;于是,末端接触力在六维力传感器坐标系表示下的读数便可求得;由于六维力传感器通过转接盘与工具连接,因此六维力传感器与工具的姿态相同,位置不同。
如图4所示为六维力传感器100与工具300相对位姿示意图,当六维力传感器100与工具300水平安装无夹角时,则工具坐标系到六维力传感器坐标系的线性变换矩阵为:其中为旋转矩阵,为工具坐标系在传感器坐标系中的位置表达,l为工具300的重心到传感器坐标系原点的距离。
由于传感器与机器人末端法兰姿态相同,则旋转矩阵为3X3的单位阵,则末端接触力在传感器坐标系[Fs,Ms]和工具坐标系中[Ft,Mt]通过公式7)表示:
本发明的实施例还提供一种基于力传感器的机器人末端接触力补偿系统,所述系统包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述计算机程序被所述处理器执行时实现上述实施例提供的基于力传感器的机器人末端接触力补偿方法的步骤。
可见,上述方法实施例中的内容均适用于本系统实施例中,本系统实施例所具体实现的功能与上述方法实施例相同,并且达到的有益效果与上述方法实施例所达到的有益效果也相同。
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到上述实施例方法可借助软件的实现方式,以嵌入式软件加载到处理器中,以有效利用各种传感器采集的数据,进行基于力传感器的机器人末端接触力补偿。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来。
所述处理器可以是中央处理单元(Central-Processing-Unit,CPU),还可以是其他通用处理器、数字信号处理器(Digital-Signal-Processor,DSP)、专用集成电路(Application-Specific-Integrated-Circuit,ASIC)、现场可编程门阵列(Field-Programmable-Gate-Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等,所述处理器是所述一种基于力传感器的机器人末端接触力补偿系统的控制中心,利用各种接口和线路连接整个基于力传感器的机器人末端接触力补偿系统的各个部分。
所述存储器可用于存储所述计算机程序和/或模块,所述处理器通过运行或执行存储在所述存储器内的计算机程序和/或模块,以及调用存储在存储器内的数据,实现所述基于力传感器的机器人末端接触力补偿系统的各种功能。所述存储器可主要包括存储程序区和存储数据区,存储器可以包括高速随机存取存储器,还可以包括非易失性存储器,例如硬盘、内存、插接式硬盘,智能存储卡(Smart-Media-Card,SMC),安全数字(Secure-Digital,SD)卡,闪存卡(Flash-Card)、至少一个磁盘存储器件、闪存器件、或其他易失性固态存储器件。
尽管本公开的描述已经相当详尽且特别对几个所述实施例进行了描述,但其并非旨在局限于任何这些细节或实施例或任何特殊实施例,而是应当将其视作是通过参考所附权利要求,考虑到现有技术为这些权利要求提供广义的可能性解释,从而有效地涵盖本公开的预定范围。此外,上文以发明人可预见的实施例对本公开进行描述,其目的是为了提供有用的描述,而那些目前尚未预见的对本公开的非实质性改动仍可代表本公开的等效改动。
Claims (6)
1.一种基于力传感器的机器人末端接触力补偿方法,其特征在于,包括:
步骤S100、计算六维力传感器的精度,判断六维力传感器的精度是否满足工艺需求;计算六维力传感器各轴力耦合度,判断六维力传感器各轴力耦合度是否满足工艺需求;
步骤S200、当六维力传感器的精度和各轴力耦合度满足工艺需求时,获取不少于三组机器人工具末端在不同姿态下的六维力传感器读数,利用最小二乘法计算出工具重力和传感器零点;
步骤S300、当六维力传感器与外界环境接触时,计算工具末端接触力;
步骤S400、将传感器零点、工具重力以及工具末端接触力作为六维力传感器的补偿量。
2.根据权利要求1所述的一种基于力传感器的机器人末端接触力补偿方法,其特征在于,所述步骤S100中,计算六维力传感器的精度,判断六维力传感器的精度是否满足工艺需求,包括:
读取六维力传感器当前三维力和三维力矩读数;
将六维力传感器调整到设定位置上,并记录每个设定位置上的三维力Fx、Fy、Fz的稳定波形;其中,六维力传感器的设定位置分别为:第一设定位置:X+轴朝上,Z轴保持水平姿态;第二设定位置:X+轴朝下,Z轴保持水平姿态;第三设定位置:Y+轴朝上,Z轴保持水平姿态;第四设定位置:Y+轴朝上,Z轴保持水平姿态;第五设定位置:Z轴竖直朝上,X、Y轴保持水平姿态;第六设定位置:Z轴竖直朝下,X、Y轴保持水平姿态;
在六维力传感器处于第一设定位置、第三设定位置、第五设定位置时,不加任何外部力的情况下,通过每个姿态下的X、Y、Z三个轴的读数计算三轴之间的耦合度,最后将三个设定位置下的耦合度取平均值,得到平均耦合度;
根据平均耦合度判断六维力传感器的各轴力耦合度是否满足工艺生产要求。
3.根据权利要求2所述的一种基于力传感器的机器人末端接触力补偿方法,其特征在于,所述步骤S100中,计算六维力传感器各轴力耦合度,判断六维力传感器各轴力耦合度是否满足工艺需求,包括:
通过以下公式计算6个设定位置在稳定姿态下三个方向力的平均值Fxa,Fya,Fza:
Fxa=(Fx1+Fx2+Fx3+Fx4+Fx5+Fx6)/6
Fya=(Fy1+Fy2+Fy3+Fy4+Fy5+Fy6)/6
Fza=(Fz1+Fz2+Fz3+Fz4+Fz5+Fz6)/6
取每个轴上最大值Fx max、Fy max、Fz max和最小值Fx min、Fy min、Fz min,通过以下公式计算得出FX、FY、FZ、Fx、Fy、Fz:
FX=Fx max-Fxa Fx=Fx min-Fxa
FY=Fy max-Fya Fy=Fy min-Fya
FZ=Fz max-Fza,Fz=Fz min-Fza
若精度偏差S在设定阈值以内,则判定六维力传感器精度满足工艺需求。
4.根据权利要求3所述的一种基于力传感器的机器人末端接触力补偿方法,其特征在于,所述步骤S200包括:
通过以下公式计算在六维力传感器中的力/力矩与工具重心:
Mx'=Fz'*y-Fy'*z
My'=Fx'*z-Fz'*x
Mz'=Fy'*x-Fx'*y 1)
其中,Fx’、Fy’、Fz’是工具重力在六维力传感器中的三维力分量,Mx’、My’、Mz’是三维力所引起的三维力矩;
当机器人工具末端不受外力时,通过以下公式计算工具重力以及传感器零点:
Fx=Fx'+fx
Fy=Fy'+fy
Fz=Fz'+fz
Mx=Mx'+mx
My=My'+my
Mz=Mz'+mz 2)
其中,Fx,Fy,Fz为工具重力,fx,fy,fz为传感器零点;
将公式2)带入公式1)中得公式3);
Mx=Fz*y-Fy*z+kx
My=Fx*z-Fz*x+ky
Mz=Fy*x-Fx*y+kz 3)
其中:
kx=mx+fy*z-fz*y
ky=my+fz*x-fx*z
kz=mz+fx*y-fy*x 4)
将公式3)转换成矩阵形式:
记录不少于三个机器人末端不同姿态下的六维力传感器读数,利用最小二乘法计算出工具重心在六维力传感器中的坐标(x,y,z)以及常数kx,ky,kz;
选取不少于三组机器人工具末端的不同姿态,将公式4)转换成公式6)的矩阵形式,同样利用最小二乘法计算出六维力传感器自身零点(mx,my,mz),(fx,fy,fz);
6.一种基于力传感器的机器人末端接触力补偿系统,其特征在于,所述系统包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述计算机程序被所述处理器执行时实现如权利要求1至5中任一项所述的基于力传感器的机器人末端接触力补偿方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010105965.2A CN111230879B (zh) | 2020-02-20 | 2020-02-20 | 一种基于力传感器的机器人末端接触力补偿方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010105965.2A CN111230879B (zh) | 2020-02-20 | 2020-02-20 | 一种基于力传感器的机器人末端接触力补偿方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111230879A true CN111230879A (zh) | 2020-06-05 |
CN111230879B CN111230879B (zh) | 2023-07-11 |
Family
ID=70868253
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010105965.2A Active CN111230879B (zh) | 2020-02-20 | 2020-02-20 | 一种基于力传感器的机器人末端接触力补偿方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111230879B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112847361A (zh) * | 2021-01-05 | 2021-05-28 | 佛山科学技术学院 | 一种机器人柔性装配控制方法及系统 |
CN113319855A (zh) * | 2021-06-28 | 2021-08-31 | 哈尔滨工业大学 | 一种多关节诊疗机器人柔顺力控制模式下的重力补偿方法 |
CN114310916A (zh) * | 2022-02-25 | 2022-04-12 | 哈尔滨工业大学 | 一种机器人与环境交互时接触力的辨识方法及辨识系统 |
CN115847392A (zh) * | 2021-09-26 | 2023-03-28 | 苏州艾利特机器人有限公司 | 一种力传感器空载读数补偿方法、装置及存储介质 |
Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103279037A (zh) * | 2013-05-24 | 2013-09-04 | 华南理工大学 | 基于六维力/力矩传感器的机器人力跟随运动控制方法 |
CN103454029A (zh) * | 2013-09-03 | 2013-12-18 | 东南大学 | 基于卡尔曼滤波与多次采集的多维力线性解耦方法 |
CN103600354A (zh) * | 2013-11-08 | 2014-02-26 | 北京卫星环境工程研究所 | 航天器机械臂柔性随动控制重力补偿方法 |
CN104913780A (zh) * | 2015-05-21 | 2015-09-16 | 山东科技大学 | 集成gnss和ccd天顶筒的高精度垂线偏差快速测量方法 |
CN105583824A (zh) * | 2016-01-26 | 2016-05-18 | 清华大学 | 力控牵引和摆位的多自由度机械臂控制装置及其控制方法 |
CN106041926A (zh) * | 2016-06-12 | 2016-10-26 | 哈尔滨工程大学 | 一种基于卡尔曼滤波器的工业机械臂力/位置混合控制方法 |
CN106335057A (zh) * | 2016-09-27 | 2017-01-18 | 东南大学 | 一种基于实时力控的装配机器人全空间柔顺插孔控制方法 |
CN108789363A (zh) * | 2018-05-25 | 2018-11-13 | 雅客智慧(北京)科技有限公司 | 一种基于力传感器的直接拖动示教系统及方法 |
CN109505587A (zh) * | 2018-09-29 | 2019-03-22 | 陕西安控科技有限公司 | 一种抽油机曲柄扭矩测量方法及装置 |
CN109822574A (zh) * | 2019-03-20 | 2019-05-31 | 华中科技大学 | 一种工业机器人末端六维力传感器标定的方法 |
CN109848983A (zh) * | 2018-12-10 | 2019-06-07 | 华中科技大学 | 一种高顺应性人引导机器人协同作业的方法 |
CN110666799A (zh) * | 2019-10-15 | 2020-01-10 | 吉林大学 | 一种基于重力补偿的六自由度串联机器人柔顺控制方法 |
US20200030981A1 (en) * | 2018-07-30 | 2020-01-30 | Seiko Epson Corporation | Robot and abnormality detection method of robot |
CN110802585A (zh) * | 2019-11-20 | 2020-02-18 | 山东大学 | 机械臂末端传感器补偿方法及接触力/力矩测量方法 |
-
2020
- 2020-02-20 CN CN202010105965.2A patent/CN111230879B/zh active Active
Patent Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103279037A (zh) * | 2013-05-24 | 2013-09-04 | 华南理工大学 | 基于六维力/力矩传感器的机器人力跟随运动控制方法 |
CN103454029A (zh) * | 2013-09-03 | 2013-12-18 | 东南大学 | 基于卡尔曼滤波与多次采集的多维力线性解耦方法 |
CN103600354A (zh) * | 2013-11-08 | 2014-02-26 | 北京卫星环境工程研究所 | 航天器机械臂柔性随动控制重力补偿方法 |
CN104913780A (zh) * | 2015-05-21 | 2015-09-16 | 山东科技大学 | 集成gnss和ccd天顶筒的高精度垂线偏差快速测量方法 |
CN105583824A (zh) * | 2016-01-26 | 2016-05-18 | 清华大学 | 力控牵引和摆位的多自由度机械臂控制装置及其控制方法 |
CN106041926A (zh) * | 2016-06-12 | 2016-10-26 | 哈尔滨工程大学 | 一种基于卡尔曼滤波器的工业机械臂力/位置混合控制方法 |
CN106335057A (zh) * | 2016-09-27 | 2017-01-18 | 东南大学 | 一种基于实时力控的装配机器人全空间柔顺插孔控制方法 |
CN108789363A (zh) * | 2018-05-25 | 2018-11-13 | 雅客智慧(北京)科技有限公司 | 一种基于力传感器的直接拖动示教系统及方法 |
US20200030981A1 (en) * | 2018-07-30 | 2020-01-30 | Seiko Epson Corporation | Robot and abnormality detection method of robot |
CN109505587A (zh) * | 2018-09-29 | 2019-03-22 | 陕西安控科技有限公司 | 一种抽油机曲柄扭矩测量方法及装置 |
CN109848983A (zh) * | 2018-12-10 | 2019-06-07 | 华中科技大学 | 一种高顺应性人引导机器人协同作业的方法 |
CN109822574A (zh) * | 2019-03-20 | 2019-05-31 | 华中科技大学 | 一种工业机器人末端六维力传感器标定的方法 |
CN110666799A (zh) * | 2019-10-15 | 2020-01-10 | 吉林大学 | 一种基于重力补偿的六自由度串联机器人柔顺控制方法 |
CN110802585A (zh) * | 2019-11-20 | 2020-02-18 | 山东大学 | 机械臂末端传感器补偿方法及接触力/力矩测量方法 |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112847361A (zh) * | 2021-01-05 | 2021-05-28 | 佛山科学技术学院 | 一种机器人柔性装配控制方法及系统 |
CN113319855A (zh) * | 2021-06-28 | 2021-08-31 | 哈尔滨工业大学 | 一种多关节诊疗机器人柔顺力控制模式下的重力补偿方法 |
CN115847392A (zh) * | 2021-09-26 | 2023-03-28 | 苏州艾利特机器人有限公司 | 一种力传感器空载读数补偿方法、装置及存储介质 |
CN115847392B (zh) * | 2021-09-26 | 2023-10-27 | 苏州艾利特机器人有限公司 | 一种力传感器空载读数补偿方法、装置及存储介质 |
CN114310916A (zh) * | 2022-02-25 | 2022-04-12 | 哈尔滨工业大学 | 一种机器人与环境交互时接触力的辨识方法及辨识系统 |
CN114310916B (zh) * | 2022-02-25 | 2024-02-06 | 哈尔滨工业大学 | 一种机器人与环境交互时接触力的辨识方法及辨识系统 |
Also Published As
Publication number | Publication date |
---|---|
CN111230879B (zh) | 2023-07-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111230879B (zh) | 一种基于力传感器的机器人末端接触力补偿方法及系统 | |
CN107433590B (zh) | 一种基于机械臂负载质量和传感器零漂在线辨识的重力补偿方法 | |
CN113510698B (zh) | 一种机械臂控制方法、装置、机械臂和可读存储介质 | |
CN111618857A (zh) | 一种机械臂的多负载自适应重力补偿方法 | |
CN116604601A (zh) | 机器人及控制方法、部件制造方法、控制程序和介质 | |
CN110774314A (zh) | 机器人及机器人的异常检测方法 | |
CN111531533A (zh) | 一种六维力传感器的零点校正及重力补偿方法 | |
CN113021358A (zh) | 机械臂工具坐标系原点标定方法、装置和电子设备 | |
CN112720460A (zh) | 机器人控制方法、装置、计算机可读存储介质及机器人 | |
Ren et al. | Theoretical analysis of a six-axis force/torque sensor with overload protection for polishing robot | |
CN114131611A (zh) | 机器人重力位姿分解的关节误差离线补偿方法、系统及终端 | |
CN113021353A (zh) | 机器人碰撞检测方法 | |
Abdullah et al. | Force/torque data modeling for contact position estimation in peg-in-hole assembling application | |
CN114310916B (zh) | 一种机器人与环境交互时接触力的辨识方法及辨识系统 | |
CN113091670B (zh) | 一种机器人关节刚度的标定装置及标定方法 | |
CN114603554A (zh) | 机器人负载转动惯量的标定方法、装置及存储介质 | |
CN112775974B (zh) | 工业机器人铣削过程中的关节刚度辨识方法 | |
CN115139305A (zh) | 一种六维力传感器偏移补偿方法及系统 | |
CN112013868B (zh) | 一种基于视觉惯导里程计的自适应参数警犬姿态估计方法 | |
CN108956003B (zh) | 一种实时标定六维传感器姿态的方法、装置及终端设备 | |
CN111558954A (zh) | 力传感器组件、测量方法及包括该组件的执行器、机器人 | |
US20240131699A1 (en) | Robot system, learning apparatus, information processing apparatus, learned model, control method, information processing method, method for manufacturing product, and recording medium | |
US20240131702A1 (en) | Robotic arm control method, robotic arm and computer-readable storage medium | |
Kitagaki et al. | Contact state detection by force sensing for assembly tasks | |
CN115847392B (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 |