1.一种基于Scara机器人的非固定式手眼关系标定方法,其特征在于:Scara机器人有三个关节,四个自由度,第一关节和第二关节都是旋转关节,第三个关节即能够旋转又能够移动,三个关节的轴线是相互平行的;Scara机器人的第二个关节上安装有相机,相机能够随着第二个关节的运动而运动,此标定方法具体包括如下步骤:步骤1:假设相机的坐标系为C,Scara机器人的基坐标系为O,Scara机器人的机械手臂T
末端的坐标系为T,则相机相对于机械手臂末端之间的关系Gc为:T o ‑1o
Gc=(GT) Gc (1);
o o o
其中,GT和Gc分别是机械手臂末端和相机相对于Scara机器人基坐标系的变换,GT能o T
够从Scara机器人的控制器中直接读出,那么只需要求出Gc即能够确定Gc;
步骤2:根据指数积模型知:o o
Gc=e1e2Gc(0) (2);
其中:
3×1 3×1
其中,ωi∈R 是Scara机器人第i关节的轴线方向矢量,ri∈R 是Scara机器人第i关节轴上的任意一点,称之为旋量参数,变量θi,i=1,2,是关节角度,能够实时从Scara机器o 4×4
人的控制器中获取;Gc(0)∈R 是相机与Scara机器人在初始位置时的坐标变换关系;
o
步骤3:求取Gc(0);具体包括如下步骤:步骤3.1:利用Scara机器人的末端工具去接触平台面上的目标点,即能够得到这些目n×3
标点在Scara机器人基坐标系下的值,记为Xo∈R ,n>=4为目标点的个数;
步骤3.2:控制机械手臂带动相机运动,使目标点进入到相机视野中,对目标点进行拍n×3
照,此时目标点在相机坐标系下的值,记为Xc0∈R ,同时,这一拍照位置被记为Scara机器o
人的初始位置;然后利用先求旋转矩阵后求平移向量的传统两步法获得Gc(0),即得到初始位置时相机与Scara机器人之间的关系;
步骤4:求取旋量参数ωi,ri,i=1,2;具体包括如下步骤:步骤4.1:从Scara机器人的初始位置开始,转动Scara机器人的第二个关节θ2角度,控制n×3
目标点不超出相机的视野范围,然后获得目标点在转动后的相机坐标系下的值Xc2∈R ,根据Xc0与Xc2的关系,利用两步法,得到ω2,r2的封闭解;
步骤4.2:步骤4.1的基础上,紧接着再转动Scara机器人第一个关节θ1角度,控制目标点n×3
不超出相机的视野范围,并获得转动后目标点在相机坐标系下的值Xc1∈R ,然后根据Xc1与Xc2的关系,利用两步法,得到ω1,r1的封闭解;
o
根据公式(2),步骤3求取的Gc(0)以及步骤4求取的旋量参数ωi,ri,i=1,2,即能够实时确定相机与Scara机器人之间的关系。