一种利用球杆仪标定机器人结构参数的方法

1.一种利用球杆仪标定机器人结构参数的方法，其特征在于，该方法包括下列步骤：
(a)将标定杆通过螺纹安装在机器人末端，接着将工具杯与所述标定杆连接，然后固定标定底板的位置并将三个中心座安装在该标定底板的三个顶点DCB上；
(b)标定工具坐标系{tool}，利用该工具坐标系标定用户坐标系{uframe}，然后校准球杆仪并测量由所述三个中心座形成的三角形DCB的三条边长，分别记为l1、l2、l3；
(c)预设A点与所述DCB构成空间四面体，且预设A点到所述DCB的棱长分别为l4i、l5i、l6i，其中i＝1,2…7，所述用户坐标系中C点坐标为uframec＝(0,0,0)，根据所述l1、l2、l3和所述l4i、l5i、l6i确定在所述用户坐标系下A点的坐标
(d)根据所述{tool}、所述{uframe}和所述用户坐标系下A点的坐标编写程序，使得所述机器人末端带动所述工具杯的末端顶点Otool运动到所述C点再到所述A点的，所述机器人末端从初始位置相应地运动到o′6-C再到o6-Ai，在所述机器人的示教器上读取并记录所述Otool到达所述C点和A点时对应的各关节转角，即所述C点和A点的关节坐标qC＝(θ1C,θ2C,θ3C,θ4C,θ5C,θ6C)， 所述o′6-C与o6-Ai分别与所述C点和A点关节
坐标相同，通过含有待求解的机器人结构参数的转化矩阵将该o′6-C与o6-Ai关节坐标转换为基坐标，同时求得向量baseo′6-Co6-Ai＝baseo′6-C-baseo6-Ai；
(e)校准球杆仪测量所述空间四面体的ABCD的实际侧棱长l4i*、l5i*、l6i*，根据该实际棱长和所述l1、l2、l3确定在所述用户坐标系下A点的实际坐标
uframe
然后通过用户坐标与基坐标的转换矩阵将所述用户坐标系下的C点坐标 c＝(0,0,0)和该A点实际坐标转换为基坐标系下的坐标，同时求出向量
(f)根据平行四边形原理，所述向量 由此计算得到待求解的机器
人结构参数。
2.如权利要求1所述的方法，其特征在于，在步骤(b)中，采用机器人内部的四点法工具坐标系标定方法标定工具坐标系。
3.如权利要求1或2所述的方法，其特征在于，在步骤(b)中，采用机器人内部的三点法用户坐标系标定方法标定用户坐标系。
4.如权利要求1或2所述的方法，其特征在于，在步骤(d)中，所述含有待求解的机器人结构参数的转化矩阵T如下，其中，nx、ny、nz、ox、oy、oz、ax、ay、az分别为关节坐标系相对于基坐标坐标系的x、y、z坐标轴夹角的余弦，该夹角在所述机器人的示教器上显示，basepx、basepy、basepz为关节坐标系相对于基坐标坐标系各坐标轴的位置：
5.如权利要求1或2所述的方法，其特征在于，在步骤(e)中，所述用户坐标与基坐标的转换矩阵baseTuframe如下，其中， 分
别为用户坐标系相对于基坐标坐标系的x、y、z坐标轴夹角的余弦， 为
关节坐标系相对于基坐标坐标系各坐标轴的位置，baseTuframe中的参数通过所述示教器中显示的值计算得出，
6.如权利要求1或2所述的方法，其特征在于，在步骤(f)中，采用按照下列表达式，通过最小二乘法使得目标函数Fobject最小化计算机器人结构参数，

暂无