Matlab Robotic Toolbox V9.10工具箱(三)：轨迹规划

利用matlab robotics 进行轨迹规划
轨迹规划有两个函数：
（1）、jtraj，已知初始和终止的关节角度，利用五次多项式来规划轨迹。

[q,qd,qdd] = jtraj(q0, qf, m)

（2）、ctraj，已知初始和终止的末端关节位姿，利用匀加速、匀减速运动来规划轨迹。

tc = ctraj(T0, T1, n)

相关代码如下：

clear;
clc;
L1 = Link('d', 0, 'a', 0, 'alpha', pi/2);    %Link 类函数
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);
robot=SerialLink([L1,L2,L3,L4,L5,L6]);   %SerialLink 类函数
robot.name='带球形腕的拟人臂';     %SerialLink 属性值
robot.manuf='飘零过客';     %SerialLink 属性值init_ang=[0 0 0 0 0 0];
targ_ang=[pi/4,-pi/3,pi/5,pi/2,-pi/4,pi/6];
step=40;
[q,qd,qdd] = jtraj(init_ang, targ_ang, step);
subplot(3,2,[1,3]);
robot.plot(q); subplot(3,2,2);
i=1:6;
plot(q(:,i));
title('位置');
grid on;
subplot(3,2,4);
i=1:6;
plot(qd(:,i));
title('速度');
grid on;
subplot(3,2,6);
i=1:6;
plot(qdd(:,i));
title('加速度');
grid on;p1 =[  -0.7071   -0.0000    0.7071    1.4142;0.0000   -1.0000   -0.0000   -0.0000;0.7071    0.0000    0.7071    1.9142;0         0         0    1.0000];p2 =[    0.9640   -0.2639   -0.0332    0.9331;0.0979    0.2361    0.9668    1.9331;-0.2473   -0.9352    0.2534    0.8618;0         0         0    1.0000];Tc=ctraj(p1,p2,step);
Tjtraj=transl(Tc);
subplot(3,2,5);
plot2(Tjtraj,'r');
title('p1到p2直线轨迹');
grid on;

仿真的结果如图所示：

左上图为机器人模型，
左下图为 ctraj 轨迹规划的末端关节轨迹
有边三个图分别是 jtraj 轨迹规划的各关节的角度，角速度，角加速度

Matlab Robotic Toolbox V9.10工具箱(三)：轨迹规划相关推荐

Matlab Robotic Toolbox V9.10工具箱(六)：puma560 动力学建模与仿真
puma560,是经典的机器人模型,很多教材上都用它作为例子. 其D-H矩阵为: j theta d a alpha offset 1 q1 0 0 1.571 0 2 q2 0 0.4318 0 0 ...
Matlab Robotic Toolbox V9.10工具箱(五)：动力学简介
机器人动力学是机器人学中最核心的部分,也是机器人力控制的基础. matlab Robotics Toolbook 工具箱中有具体的动力学计算函数: 正动力学: 已知各关节上电机提供的力,求对应的各关节 ...
Matlab Robotic Toolbox V9.10工具箱(四)：常用函数
机器人工具箱 V9.10 有很多函数,对于一般的简单进行建模.仿真常用的函数如下: 建立机器人: LinkSerialLink. nameSerialLink. plotSerialLink.disp ...
Matlab Robotic Toolbox V9.10工具箱(二)：正/逆运动学
matlab机器人工具箱 robotic toolbox 做运动学分析非常方便,SerialLink 类中有现成的函数:SerialLink.fkine(theta),可以直接对已经建立的机器人模型做 ...
Matlab Robotic Toolbox V9.10工具箱(七)：Stanford arm 动力学建模与仿真
Stanford arm,斯坦福机械臂,也是经典的机器人模型,很多教材上都用它作为例子. 1.动力学建模其 DHDH矩阵为: j theta d a alpha offset 1 q1 0.412 ...
MATLAB Robotic Toolbox 机器人工具箱示例
程序是基于Matlab2016a,工具箱版本为Robotic Toolbox 10.2 参考博客: MATLAB机器人工具箱使用 Matlab Robotic Toolbox V9.10工具箱(三): ...
s matlab toolbox,Matlab Robotic Toolbox工具箱学习笔记（一）
Matlab Robotic Toolbox工具箱学习笔记(一) 软件:matlab2013a 工具箱:Matlab Robotic Toolbox v9.8 Matlab Robotic Toolb ...
matlab toolbox 介绍,Matlab Robotic Toolbox使用简介（1）
软件:matlab2014a 工具箱:Matlab Robotic Toolbox v9.8 这里感谢枫箫提供的机器人工具箱:http://blog.sina.com.cn/u/2707887295 ...
基于Matlab Robotics Toolbox的Dobot机械臂运动规划（4）
[基于Matlab Robotics Toolbox的Dobot机械臂运动规划]系列文章是我在学习robotics toolbox中所做工作的记录,方便自己后面复习.改进软件环境 : Matlab ...

Matlab Robotic Toolbox V9.10工具箱(三)：轨迹规划

Matlab Robotic Toolbox V9.10工具箱(三)：轨迹规划相关推荐

最新文章

热门文章