1.一种全自动顺序多站式测量系统,其特征是:包括工业机器人(1)、主动式靶球(2)、激光跟踪仪(3)、AGV车(4)、固定靶球(5)以及磁性基座(6),所述的主动式靶球(2)安装在工业机器人(1)的末端,所述的激光跟踪仪(3)能够测量主动式靶球(2)的空间坐标,激光跟踪仪(3)固定在AGV车(4)的升降板上,通过AGV车(4)的移动调节激光跟踪仪(3)的空间位置,所述的固定靶球(5)通过磁性基座(6)固定在激光跟踪仪(3)可测空间内的某一固定位置。
2.一种使用如权1所述的一种全自动顺序多站式测量系统的测量方法,其特征是:包括以下几个步骤:
步骤1:将工业机器人(1)恢复至初始零位状态,所述初始零位状态是指工业机器人(1)的各个关节角度均为0°,并通过工具坐标系标定方法获得主动式靶球(2)在工业机器人(1)的默认工具坐标系下的坐标表示;
步骤2:控制AGV车(4)搭载激光跟踪仪(3)运动到第一个基站位置,该基站位置记为A(x1,y1,z1),并测量固定靶球(5)的空间坐标为Q(xq1,yq1,zq1);
步骤3:控制工业机器人(1)的末端到达制定的自标定测量点Pj(j=1,…,N=100),该点在工业机器人(1)基坐标系内的坐标为Pj=(xRi,yRi,zRi),其中R表示工业机器人(1)基坐标系,自标定测量点沿圆的径向均匀分布,并用激光跟踪仪(3)测量自标定测量点在该基站位置A上的激光跟踪仪(3)测量坐标系内的测量点坐标为PAj=(xMAj,yMAj,zMAj)(j=1,…,N=i00),其中M表示激光跟踪仪(3)测量坐标系,A表示第一个基站位置;
步骤4:控制工业机器人(1)恢复至初始零位状态,然后分别依次单独旋转工业机器人(1)关节1至关节N,利用激光跟踪仪(3)测量各个关节的旋转轨迹上的测量点,每个关节的各个测量点为在固定角度范围内均匀分布的点,各个测量点在该基站位置上的激光跟踪仪(3)测量坐标系内的测量点坐标为PACi=(xMACij,yMACij,zMACij),其中i表示第i个关节,i=
1,…,N,A表示第一个基站位置,Ci表示关节i的测量点;
步骤5:控制工业机器人(1)恢复至初始零位状态,然后控制AGV车(4)搭载激光跟踪仪(3)运动到第二个基站位置,该基站位置记为B(x2,y2,z2),并测量固定靶球(5)的空间坐标为Q(xq2,yq2,zq2),然后重复步骤3和步骤4,所述的工业机器人(1)基坐标系内的自标定测量点Pj在第二个基站位置B与第一个基站位置A上为相同点,所述的工业机器人(1)各个关节的旋转轨迹上的测量点在第二个基站位置B与第一个基站位置A上为相同点;
步骤6:控制工业机器人(1)恢复至初始零位状态,然后控制AGV车(4)搭载激光跟踪仪(3)运动到第三个基站位置,该基站位置记为C(x3,y3,z3),并测量固定靶球(5)的空间坐标为Q(xq3,yq3,zq3),然后重复步骤3和步骤4,所述的工业机器人(1)基坐标系内的自标定测量点Pj在第三个基站位置C与第一个基站位置A和第二个基站位置B上均为相同点,所述的工业机器人(1)各个关节的旋转轨迹上的测量点在第三个基站位置C与第一个基站位置A和第二个基站位置B上均为相同点;
步骤7:控制工业机器人(1)恢复至初始零位状态,然后控制AGV车(4)搭载激光跟踪仪(3)运动到第四个基站位置,该基站位置记为D(x4,y4,z4),并测量固定靶球(5)的空间坐标为Q(xq4,yq4,zq4),然后重复步骤3和步骤4,所述的工业机器人(1)基坐标系内的自标定测量点Pj在第四个基站位置D与第一个基站位置A、第二个基站位置B和第三个基站位置C上均为相同点,所述的工业机器人(1)各个关节的旋转轨迹上的测量点在第四个基站位置D与第一个基站位置A、第二个基站位置B和第三个基站位置C上均为相同点;
步骤8:以第一个基站位置A为基准,该位置作为直三棱锥形的一个顶点,根据直角三棱锥形的体积及几何约束,计算其他三个顶点B,C,D的空间位置,在运动过程中,激光跟踪仪(3)始终测量固定靶球(5)的空间位置,将B,C,D与A的空间相对位置转换为固定靶球(5)在激光跟踪仪(3)测量坐标系内的空间相对位置,从而实现高精度的基站位置调整;
步骤9:首先根据工业机器人(1)基坐标系内的自标定测量点Pj的坐标与激光跟踪仪(3)测量坐标系的坐标,实现基坐标系与测量坐标系的转换,获取测量坐标系的原点在基坐标系内位置,分别实现在四个基站位置A,B,C,D上的坐标系转换;
步骤10:根据工业机器人(1)基坐标系内的自标定测量点Pj在四个基站位置A,B,C,D的极坐标中的距离值,记为Li1、Li2、Lt3、Li4,满足以下方程,根据方程构建优化目标函数J,
以工业机器人(1)控制器内的测量点读取值以及步骤9中获得测量坐标系在基坐标系的位置作为优化目标函数J的初值,该优化算法可采用常规的LM算法或遗传算法,从而得到四个基站位置A,B,C,D在工业机器人(1)基坐标系内的精确坐标值;
步骤11:根据步骤10获取的四个基站位置A,B,C,D的精确坐标值与激光跟踪仪(3)测量各个关节的旋转轨迹上的测量点距离激光跟踪仪(3)的距离,根据方程,可得各个关节的旋转轨迹上的测量点的精确坐标值。
3.如权2所述的使用全自动顺序多站式测量系统的测量方法,其特征是:所述的主动式靶球(2)能够保证激光跟踪仪(3)在任意位置都能够测量自标定测量点Pj以及工业机器人(1)各个关节的旋转轨迹上的测量点。