转载自这里
机器人学工具箱(Robotics Toolbook for Matlab) 是matlab中专门用于机器人仿真的工具箱,在机器人建模、轨迹规划、控制、可视化方面使用非常方便。
创建机器人的两个最重要的函数是:Link和Seriallink
Link 对象包括连杆的各种属性:运动学参数、惯性张量、电机、传递矩阵等
Link 的类函数:
A :关节传动矩阵
RP :关节类型
friction : 摩擦力
nofriction : 摩擦为0
dyn : 显示动力学参数
islimit:检测关节变量是否超出范围
isrevolute : 检测关节是否为转动关节
isprismatic : 检测关节是否为移动关节
display : 显示D-H矩阵
char : 转化为字符串
Link 的类属性(读/写):
theta:D-H参数
d:D-H参数
a:D-H参数
alpha:D-H参数
sigma: 默认0,旋转关节;1,移动关节
mdh: 默认0,标准D-H;1,改进D-H
offset:关节变量偏移量
qlim:关节变量范围
m: 质量
r: 质心
I: 惯性张量
B: 粘性摩擦
Tc: 静摩擦
G: 减速比
Jm: 转子惯量
例如:定义连杆
L =link('d',1.2,'a', 0.3,'alpha',pi/2,'offset',pi/2,‘mdh’,1,'qlim',[-pi,pi],'m',0.5,'r',[0 0 0.05],'I',[0.001 0 0; 0 0.001 0; 0 0 0.05]); b1=isrevolute(L); %判读L是否为旋转连杆 b2= L.d; %读取L连杆的长度
Seriallink 的类函数:
类函数比较多,包括显示机器人、动力学、逆动力学、雅可比等,用的最多的是:SerialLink 和 plot,用来显示机器人
R=SerialLink(links, options); R.plot(theta);
Seriallink 的类属性(读/写):
links :连杆向量
gravity :重力加速度
base :基座标系
tool:与基座标系的变换矩阵
qlim :关节极限位置
offset :关节偏移量
name :机器人的名字
manuf :制造者的名字
comment: 注释
Seriallink 的类属性(读):
n :关节数
config: 关节配置,如‘RRRRRR’
mdh :D-H矩阵类型
theta :D-H参数
d :D-H参数
a :D-H参数
alpha: D-H参数
首先用Link建立连杆,再用SerialLink建立机器人,最后用plot显示机器人。
clear; clc; L1 = Link('d', 0, 'a', 0, 'alpha', pi/2); L2 = Link('d', 0, 'a', 0.5, 'alpha', 0,'offset',pi/2); L3 = Link('d', 0, 'a', 0, 'alpha', pi/2,'offset',pi/4); L4 = Link('d', 1, 'a', 0, 'alpha', -pi/2); L5 = Link('d', 0, 'a', 0, 'alpha', pi/2); L6 = Link('d', 1, 'a', 0, 'alpha', 0); b=isrevolute(L1); %Link 类函数 robot=SerialLink([L1,L2,L3,L4,L5,L6]); %SerialLink 类函数 robot.name='带球形腕的拟人臂'; robot.comment='飘零过客'; robot.display(); %Link 类函数 theta=[0 0 0 0 0 0]; robot.plot(theta); %SerialLink 类函数
在 Matlab 的命令行窗口中显示 display 的
robot = 带球形腕的拟人臂 (6 axis, RRRRRR, stdDH, fastRNE) 飘零过客; +---+-----------+-----------+-----------+-----------+-----------+ | j | theta | d | a | alpha | offset | +---+-----------+-----------+-----------+-----------+-----------+ | 1| q1| 0| 0| 1.571| 0| | 2| q2| 0| 0.5| 0| 1.571| | 3| q3| 0| 0| 1.571| 0.7854| | 4| q4| 1| 0| -1.571| 0| | 5| q5| 0| 0| 1.571| 0| | 6| q6| 1| 0| 0| 0| +---+-----------+-----------+-----------+-----------+-----------+ grav = 0 base = 1 0 0 0 tool = 1 0 0 0 0 0 1 0 0 0 1 0 0 9.81 0 0 1 0 0 0 1 0 0 0 0 1 0 0 0 1
plot 的图形为:
display 显示的结果中,除了D-H参数外,还有三个矩阵,grav,base,tool (在10.2版本中未出现)
grav,重力加速度矢量
base,基座标的齐次矩阵,正常情况下,竖直方向Z轴(看重力加速度矢量),如上图所示。但有些机器人的基座标系竖直方向不是Z轴(如下图,两连杆机械臂),基座标矩阵就是机械臂的基座标系与plot图的默认坐标系之间的变换关系。如果不改变base坐标,那么就要改变grav矢量的值了。
tool,指工具坐标系和末端连杆的坐标系之间的变换矩阵。一般情况下是重合的。
[1] Peter Corke,Robotics Toolbox for MATLAB Release 9(Version,9.10),2015.02
[2] P.I. Corke, Robotics, Vision & Control: Fundamental Algorithms in MATLAB.Springer, 2011.