使用五次多项式插值jtraj进行关节空间轨迹规划的matlab仿真

‍需要机械臂相关资源的同学可以在评论区中留言哦指南目录机械臂速成小指南零点五机械臂相关资源机械臂速成小指南零指南主要内容及分析方法机械臂速成小指南一机械臂发展概况机械臂速成小指南二机械臂的应用机械臂速成小指南三机械臂的机械结构机械臂速成小指南四机械臂关键部件之减速机机械臂速成小指南五末端执行器机械臂速成小指南六步进电机驱动器机械臂速成小指南七机械臂位姿的描述方法机械臂速成小指南八运动学建模标准DH法机械臂速成小指南九正运动学分析机械臂速成小指南十可达工作空间机械臂速成小指南十一坐标系的标准命名机械臂速成小指南十二逆运动学分析机械臂速成小指南十三轨迹规划概述机械臂速成小指南十四多项式插值轨迹规划机械臂速成小指南十五线性规划机械臂速成小指南十六带抛物线过渡的线性规划机械臂速成小指南十七直线规划机械臂速成小指南十八圆弧规划机械臂速成小指南十九机械臂的电路板抓取实验机械臂速成小指南二十机械臂的位姿重复性实验以下为正文去官网下载后在此安装机器人工具箱第一步我们使用下列语句实现五次多项式插值使用前需安装The Robotics Toolbox for MATLAB可直接在官网下载M50; [q, qd, qdd]jtraj(q_0,q_final,M); #没有指定机械臂起点速度以及终点速度默认为0 #若需要指定起点速度以及终点速度上式改为[q, qd, qdd]jtraj(q_0,q_final,M,v_0,v_final); #v_0与v_final分别为起点速度以及终点速度 #q_0,q_final,M分别为起始点、终点以及插值的步数设机械臂的自由度为N6所插多项式曲线表示关节空间轨迹q关节坐标从q_0 (1xN)到q_final (1xN)的变化。该五次多项式被用于默认速度和加速度为零的边界条件即在起点和终点处机械臂的速度与加速度均为0。式中qqd与qdd均为M×N的数组每个时间步长一行每个关节一列。以本文为例工作区中三者显示为第二步使用下方语句得到末端执行器的位姿Trobot2.fkine(q);其中T的类型为SE3无法直接在空间中描绘使用下方语句转换nTT.T;nt可看作50个插值点的齐次变换矩阵第三步使用下方语句在空间中描点plot3(squeeze(nT(1,4,:)),squeeze(nT(2,4,:)),squeeze(nT(3,4,:)));其中squeeze()的作用是删除长度为 1 的维度如第一个squeeze(nT(1,4,:))的作用是将nT(1,4,:)从1×1×50的数组变为1×50的数组。最终可以得到机械臂在空间中的运动轨迹如下图所示最后使用简单的plot函数得到机械臂位置、速度与加速度的图像图中显示的是关节1在空间中的角度、角速度以及角加速度