1.一种工业机器人定位精度检测装置,其特征在于:包括位姿测量机构(1)、定位装置和双特征机构(8);
所述的位姿测量机构(1)包括传感器支架(13)和三个激光传感器:X轴激光测距传感器(12)、Y轴激光测距传感器(11)和Z轴激光测距传感器(10);三个激光传感器以两两相互垂直的状态安装在传感器支架(13)上;所述的X轴激光测距传感器(12)、Y轴激光测距传感器(11)和Z轴激光测距传感器(10)发出的射线相交于一点,为位姿测量机构(1)的原点;
所述的定位装置包括安装架(7)、立板(6)、直杆、磁环编码器(2)和连杆机构(4),所述的立板(6)安装于安装架(7)上并能够沿安装架(7)上下滑动,所述的立板(6)垂直于地面,所述的直杆垂直于立板(6)所在平面,直杆的一端与立板(6)固定连接;所述的磁环编码器(2)环绕在直杆上并能沿直杆长度方向滑动;所述立板(6)上安装有第一光栅尺(5),所述磁环编码器(2)上安装有第二光栅尺(3);所述的磁环编码器(2)通过连杆机构(4)与传感器支架(13)相连;
所述的双特征机构(8)包括Y形连接机构、一个球体特征(14)和一个立方体特征(15);Y形连接机构具有两个分支杆和底杆,球体特征(14)、立方体特征(15)分别连接在Y形连接机构的两个分支杆的端部,Y形连接机构的底杆的端部为与工业机器人(9)末端相连的固定端;球体特征(14)的中心点、立方体特征(15)的中心点沿Y形连接机构底杆中轴线对称。
2.根据权利要求1所述的工业机器人定位精度检测装置,其特征在于:所述的安装架(7)为三角支架,在三角支架一侧设有垂直于地面的滑槽,所述的立板(6)嵌于滑槽中并能够沿滑槽上下滑动;所述的第一光栅尺(5)水平安装在立板(6)的下沿。
3.根据权利要求1所述的工业机器人定位精度检测装置,其特征在于:所述的第二光栅尺(3)平行于直杆设置,并与磁环编码器(2)固定,能与磁环编码器(2)一同在直杆上滑动。
4.根据权利要求1所述的工业机器人定位精度检测装置,其特征在于:所述的传感器支架(13)由三个相同的两两相互垂直的正方形板拼接组成;位姿测量机构(1)的原点与X轴激光测距传感器(12)、Y轴激光测距传感器(11)和Z轴激光测距传感器(10)的激光发射点的距离相等。
5.权利要求1-4任一项所述的工业机器人定位精度检测装置的使用方法,其特征在于:包括如下步骤:
步骤一:在工业机器人末端安装双特征机构,安装位姿测量机构和定位装置;
步骤二:建立系统坐标系:建立世界坐标系、工业机器人末端坐标系、双特征机构坐标系、定位装置坐标系和位姿测量机构坐标系;
步骤三:设置测量点:通过调整位姿测量机构和定位装置,使调整位姿测量机构的原点到达一个初始点,将该初始点记为测量点c1,计算测量点c1在世界坐标系中的位置;
步骤四:机器人末端位置计算:通过示教器控制机器人,使工业机器人带动双特征机构运动,使球体特征中心点到达测量点c1;根据位姿测量机构三个激光传感器发出的射线在球体特征表面形成的三个点,计算得到球体特征中心点在位姿测量机构坐标系下的坐标t1,并由位姿测量机构坐标系经定位装置坐标系换算至世界坐标系,得到在世界坐标系下的球体特征中心点的坐标tW1,作为机器人末端位置值;
步骤五:机器人末端姿态计算:通过示教器控制机器人,使工业机器人带动双特征机构作180°旋转运动,使立方体特征的中心点到达位姿测量机构坐标系下的坐标t1, 根据位姿测量机构三个激光传感器发出的射线在立方体特征表面形成的三个点,计算三个点所在的立方体表平面的法向量,并由位姿测量机构坐标系经定位装置坐标系换算至世界坐标系,将计算得到的其中一个平面的法向量作为机器人末端姿态值;
步骤六:通过步骤四、步骤五完成一次机器人末端位置值、机器人末端姿态值的测量及计算后,使工业机器人经过一轮运动,再次使球体特征中心点、立方体特征中心点依次到达测量点c1,再次计算机器人末端位置值、机器人末端姿态值;重复若干次;计算机器人末端位置值偏差值和机器人末端姿态值偏差值。
6.根据权利要求5所述的工业机器人定位精度检测装置的使用方法,其特征在于:世界坐标系是以工业机器人基坐标建立的世界坐标系{OW};工业机器人的末端坐标系是以Y形连接机构底杆与工业机器人末端的连接处中心点为原点建立的工业机器人末端坐标系{OE},工业机器人末端坐标系{OE}的Z轴垂直于机器人末端法兰盘平面;建立工业机器人末端坐标系{OE} 前需对工业机器人标定;双特征机构坐标系包括以球体特征的中心点为原点建立的球体特征坐标系{OT1}和以立方体特征中心点为原点建立的立方体特征坐标系{OT2},其中以工业机器人末端坐标系{OE}三根轴线的方向建立球体特征坐标系{OT1},立方体特征坐标系{OT2}的Z轴与立方体特征所在的分支杆的中轴线方向相同且向下。
7.根据权利要求6所述的工业机器人定位精度检测装置的使用方法,其特征在于:定位装置坐标系包括以安装架(7)底面上一点为原点建立的安装架坐标系{O0}、直杆的中轴线与立板(6)平面相交点为原点建立的直杆坐标系{O1}和连杆机构的中轴线与直杆的中轴线相交点为原点建立的连杆机构坐标系{O2};位姿测量机构坐标系为以X轴激光测距传感器(12)、Y轴激光测距传感器(11)和Z轴激光测距传感器(10)发出的射线相交于一点为原点、以X轴激光测距传感器(12)、Y轴激光测距传感器(11)和Z轴激光测距传感器(10)发出的射线为方向建立的位姿测量机构坐标系{O}。
8.根据权利要求7所述的工业机器人定位精度检测装置的使用方法,其特征在于:步骤三中计算测量点c1在世界坐标系中的位置,为通过磁环编码器(2)、第一光栅尺(5)和第二光栅尺(3)的数据,经直杆坐标系{O1}、连杆机构坐标系{O2}和安装架坐标系{O0}与世界坐标系{OW}的换算得到。
9.根据权利要求6所述的工业机器人定位精度检测装置的使用方法,其特征在于:步骤四中工业机器人带动双特征机构运动使球体特征中心点到达测量点c1的控制为经双特征机构坐标系中球体特征坐标系{OT1}、工业机器人末端坐标系{OE}与世界坐标系{OW}的换算后,通过示教器发布指令;步骤五中工业机器人带动双特征机构作180°旋转运动使立方体特征的中心点到达位姿测量机构坐标系下的坐标t1的控制为经双特征机构坐标系中立方体特征坐标系{OT2}、工业机器人末端坐标系{OE}与世界坐标系{OW}的换算后,通过示教器发布指令。
10.根据权利要求5所述的工业机器人定位精度检测装置的使用方法,其特征在于:通过定位装置的调整,可改变测量点c1的位置,以测定不同初始点的机器人末端位置值偏差值和机器人末端姿态值偏差值。