欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2019100448167
申请人: 南京邮电大学
专利类型:发明专利
专利状态:未下证
专利领域: 计算;推算;计数
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种基于S-R-S结构的康复机械臂的单目视觉手眼标定方法,其特征在于,所述方法包括步骤:S1、建立指定大小自由度康复机械臂的运动学模型,其中,所述康复机械臂中相邻关节的旋转轴之间均相互垂直且相交于一点;

S2、在所述康复机械臂的末端固定连接一标靶,并固定一相机在所述康复机械臂附近;

S3、以设定的姿态和位置摆放所述标靶,采用所述相机获取不同姿态和位置摆放所述标靶的照片,并利用解PNP的方法获取所述相机坐标系在所述康复机械臂转动后与所述标b靶坐标系的转换矩阵 Tc;

S4、旋转所述康复机械臂末端单个关节并利用对应关节转动的圆弧轨迹拟合出所述圆弧轨迹的圆心,基于对应所述关节的旋转轴经过所述圆心获得所述旋转轴在所述相机坐标系中的坐标表示,并获取所述康复机械臂末端坐标系与所述相机坐标系之间的转换矩阵nTc;

S5、基于所述转换矩阵nTc求得所述康复机械臂末端坐标系与所述标靶的转换矩阵bTn,并转动所述康复机械臂的基座端的单个关节基于步骤S3中原理获取所述康复机械臂基座坐标系与所述相机坐标系之间的转换矩阵0Tc;

S6、基于所述转换矩阵nTc与所述转换矩阵0Tc获取得到所述康复机械臂末端与所述康复机械臂基座之间的转换矩阵nT0,得到所述康复机械臂末端相对所述康复机械臂基座的位姿,完成所述康复机械臂的手眼标定。

2.如权利要求1所述的基于S-R-S结构的康复机械臂的单目视觉手眼标定方法,其特征在于,步骤S1中,所述运动学模型采用D-H模型构建,并选定所述康复机械臂基座坐标系{F0}作为世界坐标系{ω}。

3.如权利要求2所述的基于S-R-S结构的康复机械臂的单目视觉手眼标定方法,其特征在于,所述步骤S3包括:S31、采用张正友标定法获取所述相机坐标系的内参矩阵M1;

S32、对所述照片进行角点检测,并从检测得到的所有角点中选取四个端点p1、p2、p3、p4,计算p1、p2、p3、p4四个端点在所述照片中的像素坐标Pi(ui,vi);

S33、基于所述标靶的物理长度获得p1、p2、p3、p4四个端点在所述标靶坐标系中的做坐标,并根据所述内参矩阵M1利用解PNP方法分别获得p1、p2、p3、p4四个端点在所述相机坐标系中的坐标Pc(xc,yc,zc)。

4.如权利要求3所述的基于S-R-S结构的康复机械臂的单目视觉手眼标定方法,其特征在于,所述步骤S4包括:S41、转动所述康复机械臂与末端相邻关节,保持其他关节不动,并实时记录p1、p2端点在所述相机坐标系中的坐标,利用所述坐标生成对应的圆弧形轨迹同时拟合出该轨迹的圆心坐标Op1、圆心坐标Op2,与末端相邻的所述关节的旋转轴经过所述圆心坐标Op1、圆心坐标Op2,基于所述圆心坐标Op1和圆心坐标Op2求得与末端相邻所述关节在所述相机坐标系中的坐标表示,即所述康复机械臂末端相邻关节连杆坐标系的Y轴;

S42:将所述康复机械臂与末端相邻关节回到初始位置保持不动,转动所述康复机械臂的末端关节,基于步骤S41原理获得所述末端关节及其相邻关节连杆坐标系的Z轴;

S43、基于所述Y轴和所述Z轴获得所述康复机械臂末端相邻关节的原点O,并根据右手定则获取所述末端关节相邻关节的X轴在所述相机坐标系中的坐标表示;

S44、基于所述X轴和Y轴及Z轴求得所述末端相邻关节与所述相机坐标系的转换矩阵n-

1Tc;

S45、基于所述末端关节坐标原点On在所述康复机械臂末端相邻关节连杆坐标系Z轴的正上方,利用平移矩阵可以得到所述末端连杆坐标系与所述相机坐标系中的转换矩阵nTc,并求得所述标靶坐标系与所述康复机械臂末端坐标系的转换矩阵bTn。

5.如权利要求4所述的基于S-R-S结构的康复机械臂的单目视觉手眼标定方法,其特征在于,所述方法还包括获取所述康复机械臂基座坐标系{F0}作为世界坐标系{ω}与所述相机坐标系的转换矩阵wTc和和转换矩阵0Tc,且wTc=0Tc,所述求解原理与所述步骤S4中所述转换矩阵bTn的求解原理原理相同。

6.如权利要求5所述的基于S-R-S结构的康复机械臂的单目视觉手眼标定方法,其特征b在于,所述相机与所述康复机械臂的相对位置保持不变,对应的,所述转换矩阵 Tn与转换矩阵wTc保持不变。

7.如权利要求6所述的基于S-R-S结构的康复机械臂的单目视觉手眼标定方法,其特征在于,所述步骤S6还包括:b w

S61、基于所述转换矩阵Tn与转换矩阵 Tc求得所述康复机械臂末端坐标系与所述康复机械臂基座坐标系{F0}之间的转换矩阵wTn;

S62、从所述转换矩阵wTn中取出旋转矩阵R,并利用旋转矩阵R与欧拉角的关系求得所述康复机械臂末端相对所述康复机械臂基座的姿态角,从而求得机械臂末端位姿。