标准DH模型正运动学求解程序编写

依据Peter Croke所建立的机器人工具箱模型。
标准DH模型，其第j个关节，第j个连杆与第j个坐标系建立关系如下所示。即j坐标系是建立在关节j+1处。

改进DH模型，其第j个关节，第j个连杆与第j个坐标系建立关系如下所示。即j坐标系是建立在关节j处。

如下机器人运动学正解程序是建立在标准DH模型下；
根据Peter Croke所著的《Robotic, Vision and Control—Fundamental Algorithms in MATLAB》我们可以得到从连杆坐标系{j-1}到坐标系{j}的变换公式如下；

由矩阵平移和旋转变换可展开得：

由此，对于六自由度机器人的第六关节坐标系相对于基坐标系得变换矩阵可以写为：
T6-0=T1-0* T2-1* T3-2* T4-3* T5-4* T6-5
T6-1代表第六关节坐标系相对基坐标系得转换矩阵。
首先，写出机器人标准DH参数：

SDH=[theta1   0.000   -0.05      pi/2;theta2   0.000   0.425    0.000;theta3   0.050   0.000    -pi/2;theta4   0.425   0.000    pi/2;theta5   0.000   0.000    -pi/2;theta6   0.000   0.000    0.000];

进而写出变换矩阵：

T01=[cos(SDH(1,1))  -sin(SDH(1,1))*cos(SDH(1,4))   sin(SDH(1,1))*sin(SDH(1,4))    SDH(1,3)*cos(SDH(1,1));sin(SDH(1,1))   cos(SDH(1,1))*cos(SDH(1,4))  -cos(SDH(1,1))*sin(SDH(1,4))    SDH(1,3)*sin(SDH(1,1));0               sin(SDH(1,4))                 cos(SDH(1,4))                  SDH(1,2);0               0                             0                              1];

依照上面，依次写出T12、T23、T32、T45、T56;
最后：
T06=T01T12T23T34T45*T56；完成机器人标准DH模型运动学正解得求解。

标准DH模型正运动学求解程序编写相关推荐

aubo-i5机械臂（1）-正运动学求解
目录 1.DH表建立 2.Matlab实现正运动学求解 1.DH表建立注:使用改进DH表建立的根据公式求出相邻连杆的变换矩阵 2.Matlab实现正运动学求解 function [H, H_i] ...
【现代机器人学——螺旋理论】UR5机器人正运动学求解
系列文章目录 [现代机器人学--螺旋理论]UR5机器人正运动学求解 [现代机器人学--螺旋理论]UR5机器人逆运动学求解提示:本文介绍基于螺旋理论分析的UR5机器人正运动学求解思路,仅供参考. 文章 ...
工业六轴机器人常见的STD(标准)-DH模型建立方法
文章目录一.D-H模型二.形式1 三.形式2 四.形式3 五.形式4 一.D-H模型二.形式1 利用MATLAB机器人工具箱Matlab-Robotics-Toolbox建立标准Link函数,其 ...
c++运动学正反解 ros_ROS系统MoveIt玩转双臂机器人系列（六）–D-H逆运动学求解程序（C++）...
注:本篇博文全部源码下载地址为:Git Repo. 一.转换矩阵经过上一篇博客介绍,我们已经获得了Rob一个手臂的D-H参数表,如上表所示,我们要把这些参数转换成相邻坐标系的转换矩阵,D和H两位老前 ...
UR机械臂正逆运动学求解
最近有个任务:求解UR机械臂正逆运动学,在网上参考了一下大家的求解办法,众说纷纭,其中有些朋友求解过程非常常规,但是最后求解的8组解,只有4组可用.在这里我介绍一个可以求解8组解析解的方法,供大家参考 ...
6轴机械臂（拟人臂+球形腕（三轴相交于一点））正逆运动学求解
1.DH坐标下机械臂参数 theta=[pi/10,pi/2,pi/4,-pi/4,pi/4,-pi/8];%关节角度 a=[0, 0.260, 0.025, 0, 0, 0];%连杆长度 d=[0, ...
中正平和的机器人学笔记——1. 机械臂正运动学（附MATLAB代码）
中正平和的机器人学笔记--1.正运动学 0. 何为运动学?何为正运动学? 运动学主要研究的就是机械臂的运动特性(位置.速度.加速度等),但是不考虑使机械臂产生运动时施加的力和力矩(这部分是动力学).而 ...
机械臂正运动学（1）——MDH下的正解（自编）
%% 该函数执行 MDH参数下正运动学求解功能 function [result] = myfkine_MDH(q,a,alpha,d,offset) % q为输入的关节转角,a为杆件长度,alpha ...
修正逆解文章——六轴UR机械臂正逆运动学求解_MATLAB代码（标准DH参数表）
如下参考链接1的作者大大实现了UR5机械臂的正运动学和逆运动学的Matlab代码.但逆解部分在不同版本的Matlab中运行有错误. 本篇文章是MatlabR2016a下完成的,并说明一下原代码错误的原 ...

标准DH模型正运动学求解程序编写

标准DH模型正运动学求解程序编写相关推荐

最新文章

热门文章