平码五不中公式规律
  • / 5
  • 下载费用:30 金币  

一种激光自标定实现零点标定的方法.pdf

关 键 ?#21097;?/dt>
一种 激光 标定 实现 零点 方法
  专利查询网所有资源均是用户自行上传分享,仅供网友学习交流,未经上传用户书面授权,请勿作他用。
摘要
申请专利号:

CN201910085768

申请日:

20190129

公开号:

CN109631762A

公开日:

20190416

当前法律状态:

公开

有效性:

审中

法?#19978;?#24773;: 公开
IPC分类号: G01B11/00 主分类号: G01B11/00
申请人: 合肥中控智科机器人有限公司
发明人: 谢之凤
地址: 230000 安徽省合肥市经济技术开发区青龙潭路西、肥光路东、滨?#26377;?#21306;北出口加工区1栋1216
优先权:
专利代理机构: 代理人:
PDF完整版下载: PDF下载
法律状态
申请(专利)号:

CN201910085768

授权公告号:

法律状态公告日:

20190416

法律状态类型:

公开

摘要

本发明公开了一种激光自标定实现零点标定的方法,所述激光跟踪测长仪为一个单频激光干涉仪安装在有两个互相垂直的旋转自由度的机构中心上的仪器,所述跟踪仪的反射靶为一个内部安装?#31169;?#38181;反射镜的球,角锥的顶点与球心重合,激光跟踪仪可以跟踪在空间运动的靶并测量靶的圆心在跟踪仪旋转中心为原点的极坐标系中的极坐标,即原点到靶的中心的距离和两点连线的两个方向角。本发明使得激光目标点的实际位置恰好位于预期位置上,从而实现激光自标定的零点标定。

权利要求书

1.一种激光自标定实现零点标定的方法,其特征在于:所述激光跟踪测长仪为一个单频激光干涉仪安装在有两个互相垂直的旋转自由度的机构中心上的仪器,所述跟踪仪的反射靶为一个内部安装?#31169;?#38181;反射镜的球,角锥的顶点与球心重合,激光跟踪仪可以跟踪在空间运动的靶并测量靶的圆心在跟踪仪旋转中心为原点的极坐标系中的极坐标,即原点到靶的中心的距离和两点连线的两个方向角。 2.根据权利要求1所述的一种激光自标定实现零点标定的方法,其特征在于:包括以下步骤: a.测量动平台上铰链点的位置。固定并联机床的一根杆,使它既不伸缩也不绕任何轴转动,即固定该杆在动平台上的铰链点在空间的位置。将测?#31185;?#21488;放到动平台前,激光跟踪仪安装到其中一个定位孔上。测量动平台上安放好三个靶镜,并设其中一个为靶镜A。使动平台运动到某一位置静?#20849;?#21160;,用激光跟踪仪在三个定位孔上分别检测到三个靶镜的距离,由得到的数据可以计算出动平台上三个靶镜中点在测量坐标系中的坐标。重复上述过?#28525;?#27425;,选择靶镜A的4个不在同一平面内的坐标。由空间解析几何知,已知4个不共面的点P(x,y,z),i=1,2,3,4,过这4点的球面方程是 X2+Y2+Z2 X Y Z 1=0 X21+Y21+Z21 X1 Y1 Z1 1=0 X22+Y22+Z22 X2 Y2 Z2 1=0 X23+Y23+Z23 X3 Y3 Z3 1=0 X24+Y24+Z24 X4 Y4 Z4 1=0 b.由此方程可以得?#35282;?#24515;坐标。所以将上述四点代入球面方程中,就可计算出固定的杆在动平台上的铰链点在测量坐标系中的坐标。 c.测量静平台上铰链点的位置。现在已知某根杆在动平台上的铰链点的坐标,每一次使该杆杆长不变的测?#31185;?#23454;是测出了以该杆在静平台上的铰链为圆心,以固定杆长为半径的一个球上的点的坐标,所以圆心和半径都可以求出。固定某一根杆的杆长,将该杆的角度变化四次,每次?#21152;?#27979;得的数据计算出该杆在动平台上铰链点的空间坐标,代入球面方程中可以计算出杆在静平台上的铰链点在测量坐标系中的坐标。

说明书


一种激光自标定实现零点标定的方法
技术领域


本发明涉及零点标定技术领域,具体为一种激光自标定实现零点标定的方法。


背景技术


通常激光的重复定位精度很高(可达0.01mm),但绝对定位精度很差(仅几个毫
米)。如果要使用机器壁的离线编程方法或者是进行高精度测量,激光的目标点位置精度将
会是一个非常令人关心的问题。机器人末端执行器的位置一般在其工作空间内描述,但是
这些位置通过驱动关节电动机获得,整个过程在角度空间里进?#23567;?#22240;某些原因(例如:机械
加工的精度、装配误差、磨损、传动误差、负载变化和环境影响等)使得机器人控制器所使用
的运动学模型与真实的运动学模型不一致,从而导致用机器人内部运动学模型来驱动关节
电动机获得末端执行器位置时,得到的激光目标点的实际位置将会偏离预期的位置。


发明内容


本发明的目的在于提供一种激光自标定实现零点标定的方法,以解决上述背景技
术中提出的机器人内部运动学模型来驱动关节电动机获得末端执行器位置时,得到的激光
目标点的实际位置将会偏离预期的位置问题。


为实现上述目的,本发明提供如下技术方案:一种激光自标定实现零点标定的方
法,所述激光跟踪测长仪为一个单频激光干涉仪安装在有两个互相垂直的旋转自由度的机
构中心上的仪器,所述跟踪仪的反射靶为一个内部安装?#31169;?#38181;反射镜的球,角锥的顶点与
球心重合,激光跟踪仪可以跟踪在空间运动的靶并测量靶的圆心在跟踪仪旋转中心为原点
的极坐标系中的极坐标,即原点到靶的中心的距离和两点连线的两个方向角。


优选的,一种激光自标定实现零点标定的方法,包括以下步骤:


a.测量动平台上铰链点的位置。固定并联机床的一根杆,使它既不伸缩,也不绕任
何轴转动,即固定该杆在动平台上的铰链点在空间的位置。将测?#31185;?#21488;放到动平台前,激光
跟踪仪安装到其中一个定位孔上。测量动平台上安放好三个靶镜,并设其中一个为靶镜A。
使动平台运动到某一位置静?#20849;?#21160;,用激光跟踪仪在三个定位孔上分别检测到三个靶镜的
距离,由得到的数据可以计算出动平台上三个靶镜中点在测量坐标系中的坐标。重复上述
过?#28525;?#27425;,选择靶镜A的4个不在同一平面内的坐标。由空间解析几何知,已知4个不共面的
点P(x,y,z),i=1,2,3,4,过这4点的球面方程是


X
2+Y
2+Z
2 X Y Z 1=0


X
2
1+Y
2
1+Z
2
1 X
1 Y
1 Z
1 1=0


X
2
2+Y
2
2+Z
2
2 X
2 Y
2 Z
2 1=0


X
2
3+Y
2
3+Z
2
3 X
3 Y
3 Z
3 1=0


X
2
4+Y
2
4+Z
2
4 X
4 Y
4 Z
4 1=0


b.由此方程可以得?#35282;?#24515;坐标。所以将上述四点代入球面方程中,就可计算出固
定的杆在动平台上的铰链点在测量坐标系中的坐标。


c.测量静平台上铰链点的位置。现在已知某根杆在动平台上的铰链点的坐标,每
一次使该杆杆长不变的测?#31185;?#23454;是测出了以该杆在静平台上的铰链为圆心,以固定杆长为
半径的一个球上的点的坐标,所以圆心和半径都可以求出。固定某一根杆的杆长,将该杆的
角度变化四次,每次?#21152;?#27979;得的数据计算出该杆在动平台上铰链点的空间坐标,代入球面
方程中可以计算出杆在静平台上的铰链点在测量坐标系中的坐标。


与现有技术相比,本发明的有益效果是:


1、通过测量动平台上铰链点的位置,然后由球面方程可以得?#35282;?#24515;坐标,从而测
量静平台上铰链点的位置,由此可以保证机器人内部运动学模型来驱动关节电动机获得末
端执行器位置时,使得激光目标点的实际位置恰好位于预期位置上,从而实现激光自标定
的零点标定。


2、通过用测得的数据计算出动平台在测量坐标系中的位置,而该铰链点在测量坐
标系中的坐标可知,所以在动平台上的位置也就可以计算出来了。依次对每一根杆使用以
上的方法,就可以测量出动平台上各铰链点的实际位置。


具体实施方式


本申请实施例通过提供通过测量动平台上铰链点的位置,然后由球面方程可以得
?#35282;?#24515;坐标,从而测量静平台上铰链点的位置,由此可以保证机器人内部运动学模型来驱
动关节电动机获得末端执行器位置时,使得激光目标点的实际位置恰好位于预期位置上,
从而实现激光自标定的零点标定。


本申请实施例中的技术方案为解决上述串扰的问题,总体思路如下:


通过激光跟踪测长仪是将一个单频激光干涉仪安装在有两个互相垂直的旋转自
由度的机构中心上的仪器,其旋转中心的位置在测量?#21271;?#25345;不变。跟踪仪的反射靶是一个
内部安装?#31169;?#38181;反射镜的球,角锥的顶点与球心重合。用激光跟踪仪可以跟踪在空间运动
的靶并测量靶的圆心在以跟踪仪旋转中心为原点的极坐标系中的极坐标,即原点到靶的中
心的距离和两点连线的两个方向角。


使得激光目标点的实际位置恰好位于预期位置上,从而实现激光自标定的零点标
定,通过用测得的数据计算出动平台在测量坐标系中的位置,而该铰链点在测量坐标系中
的坐标可知,所以在动平台上的位置也就可以计算出来了。依次对每一根杆使用以上的方
法,就可以测量出动平台上各铰链点的实际位置。


下面将结合本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实
施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普
通技术人员在没有做出创造性劳动前提?#28388;?#33719;得的所有其他实施例,?#38469;?#20110;本发明保护的
范围。


实施例一:


一种激光自标定实现零点标定的方法,激光跟踪测长仪为一个单频激光干涉仪安
装在有两个互相垂直的旋转自由度的机构中心上的仪器,跟踪仪的反射靶为一个内部安装
?#31169;?#38181;反射镜的球,角锥的顶点与球心重合,激光跟踪仪可以跟踪在空间运动的靶并测量
靶的圆心在跟踪仪旋转中心为原点的极坐标系中的极坐标,即原点到靶的中心的距离和两
点连线的两个方向角。


实施例二


一种激光自标定实现零点标定的方法,包括以下步骤:


a.测量动平台上铰链点的位置。固定并联机床的一根杆,使它既不伸缩,也不绕任
何轴转动,即固定该杆在动平台上的铰链点在空间的位置。将测?#31185;?#21488;放到动平台前,激光
跟踪仪安装到其中一个定位孔上。测量动平台上安放好三个靶镜,并设其中一个为靶镜A。
使动平台运动到某一位置静?#20849;?#21160;,用激光跟踪仪在三个定位孔上分别检测到三个靶镜的
距离,由得到的数据可以计算出动平台上三个靶镜中点在测量坐标系中的坐标。重复上述
过?#28525;?#27425;,选择靶镜A的4个不在同一平面内的坐标。由空间解析几何知,已知4个不共面的
点P(x,y,z),i=1,2,3,4,过这4点的球面方程是


X
2+Y
2+Z
2 X Y Z 1=0


X
2
1+Y
2
1+Z
2
1 X
1 Y
1 Z
1 1=0


X
2
2+Y
2
2+Z
2
2 X
2 Y
2 Z
2 1=0


X
2
3+Y
2
3+Z
2
3 X
3 Y
3 Z
3 1=0


X
2
4+Y
2
4+Z
2
4 X
4 Y
4 Z
4 1=0


b.由此方程可以得?#35282;?#24515;坐标。所以将上述四点代入球面方程中,就可计算出固
定的杆在动平台上的铰链点在测量坐标系中的坐标。由于可以用测得的数据计算出动平台
在测量坐标系中的位置,而该铰链点在测量坐标系中的坐标可知,所以在动平台上的位置
也就可以计算出来了。依次对每一根杆使用以上的方法,就可以测量出动平台上各铰链点
的实际位置。


c.测量静平台上铰链点的位置。现在已知某根杆在动平台上的铰链点的坐标,每
一次使该杆杆长不变的测?#31185;?#23454;是测出了以该杆在静平台上的铰链为圆心,以固定杆长为
半径的一个球上的点的坐标,所以圆心和半径都可以求出。固定某一根杆的杆长,将该杆的
角度变化四次,每次?#21152;?#27979;得的数据计算出该杆在动平台上铰链点的空间坐标,代入球面
方程中可以计算出杆在静平台上的铰链点在测量坐标系中的坐标。


本实施例中,激光跟踪测长仪是将一个单频激光干涉仪安装在有两个互相垂直的
旋转自由度的机构中心上的仪器,其旋转中心的位置在测量?#21271;?#25345;不变。跟踪仪的反射靶
是一个内部安装?#31169;?#38181;反射镜的球,角锥的顶点与球心重合。用激光跟踪仪可以跟踪在空
间运动的靶并测量靶的圆心在以跟踪仪旋转中心为原点的极坐标系中的极坐标,即原点到
靶的中心的距离和两点连线的两个方向角。因为角度测量的误差比较大,而且测量点距离
原点越远,由极坐标计算的直角坐标误差就越大,所以本文的方法中只使用激光跟踪仪的
测长结果,然后经测量动平台上铰链点的位置,然后由球面方程可以得?#35282;?#24515;坐标,从而测
量静平台上铰链点的位置,由此可以保证机器人内部运动学模型来驱动关节电动机获得末
端执行器位置时,使得激光目标点的实际位置恰好位于预期位置上,从而实现激光自标定
的零点标定。


尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以
理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换
和变型,本发明的范围由所附权利要求及其等同物限定。


关于本文
本文标题:一种激光自标定实现零点标定的方法.pdf
链接地址:http://www.pqiex.tw/p-6151827.html
关于我们 - 网站声明 - 网站地图 - 资源地图 - 友情链接 - 网站客服 - 联系我们

[email protected] 2017-2018 zhuanlichaxun.net网站版权所有
经营许可证编号:粤ICP备17046363号-1 
 


收起
展开
平码五不中公式规律 《股票分析指标大全》 股票指数基金 6月7日股票推荐 股票融资优缺点 如何开通股票融资费用 炒股公司 免费炒股软件 上证指数大盘 2019年9月1日美国股票指数 短线股票推荐电话