puma560笔记

% 轨迹规划中,首先建立机器人模型,6R机器人模型,名称modified puma560。
% 定义机器人 a--连杆长度,d--连杆偏移量
%数据源于课本第93页
a2=431;a3=20;d2=149;d4=433;
%			 a(i-1)    ai      di            angle(i)
L1 = Link([0      0              0           pi/2], 'modified');
L2 = Link([0      -pi/2          d2          0], 'modified');
L3 = Link([a2     0              0          -pi/2], 'modified');
L4 = Link([a3     -pi/2          d4          0], 'modified');
L5 = Link([0      pi/2  	     0           0], 'modified');
L6 = Link([0       -pi/2         0           0], 'modified');
robot = SerialLink([L1,L2,L3,L4,L5,L6]);
robot.name = 'puma560';
robot.display();
robot.teach();

    
% 机器人运动学正解,解出机器人在给定关节角度下的末端执行器的位姿
q = [pi/2, 0, -pi/2, 0, 0, 0];
t = robot.fkine(q);
disp(t)
% 机器人运动学逆解:解出机器人在给定关位姿的关节角
% 期望的末端位置 t
R = robot.ikine(t)        %求出末端姿态矩阵的逆运动学解
disp(R)

T= robot.fkine(R)       %验证求出的解是否正确
% 打印机器人关节变量
disp(T)

不排除写的有错误的可能,留个笔记,日后有心情了再看

个人笔记,转载前请留下个评论,让我知道

  • 0
    点赞
  • 2
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值