机器人学DH建模PUMA560机械臂运动学正解Matlab程序

前言

第一次写博客记录学习有关机械臂内容,最近学习林沛群教授的《机器人学》,和看了《机器人学导论》中有关机械臂运动学正解的内容,并通过Matlab程序实现书中的例子,在此记录学习内容和学习过程中遇到的问题。

正文

1.DH参数

DH参数分为分为标准DH参数和改进DH参数两种

坐标系建立步骤:

1,找出各类关节轴,标出(或画出)这些轴线的延长线。在下面的步骤2至步骤5中,仅考虑前后两个相邻的轴线(关节轴i和关节轴z_{i-1}

2,找出关节轴i和关节轴i+1之间的公垂线或关节轴i和关节轴i+1的交点,以关节轴ii+1的交点或公垂线与关节轴i的交点作为连杆坐标系i的原点。

3,规定z_i轴沿着关节轴i的方向

4,规定x_i轴沿着公垂线方向,如果关节轴i和关节轴i+1相交,则规定x_i轴垂直于关节轴i和关节轴i+1所在平面。

5,按照右手定则确定y_i

6,当第一个关节变量为0(i=0)时,规定坐标系{0}和{1}重合。对于坐标系{ N}(最后一个坐标系),其原点和x_N的方向可以任意选取,选取时尽量使连杆参数为0.

(1)标准DH参数(STD-DH)

1,标准DH参数中,x轴方向由当前z轴z_i和前一个坐标系中的z轴z_{i-1}确定(叉乘)。遵循右手定则,即由z_{i-1}指向z_i,大拇指的方向即为x轴方向。或以z_iz_{i-1}的公垂线作为x轴。

2,建模步骤

(1)将x_{i-1}z_{i-1}轴旋转\theta_i,使得x_{i-1}x_{i}共线

(2)将x_{i-1}沿着z_{i-1}轴平移d_i,使得x_{i-1}x_{i}重合

(3)将z_{i-1}x_{i-1}轴旋转\alpha _{i-1},使得z_{i-1}z_i共线

(4)将z_{i-1}沿着x_{i-1}轴方向平移a_{i-1},使得z_{i-1}z_i重合

3,STD-DH四个参数变化顺序:\theta_{i} \rightarrow d_{i}\rightarrow \alpha_{i-1} \rightarrow a_{i-1}

4,每个步骤得到的变化矩阵(齐次矩阵)

Rot(z_{i-1},\theta _i)=\begin{bmatrix} cos(\theta _i) & -sin(\theta _i)&0&0 \\ sin(\theta _i)& cos(\theta _i)&0&0\\0&0&1&0\\0&0&0&1 \end{bmatrix} \quad

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值