01_机器人坐标系的说明

 

机器人的坐标系分为关节坐标系和直角坐标系(笛卡尔坐标系)。坐标系是为了确定机器人的位置和姿态而在机器人或空间上定义的位置指标系统。

 

1.    机器人关节坐标系

机器人的关节坐标系用来描叙机器人每个独立关节的运动,对于六轴串联型机械臂,关节类型均为转动关节。在关节坐标系下,将机器人末端移动到期望位置,可以依次驱动各关节运动,从而让机器人末端到达指定位置。

我们会规定机器人在关节坐标系下的零点位置,一般情况下,六轴机械臂的零点位置如下图所示,我们也叫这个位置为“门位置”。

 

                                        

                                                                           图 1

针对机器人的关节坐标系,我们还需要规定各个关节的转动方向,如下图所示,我们依次描叙了各个关节的正负方向。在关节坐标系下,机器人各个关节的转动方向,必须和下图相符。

 

                                  

                                                                      图 2

 

2.    机器人直角坐标系

目前所说的直角坐标系是机器人的工具坐标系,如下图所示,因为该机器人没有安装执行末端,所以,工具坐标系原点在第六轴末端法兰中心处,红色箭头是X轴,蓝色箭头是Z轴,根据右手定则确定Y轴方向。

 

                                       

                                                                      图3

 

基坐标系所在的位置是定义机器人基座的位置,如上图所示,坐标系原点在第一关节的中心处,红色箭头所示为X轴,蓝色箭头所示为Z轴,根据右手定则,即可确定Y轴的方向。具体如上图旁边那个坐标系所示。

当我们说六轴机械臂位姿时,说的是六轴机械臂末端的位姿,该位姿包括六个参数,分别为X YZ A B C。六轴机械臂末端的位姿是以基坐标系作为参考坐标系的。

X:笛卡尔坐标系的X轴,X轴距离

Y:笛卡尔坐标系的Y轴,Y轴距离

Z:笛卡尔坐标系的Z轴,Z轴距离

A:X-Y-Z固定角坐标系下的偏转角

B:X-Y-Z固定角坐标系下的俯仰角

C:X-Y-Z固定角坐标系下的回转角

 

                                

                                                                                   图 4

 

如上图所示,A对应第一个坐标系中的γ,B对应第二个坐标系中的β,C对应第三个坐标系中的α。

 

为什么我们需要花费专门的一节来讲解六轴机器人的坐标系和关节?因为我们后续要学习的FK和IK就是以这个为基础的。

FK是已知六轴机械臂在关节坐标系下各个关节转动的角度,然后求解直角坐标系下的XYZABC

IK是已知六轴机械臂在直角坐标系下的XYZABC,然后求解关节坐标系下各个关节转动的角度。

 

 

 

需要交流六轴机械臂算法

更多halcon和六轴机械臂算法干货公众号:

 

微信:

 

假设我们有一个三轴机器人,其末端执行器的位置和姿态可以用6个自由度描述,即[x, y, z, α, β, γ]。三轴机器人的三个关节分别为q1、q2、q3,其中q1和q3为旋转关节,q2为直线关节。 首先,我们需要求解机器人的正运动学,即机器人末端执行器的位置和姿态与关节变量之间的关系。假设机器人的正运动学表达式为: x = f(q1, q2, q3) 其中,x为末端执行器的状态变量,f为正运动学方程。 然后,我们可以计算机器人的旋量矩阵和平移矩阵,进而计算出机器人物体雅可比矩阵。具体地,计算机器人物体雅可比矩阵的步骤如下: 1. 计算末端执行器位置的偏导数 根据机器人正运动学方程,可以求出末端执行器位置向量P对关节变量qi的偏导数,即dP/dqi。假设机器人末端执行器位置向量为: P = [x, y, z]^T 则有: dP/dq1 = [dx/dq1, dy/dq1, dz/dq1]^T dP/dq2 = [dx/dq2, dy/dq2, dz/dq2]^T dP/dq3 = [dx/dq3, dy/dq3, dz/dq3]^T 2. 计算末端执行器姿态的偏导数 根据机器人正运动学方程,可以求出末端执行器姿态的旋转矩阵R对关节变量qi的偏导数,即dR/dqi。假设机器人末端执行器的欧拉角为[α, β, γ],则可以通过欧拉角转换矩阵求出末端执行器的旋转矩阵R。 假设欧拉角转换矩阵为: T(α, β, γ) 则末端执行器的旋转矩阵为: R = T(α, β, γ) 然后,可以求出旋转矩阵R对关节变量qi的偏导数,即dR/dqi。 3. 计算机器人物体雅可比矩阵 根据物体坐标系旋量法,机器人物体雅可比矩阵的表达式为: J = [Jv, Jω] 其中,Jv为机器人位置雅可比矩阵,Jω为机器人姿态雅可比矩阵。 机器人位置雅可比矩阵的表达式为: Jv = [dP/dq1, dP/dq2, dP/dq3] 机器人姿态雅可比矩阵的表达式为: Jω = [dR/dq1, dR/dq2, dR/dq3] * R^-1 最终,可以得到机器人物体雅可比矩阵J,其维度为6x3。 需要注意的是,在实际计算中,需要考虑欧拉角的奇异性问题,以及对旋转矩阵求逆矩阵的计算精度问题。
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值