【机器人工具箱Robotics Toolbox开发笔记(八)】 机器人正运动学分析

​1. 正运动学理论基础

机器人运动学描述:在机器人的每个关节上D-H参数中的四个参数分别代表关节连杆不同的特征或在进行不同的变换。

本节主要介绍如何采用机器人工具箱Robotics Toolbox对机器人运动学进行分析:

2. 实例

(1)矩阵变换 机器人工具箱用矩阵A表示T,用函数L.A()求出所创建的连杆对象的连杆变换矩阵。

输入matlab命令:

复制代码
L=Link([0,2, 3,pi/4,0])L.A(O)

运行结果:

因此这个变换矩阵为:

对于给定机器人的连杆,坐标系{i}相对应坐标系的变换是只有一个变量的函数,即旋转关节的关节角qi或移动关节的连杆偏距di。

当上面创建的连杆对象关节角时qi=30,可用L.A()求出相应的变换矩阵。

输入matlab命令:

复制代码
L.A(pi/6)

运行结果为:

求出的相应变换矩阵为

以上推导为前推法,当使用后推法的时候(即从第i-1个关节到第i个关节的变换,与上述变换顺序正好相反),需要采用改进型D-H参数描述法。

在创建连杆对象时,使用改进型D-H描述法需指定参数为modified。

输入matlab命令:

复制代码
L=Link([0,2,3, pi/4, 0],'modified')

运行结果:

modDH表示使用了改进后D-H参数描述法

输入matlab命令:

复制代码
L.A(0)

运行结果:

所以这个变换矩阵为:

通过将每一个连杆的变换矩阵连乘能够得到坐标{N}相对于坐标{0}的变换矩阵,即:

这个变换矩阵是N个关节变量的函数。

回顾前述正运动学的概念:给定一组关节角,计算出工具坐标系相对于基坐标系的位姿。在这里,可以通过各个关节位置传感器得到所需要的值,然后求出每个连杆的变换矩阵,通过上式就可求出机器人末端的工具坐标系相对于基坐标系的位姿,表示为:

上面的等式中的,即三行三列的子矩阵代表从基座到末端执行器的旋转矩阵,其中每列从左到右分别代表末端执行器描述基座中的x轴、y轴和z轴方向上的单位矢量,即可表示末端执行器基于基座坐标系的方向姿态。而p三行一列从上往下分别代表末端执行器相对于基座坐标系的位置。

(2)正运动学计算 MATLAB机器人工具箱中采用函数fkine()计算正运动学问题。以三连杆平面机器人为例,用标准型D-H参数描述法计算。

输入matlab命令:

复制代码
L(1)=Link([0,0,1,0])L(2)=Link([0,0,0.8,0])L(3)=Link([0,0,0.6,0])T=three_link.fkine([0 0 0])

运行结果:

因此,初始状态的变换矩阵为:

通过输入matlab命令

复制代码
three_link.plot([0 0 0])

可以将创建的机器人用图形化显示出来,运行结果如图1所示。

图1 使用标准型D-H参数法创建的机器人

当第二个关节旋转30º,第三个关节旋转45º时;

输入matlab命令:

复制代码
T=three_link.fkine([0 pi/6 pi/4])

运行结果:

输入matlab命令:

复制代码
three_link.plot([0  pi/6  pi/4])

运行结果如图2所示。

图2 经过旋转变换的机器人

相关推荐
SweetCode3 分钟前
裴蜀定理:整数解的奥秘
数据结构·python·线性代数·算法·机器学习
ゞ 正在缓冲99%…16 分钟前
leetcode76.最小覆盖子串
java·算法·leetcode·字符串·双指针·滑动窗口
xuanjiong17 分钟前
纯个人整理,蓝桥杯使用的算法模板day2(0-1背包问题),手打个人理解注释,超全面,且均已验证成功(附带详细手写“模拟流程图”,全网首个
算法·蓝桥杯·动态规划
go_bai27 分钟前
Linux环境基础开发工具——(2)vim
linux·开发语言·经验分享·笔记·vim·学习方法
吴梓穆36 分钟前
UE5学习笔记 FPS游戏制作35 使用.csv配置文件
笔记·学习·ue5
惊鸿.Jh36 分钟前
【滑动窗口】3254. 长度为 K 的子数组的能量值 I
数据结构·算法·leetcode
明灯L37 分钟前
《函数基础与内存机制深度剖析:从 return 语句到各类经典编程题详解》
经验分享·python·算法·链表·经典例题
100分题库小程序42 分钟前
2025年机动车授权签字人考试判断题分享
经验分享·笔记
碳基学AI43 分钟前
哈尔滨工业大学DeepSeek公开课:探索大模型原理、技术与应用从GPT到DeepSeek|附视频与讲义免费下载方法
大数据·人工智能·python·gpt·算法·语言模型·集成学习
补三补四1 小时前
机器学习-聚类分析算法
人工智能·深度学习·算法·机器学习