一种基于力传感器的机器人末端接触力补偿方法及系统与流程

文档序号:20989749发布日期:2020-06-05 21:34阅读:来源:国知局

技术特征:

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

取每个轴上最大值fxmax、fymax、fzmax和最小值fxmin、fymin、fzmin,通过以下公式计算得出fx、fy、fz、fx、fy、fz:

fx=fxmax-fxafx=fxmin-fxa

fy=fymax-fyafy=fymin-fya

fz=fzmax-fza,fz=fzmin-fza

根据至少三组计算结果得到平均值

通过公式s=|g1-g2|计算精度偏差,其中,

若精度偏差s在设定阈值以内,则判定六维力传感器精度满足工艺需求。

4.根据权利要求3所述的一种基于力传感器的机器人末端接触力补偿方法,其特征在于,所述步骤s200包括:

通过以下公式计算在六维力传感器中的力/力矩与工具重心:

mx'=fz'*y-fy'*z

my'=fx'*z-fz'*x

mz'=fy'*x-fx'*y1)

其中,fx’、fy’、fz’是工具重力在六维力传感器中的三维力分量,mx’、my’、mz’是三维力所引起的三维力矩;

当机器人工具末端不受外力时,通过以下公式计算工具重力以及传感器零点:

fx=fx'+fx

fy=fy'+fy

fz=fz'+fz

mx=mx'+mx

my=my'+my

mz=mz'+mz2)

其中,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+kz3)

其中:

kx=mx+fy*z-fz*y

ky=my+fz*x-fx*z

kz=mz+fx*y-fy*x4)

将公式3)转换成矩阵形式:

记录不少于三个机器人末端不同姿态下的六维力传感器读数,利用最小二乘法计算出工具重心在六维力传感器中的坐标(x,y,z)以及常数kx,ky,kz;

选取不少于三组机器人工具末端的不同姿态,将公式4)转换成公式6)的矩阵形式,同样利用最小二乘法计算出六维力传感器自身零点(mx,my,mz),(fx,fy,fz);

根据公式2)和公式5)求得工具重力:

5.根据权利要求4所述的一种基于力传感器的机器人末端接触力补偿方法,其特征在于,所述步骤s300包括:

当六维力传感器与工具水平安装时,工具坐标系到六维力传感器坐标系的线性变换矩阵为;其中为旋转矩阵,为工具坐标系在传感器坐标系中的位置表达,l为工具重心到传感器坐标系原点的距离;

末端接触力在传感器坐标系[fs,ms]和工具坐标系中[ft,mt]通过公式7)表示:

机器人的工具末端接触力通过公式求得。

6.一种基于力传感器的机器人末端接触力补偿系统,其特征在于,所述系统包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述计算机程序被所述处理器执行时实现如权利要求1至5中任一项所述的基于力传感器的机器人末端接触力补偿方法的步骤。


技术总结
本发明涉及机器人控制技术领域,具体涉及一种基于力传感器的机器人末端接触力补偿方法及系统,所述方法为:首先计算六维力传感器的精度,判断六维力传感器的精度是否满足工艺需求;计算六维力传感器各轴力耦合度,判断六维力传感器各轴力耦合度是否满足工艺需求;当六维力传感器的精度和各轴力耦合度满足工艺需求时,获取不少于三组机器人工具末端在不同姿态下的六维力传感器读数,利用最小二乘法计算出工具重力和传感器零点;当六维力传感器与外界环境接触时,计算工具末端接触力;最后,将传感器零点、工具重力以及工具末端接触力作为六维力传感器的补偿量,本发明能够提高保障机器人操作的准确度。

技术研发人员:余显俊;李先祥;黄键
受保护的技术使用者:佛山科学技术学院
技术研发日:2020.02.20
技术公布日:2020.06.05
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1