平面三连杆系统仿真(逆运动学模块)

本文介绍了如何在Simulink环境中对平面三连杆机器人进行逆运动学仿真。内容涉及给定末端位姿求解关节角度,详细解析了通过正运动学方程建立的非线性方程组,并探讨了由于Simulink不支持`solve`命令,因此采用牛顿迭代法进行数值求解的过程。虽然无法展示代码,但鼓励读者手动输入以理解概念。

摘要生成于 C知道 ,由 DeepSeek-R1 满血版支持, 前往体验 >

平面三连杆系统仿真(逆运动学模块)

从这一章我们就开始详细的对simulink环境下,平面三连杆机器人系统仿真进行解说,首先就是逆运动学模块的分析,废话不多说,直接开始。

先来看这个部分,是机器人的一个逆运动学,实现的功能具体为给定末端的位姿,求解达到该位姿的关节角。考虑到该机器人为平面三连杆,其特点为只有两个坐标有意义,因为一个平面只需要二维信息。那么还有一个姿态信息,在实际操作中,一般姿态是设定好的,比如说末端需要以哪样的转角去抓取这个物体,这个是可以看成已知的,而我们在仿真的时候,可以随便设置一个姿态,任意姿态只要末端到达那个位置就行。
在这里插入图片描述

具体的我们结合上面的仿真模块来说。我们设计的是在空间中(0,410,0)和(0,150,150)两个点之间的运动,那么需要解出机器人末端到达这两个点各个关节角度值。通过机器人正运动学方程,可以得到关于关节变量的三个方程:

MatlabSimMechanics自由度串联机器人-MyRobot_moveline.rar 上次我发了二自由度串联机器人的正的贴子,可能这个论坛的高手觉得太简单了,都问我做的是是不是并联机器人。 前几天我感到很羞愧,也知道在这个论坛一定不能班门弄斧,本来我想把这次做的东西在年前就贴出来的,但是鼓励了一下自己,先做了一个六自由度机器人,我已经贴了出来。 这次是一个比较简单的串联自由度机器人 手头也正准备做两个平面并联的机器人,还望大家多给我点意见。 我才只有大学年级,毫无疑问是一个菜鸟,要好好向老鸟学习才是。 我先简单说明我建立模型的思路和步骤 首先,制作一个生成轨迹的子系统,这个用最简单的simulink就可以做出来。 然后,制作一个simmechanics的系统,这是整个仿真的关键部分,还是强调坐标系的灵活使用。 再者,制作一个位置的程序,这里我个人比较喜欢使用数值,只要用一个matlabfun模块就可以把m文件和simulink结合起来,可以大大的减少工作量,实现复杂的功能。 最后,制作joint的输入模块,所有的输入都是转动的位移,这一步是最简单的。 主要用到matlab中的一个模块和一个命令Simechanics模块和优化工具箱中的fsolve命令 好了言归正传,我先说简单的自由度机器人,这个就是最典型的PUMA机器人 但是我必须要说明的是,我只是为了演示simmechanics工具箱的使用,所以我把手腕的部分去除了,如果大家有兴趣的话希望在我的模型上加以改进。 这个机器人实际上就是连杆个转动副,连杆的长度分别为a1,a2和a3 必须要有个输入才能得到一个稳定的位置,换句话说会有有个方程,那么它们是 x=cos*cos*cos*a3-cos*sin*sin*a3 cos*cos*a2 y=sin*cos*cos*a3-sin*sin*sin*a3 sin*cos*a2 z=sin*cos*a3 cos*sin*a3 sin*a2 a1 其中th1,th2和th3个转动副的转角 这个是根据DH推出来的,在这里我就不多说了,如果不用DH也可以很简单的算出来,看大家的喜好了。 现在的任务就是,要使机器臂的末端走出一条直线来 那我就随便乱说了,原理和方是一样的就可以了 就从沿直线走到吧 好了下面我就把m文件和仿真的图都贴出来 大家多给我点意见啊,有问题也可以发邮件给我,欢迎交流 xukai19871105@126.com %MyRobot有个转动关节,共有个自由度 %该文件用于在simulink中求个转动副的转角 function [result]=MyRobot_Inverse %方便编程,转化传入的数据 x=u; y=u; z=u; %连杆的长度 a1=1; a2=0.8; a3=0.5; %求参数设置 options=optimset; %调用fsolve命令求个转角 result=fsolve; %求个转角的非线性方程组 function [theta]=NumericalSolution %方便编程,转化输入值 th1=u; th2=u; th3=u; theta=[cosd*cosd*cosd*a3-cosd*sind*sind*a3 cosd*cosd*a2-x;     sind*cosd*cosd*a3-sind*sind*sind*a3 sind*cosd*a2-y;     sind*cosd*a3 cosd*sind*a3 sind*a2 a1-z];
评论 2
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

机器王小帅

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值