matlab机器人画圆轨迹规划

在这里插入图片描述

function Untitled()clear;clc;
L(1)=Link([0 0.15055 0 pi/2]);
L(2)=Link([0 -0.115 0.246 0]);
L(3)=Link([0 0.1163 0.190 0]);
L(4)=Link([0 -0.1175 0 pi/2]);
L(5)=Link([0 0.1175 0 -pi/2]);
L(6)=Link([0 0.105 0 0]);ZU3=SerialLink(L,'name','JAKA ZU3');     %确定画图平面
p0=[0,0,0];
p1=[0.4,0.4,0.4];
p2=[-0.5,0.5,0.5];
X=p1-p0;B=p2-p0;
Z=cross(X,B);
Y=cross(Z,X);
x1=X/norm(X);
y1=Y/norm(Y);
z1=Z/norm(Z);
R=[x1.',y1.',z1.'];
Js=[R ,p0.'];
Js=[Js;0 0 0 1];
r=norm(p1-p0);  %圆的轨迹
t=0:0.05:5;
[s,sd,~] = tpoly(0,2*pi,t);
q1=[-12.7,98.9,-107,158,-114,11];
k = q1;
vs =[]; % qs  关节速度
pd=[];%ps  笛卡尔坐标系下的坐标位置
for i = 1:length(s)T=[1 0 0 r*cos(s(i));0 1 0 r*sin(s(i));0 0 1 0;0 0 0 1];T1=Js*T;       q=ZU3.ikunc(T1,k); %求解逆运动k=q;pd=[pd;T1(1:3,4).'];vs=[vs;q];
end
close all;
figure('NumberTitle', 'off', 'Name', '运动图像');
plot2(pd,'r','LineWidth',2);%圆的线宽
hold on;
ZU3.plot(vs,'fps',20);%输出运动图像
%绘制运动曲线
figure('NumberTitle', 'off', 'Name', '关节值随时间变化曲线');subplot(4,1,1);%图像布局plot(t,pd);  %输出空间位置曲线title('空间位置曲线')xlabel('秒(s)');ylabel('路程(m)')subplot(4,1,2);   plot(t,vs);%输出关节角度曲线title('关节角度曲线')  xlabel('秒(s)');  ylabel('角度(rad)');legend('θ1','θ2','θ3','θ4','θ5','θ6');%计算空间速度并输出空间速度曲线vx = -r*sin(s).*sd;vy = r*cos(s).*sd;vv = r*sd;subplot(4,1,3);   plot(t,[vx,vy,vv]);title('空间速度曲线')xlabel('秒(s)');   ylabel('速度(m/s)')%计算关节速度omiga=[];for i =1:length(s)J0=ZU3.jacob0(vs(i,:)');dq=J0\[vx(i);vy(i);0;0;0;0];omiga=[omiga;dq'];endsubplot(4,1,4);  plot(t,rad2deg(omiga));title('关节速度曲线')%输出关节速度曲线xlabel('秒(s)');  ylabel('角速度(rad/s)')

matlab机器人画圆轨迹规划相关推荐

MATLAB机器人工具箱3-及轨迹规划
轨迹规划机器人轨迹规划分为关节空间轨迹规划和笛卡尔空间轨迹规划关节空间轨迹规划关节空间轨迹规划是以关节角的函数来描述轨迹(在时间和空间)的轨迹生成方法. clc; clear;%%轨迹规划的第一 ...
四足机器人足端轨迹规划--摆线
古月居课程四足机器人控制与仿真入门笔记,视频链接:link 四足机器人足端轨迹规划--摆线摆线定义模型表示 matlab程序摆线定义摆线,又称旋轮线.圆滚线,在数学中,摆线(Cycloid)被 ...
[论文]欠驱动水下机器人的平面轨迹规划与跟踪控制设计
[论文]欠驱动水下机器人的平面轨迹规划与跟踪控制设计摘要研究了欠驱动自主水下航行器在水平面上的轨迹规划与跟踪控制的组合问题.给定光滑的.惯性的二维参考轨迹,规划算法利用车辆动力学计算参考方向和机体 ...
Scara机器人关节空间轨迹规划-机器人工具箱函数jtraj
1.前记:记录下scara机器人建模和轨迹规划.由于有移动关节的存在,稍微和六轴的有区别. clc clear L1=Link([0 0 0 0 0],'modified'); L2=Link([0 ...
scara机器人动荷载_SCARA机器人结构设计及轨迹规划算法.pdf
第31卷第7期合肥工业大学学报(自然科学版) V01．31No．7 HEFEI TECHNoIoGY 2008年7月 JOURNAL0F I小rn咂RSrrY0F Jul．2008 SCARA机器人 ...
机器人论文（2）-双足机器人楼梯行走轨迹规划
目录摘要机器人行走稳定性指标: 类人机器人稳定行走的轨迹规划方法: 机器人行走性能研究:如能效.步速机器人推向运动: 对于机器人楼梯行走问题描述: 建模及控制器 1.样机 2.控制部分轨迹规划 ...
机器人-关节空间轨迹规划
机器人工作时,已知机器人各关节的初始位置便可以根据机器人的正运动方程求解出机器人末端的末端位姿.知道到机器人末端执行器的初始位姿和末端位姿就可以规划出机器人从初始位姿到达期望位姿的轨迹. 本节将介绍关 ...
机器人关节空间轨迹规划--S型速度规划
关节空间 VS 操作空间关节空间与操作空间轨迹规划流程图如下(上标$i$和$f$分别代表起始位置initial和目标位置final): 在关节空间内进行轨迹规划有如下优点: 在线运算量更小,即无需进 ...
ABB机器人画圆编程_ABB工业机器人(条件执行数字信号判断，画方or画圆)
一.前戏条件:从安全点,到工具区域夹取工具(笔),到工作区域,判断数字信号 Di1 =1 ,Ture :画方,False:画圆,回到工具区域放下工具(笔),回到安全点二. 准备工作校准tcp工具 ...
matlab怎么画园与椭圆,[转载]【MATLAB】画圆和椭圆
%圆和椭圆都是0到360°极角乘上极径来控制的图形 %当x,y方向极径相同时画出的就是圆 %当x,y方向极径不同时画出的就是椭圆 %圆心(x0,y0);半径(a,b); %旋转可以有两种方式: %1. ...

matlab机器人画圆轨迹规划

matlab机器人画圆轨迹规划相关推荐

最新文章

热门文章