四足机器人并联腿足端轨迹Matlab仿真

2024-03-31 09:04:06

四足机器人并联腿足端轨迹Matlab仿真

轨迹计算

轨迹是分成两部分：摆线方程+水平线段
首先，设置大腿关节轴心坐标为（0，0），根据机械设计的大腿小腿长度设置参数。此处设置大腿 l1=100mm，小腿l2=200mm。
摆线方程根据公式x=a(t - sint)，y=a(1 -cost)，假设摆线的圆半径R=20mm，选择时间的步长为▲t=0.1pi（0->2pi）；
则列出足端的轨迹方程xL2 = R*(t-sin(t))-20pi，yL2 = R(1-cos(t))-100sqrt(3)。
水平直线：左右两部分使用两组坐标
xL2 = -20pi:(40pi)/20:20pi; yL2 = repelem(-100sqrt(3),21);
xR2 = -20pi:40pi/20:20pi; yR2 = repelem(-100*sqrt(3),21);

绘图

使用matlab里的plot函数把上一步计算出来的轨迹描绘出来，如图所示。

计算左右关节点坐标

简单方法就是使用小学二年级学过的余弦定理，根据已知的大腿小腿的长度计算三角形的第三边长度，再根据长度计算出需要的关节角度和小腿与第三边的夹角。最后通过判断目标的点坐标与大腿轴关节的坐标相对位置，计算出一个需要的角度，最后就可以根据这个需要的角度计算出来大小腿关节点的坐标。
具体计算如下：

连续绘图如下：

清除掉历史轨迹后结果如下：

说明：博主基于此视频学习修改而来，讲解通俗易懂，对此表示感谢！
上述完整matlab程序点击这里进入下载。

四足机器人并联腿足端轨迹Matlab仿真相关推荐

四足机器人单腿逆运动学解-几何方法
四足机器人单腿逆运动学解-几何方法视角分解静止状态运动状态运动学逆解求解gamma角求解beta角求解alpha角 matlab代码实现古月居<四足机器人控制与仿真入门>学 ...
【四足机器人支撑腿反作用力规划】未简化的动力学模型规划反作用力 +运动学模型雅可比+虚功原理规划关节扭矩方法
系列文章目录提示:这里可以添加系列文章的所有文章的目录,目录需要自己手动添加 TODO:写完再整理文章目录系列文章目录前言一.基于动力学模型的工作空间控制框图二.原理推导三.缺点前言 ...
四个翅膀的飞机Simulink与轨迹跟踪仿真
数学建模这一部分强烈建议看一篇知乎文章:zinghd的回答其最终模型结果: 其中部分符号的定义可以参考上面给的知乎链接.下面给出角度的定义和飞行器的外观. 对于上图给出的四旋翼飞行器,其x轴为向量 ...
六自由度机器人（机械臂）运动学建模及运动规划系列（三）——机器人建模及运动学分析的Matlab仿真
在完成机器人的建模以及运动学分析之后,可以利用Matlab中的Robotics工具箱进行仿真. 本篇目录一.工具箱下载二.机器人建模仿真三.机器人运动学计算仿真四.小结一.工具箱下载要在M ...
【四足机器人--摆动相足端位置速度轨迹规划】（4.1）FootSwingTrajectory（bezier曲线计算脚的摆动轨迹）代码解析
系列文章目录提示:这里可以添加系列文章的所有文章的目录,目录需要自己手动添加 TODO:写完再整理文章目录系列文章目录前言一.FootSwingTrajectory(bezier曲线)的内容 ...
matlab 棍,双足机器人行走棍图怎么用MATLAB画出来
匿名用户 1级 2016-05-25 回答 The following is a function I wrote to generate a stick diagram of robot motio ...
【四足机器人】学习笔记单腿逆运动学和站立姿态控制
[四足机器人]学习笔记单腿逆运动学和站立姿态控制一.四足机器人单腿逆运动学原理二.四足机器人站立姿态控制原理近期,博主在古月居学习关于四足机器人的相关部分知识,从阳炼老师的四足机器人控制与仿真 ...
相对全面的四足机器人驱动规划MATLAB和Simulink实现方式（足端摆线规划，Hopf-CPG，Kimura-CPG）
许久没更新四足机器人相关的博客文章,由于去年一整年都在干各种各样的~活,终于把硕士毕业论文给写好,才有点时间更新自己的所学和感悟.步态规划和足端规划只是为了在运动学层面获取四足机器人各关节的期望角位移 ...
【四足机器人步态状态FSM管理】电机失能模式、躯干翻身\收腿\恢复站立步态、WBC平衡站立步态、站立过程步态、对角小跑的运动步态
系列文章目录提示:这里可以添加系列文章的所有文章的目录,目录需要自己手动添加 TODO:写完再整理文章目录系列文章目录前言一.电机失能模式SM_State_Passive 功能 1.onEn ...

最新文章

热门文章