%建立KR10_R1100_sixx机器人
%thetadaalphaoffset
L1=Link([00.40.025pi/20]);
L2=Link([pi/200.5600]);
L3=Link([000.035pi/20]);
L4=Link([00.5150pi/20]);
L5=Link([pi00pi/20]);
L6=Link([00.08000]);
KR10_R1100_sixx=SerialLink([L1 L2 L3 L4 L5 L6],'name','KR10 R1100 sixx');
KR10_R1100_sixx.plot([0,pi/2,0,0,pi,0]);
%3D图形仿真
T1=trotx(180,'deg')*transl(0.5,0,0);
T2=trotx(180,'deg')*transl(0,0.5,0);
q1=KR10_R1100_sixx.ikine(T1);
q2=KR10_R1100_sixx.ikine(T2);
%五次多项式轨迹
[q ,qd, qdd]=jtraj(q1,q2,50);
KR10_R1100_sixx.plot(q);
grid on
% KR10_R1100_sixx.teach
% KR10_R1100_sixx.fkine([pi/4,pi/2,pi/8,pi/2,7*pi/6,pi/2])
%显示末端执行器轨迹
hold on
T=KR10_R1100_sixx.fkine(q);
plot3(squeeze(T(1,4,:)),squeeze(T(2,4,:)),squeeze(T(3,4,:)))
hold on
KR10_R1100_sixx.plot(q)
figure;
%显示每个关节的 角度位移,角速度,角加速度 曲线
hold on;
t=[0:0.01:4];
subplot(3,1,1);
plot(q);
xlabel( 'Time(s)');
ylabel( '角度位移(rad)');
grid on;
subplot(3,1,2);
plot(qd);
xlabel('Time(s)');
ylabel('角速度(rad/s)');
grid on;
subplot(3,1,3);
plot(qdd);
xlabel('Time(s)');
ylabel('角加速度(rad/s^2)');
grid on;
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('加速度');
【Matlab|Matlab——KUKA机器人】grid on;
文章图片
文章图片
示教: KR10_R1100_sixx.teach
文章图片
推荐阅读
- 最优化问题|改进交叉算子的自适应人工蜂群黏菌算法
- matlab|嵌入均衡池的黏菌优化算法
- 最优化问题|加入领导者的黏菌优化算法
- MATLAB图形界面|基于Matlab的汽车出入库计时计费系统
- Matlab旅程|MATLAB的结构化程序设计
- matlab 内存管理 清理内存
- matlab中使用colormap没有效果