matlab机器人画圆

最近在学习机器人学导论,老师发来一个.m文件,构建了一个机器人,然后让这个机器人末端画圆。然而我遇到了很多问题。
先上代码

%定义连杆
%        theta  d  a  alpha
L1 = Link([0   138 0   -pi/2]);
L2 = Link([0    0 135   0]);
L3 = Link([0    0 147   0]);
%定义关节角范围
L1.qlim = [deg2rad(-90) deg2rad(90)];
L2.qlim = [deg2rad(0) deg2rad(85)];
L3.qlim = [deg2rad(-90) deg2rad(10)];
%连接连杆
dobot = SerialLink([L1 L2 L3],'name','Dobot');

%定义圆
N = (0:0.5:100)'; 
center = [175 0 5];
radius = 50;
theta = ( N/N(end) )*2*pi;
points = (center + radius*[cos(theta) sin(theta) zeros(size(theta))])';  
plot3(points(1,:),points(2,:),points(3,:),'r');

%pionts矩阵是“横着”的,取其转置矩阵,进一步得到其齐次变换矩阵
T = transl(points');

%当反解的机器人对象的自由度少于6时,要用mask vector进行忽略某个关节自由度%
q = dobot.ikine(T,'mask',[1 1 1 0 0 0]);
hold on;
dobot.plot(q,'tilesize',300)

问题一、 文件名有问题,导致.m文件无法执行
如图所示
文件名为 dobot+robot.m 其中有‘+’,无法正确执行启动的代码
解决办法
重命名为dobot_robot.m
也可以选中所有代码,右键,执行所选内容

问题二、程序执行时报错

错误使用 SerialLink/fkine (line 85)
q must have 3 columns

出错 SerialLink/jacob0 (line 61)
	Tn = fkine(robot, q);	% end-effector transformation

出错 SerialLink/ikine (line 153)
    J0 = jacob0(robot, q);

出错 dobot_robot (line 25)
q = dobot.ikine(T,'mask',[1 1 1 0 0 0]);

错误出现在这一行q = dobot.ikine(T,‘mask’,[1 1 1 0 0 0]);
ikine函数用于逆运动学求解,使用help指令查看帮助,找到ikine的用法
Q = R.ikine(T, Q0, M, OPTIONS)
其中T表示位姿,Q0表示初始状态,M是指几轴运动
本例中T已经计算好了,是一个圆;
Q0初始为0,这里应该为[0 0 0];
dobot为3轴机器人,这里M为[1 1 1 0 0 0];
解决办法
修改这一行为q = dobot.ikine(T,[0 0 0],[1 1 1 0 0 0]);
修改后运行程序,正常运行,弹出画面,但是不完整,明显缺少上面一块
在这里插入图片描述
可能因为先画的圆,导致坐标系不完整,这里在画圆后加一行机器人的显示
dobot.plot([0 0 0]);
在这里插入图片描述
机器人果然动起来了
附上最后代码

%定义连杆
%        theta  d  a  alpha
L1 = Link([0   138 0   -pi/2]);
L2 = Link([0    0 135   0]);
L3 = Link([0    0 147   0]);
%定义关节角范围
L1.qlim = [deg2rad(-90) deg2rad(90)];
L2.qlim = [deg2rad(0) deg2rad(85)];
L3.qlim = [deg2rad(-90) deg2rad(10)];
%连接连杆
dobot = SerialLink([L1 L2 L3],'name','Dobot');

%定义圆
N = (0:0.5:100)'; 
center = [175 0 5];
radius = 50;
theta = ( N/N(end) )*2*pi;
points = (center + radius*[cos(theta) sin(theta) zeros(size(theta))])';  
plot3(points(1,:),points(2,:),points(3,:),'r');

dobot.plot([0 0 0]);%显示机器人初始状态

%pionts矩阵是“横着”的,取其转置矩阵,进一步得到其齐次变换矩阵
T = transl(points');

%当反解的机器人对象的自由度少于6时,要用mask vector进行忽略某个关节自由度%
q = dobot.ikine(T,[0 0 0],[1 1 1 0 0 0]);
hold on;
dobot.plot(q,'tilesize',300)

matlab版本2017a
Robotics Toolbox 版本 9.10.0

说的有点啰嗦,以上是我解决这次问题的步骤,记录下来,希望能帮助到有相同问题的人。

  • 25
    点赞
  • 112
    收藏
    觉得还不错? 一键收藏
  • 12
    评论
根据提供的引用内容,有两个问题需要解决。 问题一是文件名有问题,导致.m文件无法执行。文件名为dobot+robot.m,其中有‘+’,无法正确执行启动的代码。解决办法是将文件重命名为dobot_robot.m。也可以选中所有代码,右键,执行所选内容。 问题二是程序执行时报错,错误使用SerialLink/fkine (line 85) q must have 3 columns。出错SerialLink/jacob0 (line 61) Tn = fkine(robot, q); % end-effector transformation。出错SerialLink/ikine (line 153) J0 = jacob0(robot, q);。出错dobot_robot (line 25) q = dobot.ikine(T,'mask',[1 1 1 0 0 0])。这个问题可能是由于机器人的关节角度q的维度不正确导致的。在这种情况下,需要确保关节角度q是一个3列的矩阵。你可以检查一下你的关节角度q的维度是否正确。 关于matlab机器人末端画圆的问题,可以使用matlab的Robotics System Toolbox来实现。下面是一个示例代码,演示了如何使用matlab机器人模型和运动学函数来控制机器人末端画圆: ```matlab % 创建机器人模型 robot = loadrobot('dobot'); % 设置机器人的关节角度 q = [0, pi/4, 0, pi/2, 0]; % 创建一个圆的路径 radius = 0.1; % 圆的半径 theta = linspace(0, 2*pi, 100); % 角度范围 x = radius * cos(theta); % x坐标 y = radius * sin(theta); % y坐标 z = zeros(size(theta)); % z坐标 % 将路径转换为机器人末端的位姿 poses = zeros(4, 4, length(theta)); for i = 1:length(theta) T = transl(x(i), y(i), z(i)); poses(:, :, i) = robot.fkine(q) * T; end % 控制机器人末端画圆 for i = 1:length(theta) robot.animate(poses(:, :, i)); drawnow; end ``` 这段代码首先创建了一个dobot机器人模型,然后设置了机器人的关节角度。接下来,创建了一个圆的路径,并将路径转换为机器人末端的位姿。最后,通过循环控制机器人末端沿着圆形路径移动,并使用`robot.animate`函数实时显示机器人的运动。

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值