一种关节臂式坐标测量机的自标定系统的制作方法
【技术领域】
[0001] 本实用新型设及一种关节臂式坐标测量机的自标定系统，属于自标定领域。
【背景技术】
[0002] 关节臂式坐标测量机是一种多自由度坐标测量设备，现在多用在工业现场测量、 产品逆向设计等领域。关节臂式坐标测量机采用类似关节机器人的空间开链式结构，该种 结构使关节臂式坐标测量机具有体积小、测量范围大、灵活轻便的特点，但该种结构形式存 在误差累积放大的缺点，各级关节的结构参数误差会被逐级放大，从而造成测量机的精度 降低。
[0003] 运动学标定是消除关节臂式坐标测量机结构参数误差的有效方法，但由于结构形 式的巨大差异，传统的正交坐标测量机的标定方法无法直接应用于关节臂式坐标测量机 上，而机器人领域的标定方法一般都要借助激光跟踪仪、激光干设仪等昂贵的精密测量仪 器，且标定操作步骤繁琐、标定时间长，因此也应用成本很高。目前研究较多的基于单点的 标定方法，由于关节臂式坐标测量机的运动空间受限，部分关节运动不充分，因此采集到的 数据相似度较高，在结构参数解算时容易陷入局部极小解，得到的结构参数精度较低，从而 无法有效提高关节臂式坐标测量机的精度。
【发明内容】
[0004] 本实用新型提供了一种关节臂式坐标测量机的自标定系统，通过增大标定操作时 各关节的运动空间，使采集到的数据广泛而无死角，从而提高结构参数解算的鲁椿性和精 度，并提高关节臂式坐标测量机的精度。
[0005] 本实用新型的技术方案是；一种关节臂式坐标测量机的自标定系统，包括自标定 装置、关节臂式坐标测量机12、计算机15、自标定装置电缆16、关节臂式坐标测量机电缆 17,所述计算机15含有数据采集卡；其中自标定装置通过自标定装置电缆16与计算机15 连接通讯，关节臂式坐标测量机12通过关节臂式坐标测量机电缆17与计算机15连接通 讯；通过计算机15控制数据采集卡采集自标定装置的有效长度和关节臂式坐标测量机12 的转角；所述自标定装置的有效长度为基准球3球屯、和钢球测头11球屯、的距离。
[0006] 所述自标定装置包括磁性锥座1、固定平台2、基准球3、支撑轨4、连接杆5、滑动轨 6、保护壳7、光栅尺8、光栅读数头9、磁性锥孔杆10、钢球测头11、保护壳固定螺栓13、读数 头安装螺栓14 ;其中磁性锥座1通过螺栓安装在固定平台2上，基准球3依靠磁力与磁性 锥座1连接，基准球3与导向副的支撑轨4通过连接杆5连接在一起，导向副由支撑轨4、 滑动轨6和保护壳7组成，支撑轨4上安装有光栅尺8,滑动轨6上通过读数头安装螺栓14 安装有光栅读数头9,保护壳7通过保护壳固定螺栓13安装在支撑轨4上用W保护光栅尺 8和光栅读数头9,由光栅读数头9将当前自标定装置的有效长度读取出来，用于结构参数 辨识计算，磁性锥孔杆10的一端通过螺纹与滑动轨6连接，磁性锥孔杆10的另一端的锥孔 与钢球测头11通过磁力连接，钢球测头11安装在关节臂式坐标测量机12上。
[0007] 所述基准球3为钢质基准球。
[000引本实用新型的工作原理是；将关节臂式坐标测量机的钢球测头11与自标定装置 的磁性锥孔杆10通过磁力连接，钢球测头11与基准球3之间的距离通过安装在自标定装 置内部的光栅尺8读取，根据采集到的钢球测头11与基准球3之间的距离和关节臂式坐标 测量机12的关节转角数据，通过运动学方程得到W测量机结构参数为未知量的方程式，按 照关节转角变换顺序可W得到一系列方程式，联立所得到的方程式即可得到结构参数辨识 方程组，求解结构参数辨识方程组即可得到测量机的结构参数、实现测量机的标定。
[0009] 具体步骤如下：
[0010] Stepl、上电，打开自标定装置和关节臂式坐标测量机12 ;
[0011] Step2、将自标定装置与关节臂式坐标测量机12回零，并将钢球测头11与磁性锥 孔杆10吸合，则实现自标定装置与关节臂式坐标测量机12连接在一起；
[0012] Step3、将关节臂式坐标测量机12移动至初始位姿且满足初始化计数变量i = 0 ;
[0013] Step4、判断是否完成了标定数据采集操作：
[0014] 若尚未完成则转至步骤Steps ;若已完成标定数据采集操作则转至步骤Steps ;
[0015] St巧5、计数变量自增1 ;i = i+1 ;
[0016] Step6、通过数据采集卡采集第i组自标定装置的有效长度li和关节臂式坐标测 量机12的转角数据；
[0017] Step7、变换关节臂式坐标测量机12的位姿，变换的原则为；按照关节顺序的大小 依次变换每个关节的转角；其中所有关节变换次数之和为n且每个关节变换的次数为5次 W上（包括5次）；每变换一次之后就返回到步骤Step4进行判断；
[0018] St巧8、完成标定数据采集后，令n = i ;
[0019] Step9、利用采集到的数据和关节臂式坐标测量机的运动学方程列出n个方程，每 个方程的形式为：
[0020]
【主权项】
1. 一种关节臂式坐标测量机的自标定系统，其特征在于：包括自标定装置、关节臂式 坐标测量机（12)、计算机（15)、自标定装置电缆（16)、关节臂式坐标测量机电缆（17)，所述 计算机（15)含有数据采集卡；其中自标定装置通过自标定装置电缆（16)与计算机（15)连 接通讯，关节臂式坐标测量机（12)通过关节臂式坐标测量机电缆（17)与计算机（15)连接 通讯；通过计算机（15)控制数据采集卡采集自标定装置的有效长度和关节臂式坐标测量 机的转角；所述自标定装置的有效长度为基准球做球屯、和钢球测头（11)球屯、的距 离。
2. 根据权利要求1所述的关节臂式坐标测量机的自标定系统，其特征在于：所述自标 定装置包括磁性锥座（1)、固定平台（2)、基准球（3)、支撑轨（4)、连接杆巧）、滑动轨化）、 保护壳（7)、光栅尺巧）、光栅读数头巧）、磁性锥孔杆（10)、钢球测头（11)、保护壳固定螺 栓（13)、读数头安装螺栓（14);其中磁性锥座（1)通过螺栓安装在固定平台（2)上，基准球 (3)依靠磁力与磁性锥座（1)连接，基准球（3)与导向副的支撑轨（4)通过连接杆（5)连接 在一起，导向副由支撑轨（4)、滑动轨（6)和保护壳（7)组成，支撑轨（4)上安装有光栅尺 巧），滑动轨（6)上通过读数头安装螺栓（14)安装有光栅读数头巧），保护壳（7)通过保护 壳固定螺栓（13)安装在支撑轨（4)上用W保护光栅尺（8)和光栅读数头巧），由光栅读数 头（9)将当前自标定装置的有效长度读取出来，用于结构参数辨识计算，磁性锥孔杆（10) 的一端通过螺纹与滑动轨（6)连接，磁性锥孔杆（10)的另一端的锥孔与钢球测头（11)通 过磁力连接，钢球测头（11)安装在关节臂式坐标测量机（12)上。
3. 根据权利要求2所述的关节臂式坐标测量机的自标定系统，其特征在于：所述基准 球（3)为钢质基准球。
【专利摘要】本实用新型涉及一种关节臂式坐标测量机的自标定系统，属于自标定领域。本实用新型包括自标定装置、关节臂式坐标测量机、计算机、自标定装置电缆、关节臂式坐标测量机电缆，所述计算机含有数据采集卡；其中自标定装置通过自标定装置电缆与计算机连接通讯，关节臂式坐标测量机通过关节臂式坐标测量机电缆与计算机连接通讯；通过计算机控制数据采集卡采集自标定装置的有效长度和关节臂式坐标测量机的转角；所述自标定装置的有效长度为基准球球心和钢球测头球心的距离。本实用新型为结构参数解算提供了鲁棒性更强的数据支持；提高了结构参数解算的可靠性和精度；标定操作更加灵活轻便。
【IPC分类】G01B21-00
【公开号】CN204286388
【申请号】CN201420712471
【发明人】高贯斌, 张怀山, 那靖, 刘畅, 郭瑜
【申请人】昆明理工大学
【公开日】2015年4月22日
【申请日】2014年11月24日