动力学方程、参考轨迹生成、运动学控制器、非线性ESO、动力学控制器等。它主要用于解决小车在给定参考轨迹下的运动控制问题,通过控制器输出的控制力矩来控制小车的速度和位姿,以实现对参考轨迹的跟踪

这是一个关于轮式移动机器人轨迹跟踪的MATLAB程序,采用双闭环控制结合非线性ESO技术,针对小车在参考轨迹下的运动控制。程序通过控制力矩调整小车速度和位姿,实现对参考轨迹的有效跟踪,同时提供了详细的仿真结果图表分析。
摘要由CSDN通过智能技术生成

轮式移动机器人轨迹跟踪的MATHLAB程序,运用运动学和动力学模型的双闭环控制,借鉴自抗扰控制技术结合了非线性ESO,跟踪效果良好,控制和抗扰效果较优,可分享控制结构图。

这段程序主要是一个小车的动力学仿真程序,用于模拟小车在参考轨迹下的运动。下面我将对程序进行详细的分析解释。

首先,程序开始时使用clearclcclose all命令来清除工作空间、命令窗口和图形窗口中的内容。

接下来,程序定义了一系列参数和变量,用于设置仿真的参数和存储仿真过程中的数据。这些参数包括小车的质量、车宽、驱动轮半径等,还有参考轨迹的振幅和频率,仿真步长,仿真时间等。

然后,程序定义了一些元胞数组,用于存储不同阶段的数据。这些数组包括参考轨迹位姿、真实运动轨迹位姿、参考轨迹一阶导数、虚拟参考轨迹速度、期望速度、真实速度、控制器输出的控制力矩、控制输入、期望速度与真实速度误差、摩擦值、外界扰动值、总扰动、位姿跟踪误差、扰动观测值等。

接下来,程序给这些变量赋初始值,包括小车的初始位姿和速度,虚拟初始速度,期望初始速度,控制器输出的控制力矩,扰动观测值等。

然后,程序进入一个循环,仿真时间从0到给定的仿真时间tf。在每个循环中,程序根据给定的参考轨迹生成圆形参考轨迹,并计算参考轨迹的一阶导数和虚拟参考轨迹速度。

接下来,程序计算位姿误差,并使用运动学控制器计算期望速度。然后,程序使用非线性ESO(Extended State Observer)估计速度扰动,并使用动力学控制器计算控制力矩。最后,程序根据控制力矩和扰动计算小车的实际速度和位姿,并计算位姿跟

  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值