ROS学习笔记(15)小车巡墙驾驶

0.前提

前一章我讲解了拉氏变换和PID,这一章我来讲解一下小车巡墙驾驶的理论和部分代码。

1.前情回顾

1.拉氏变换

拉普拉斯变换是要将时域问题转换成频域问题来处理。

2.PID控制器

转向角:

误差牺牲:

3.具体参看上一篇文章

2.巡墙驾驶理论

在PID当中我们提到牺牲误差,那实际运用当中我们要如何得到牺牲误差呢?在何时去获取误差(这是一个时域问题)?

回答:我们可以在当前时间利用雷达获取到右墙的距离,而现在这个时刻的距离认为是,参看下图将小车当前速度设定为,与速度垂直的角度测得到墙距离,距离与轴的角度为,在该角度的基础上叠加一个角度(),测出一个距离。

按下图我们可以计算出角度,这时我们也就知道了当前时刻我们所在的位置

既然我们得到了车和墙现在的距离,那我们设置一个我们的期望值(车和墙的距离),计算牺牲误差,在低速档的时候按照这个方式计算转向是完全ok的,但当我们小车行驶在超高速度时(雷拉洛的AK-787极速能达到260km/h!),按照这样的测距方式是来不及的,换而言之,在工业上这时不安全的,我们更希望超前预测计算距离。

按下图,我们假设小车按当前速度会向前行驶一段距离,那我们计算的牺牲误差将会是

3. ROS实现巡墙驾驶关键解析

在PID计算中我们需要用到积分与微分,但在实际代码工程中如何实现积分和微分的计算呢?

1.微分(D控制器)

1.导数的定义

导数其实本质上就是关于的函数和间的除法关系求极限。

2.D控制器公式

换个方式表达:

其中表示当前时间,表示之前时间。涉及到时间的函数在ROS中如何获取?

这里我只给出c++的ROS获取当前时间:

roscpp/Overview/Time - ROS Wiki

2.积分(I控制器)

1.积分的定义

积分其实本质上就是关于的函数和间的乘法法关系和求极限。

2.积分控制器公式

换个方式

其中表示当前时间,表示之前时间。

3.PID

最后的PID公式

转向角:

其中表示当前时间,表示之前时间。

误差牺牲:

4.总结

好了PID的理论和一些代码思路我就讲到这里了,接下来就是大家自己去实践了。

相关推荐
蒸蒸yyyyzwd1 小时前
后端学习笔记,设计模式相关以及微服务相关
笔记·学习
Hhy_11071 小时前
《C++深度解构07》手撕 vector —— 从底层三指针架构到迭代器失效彻底吃透
c语言·开发语言·c++·学习·visual studio
艾莉丝努力练剑2 小时前
【QT】系统相关:TCP的API介绍
开发语言·前端·c++·人工智能·qt·学习·tcp/ip
wechatbot8882 小时前
企业微信外部群聊自动回复机器人开发实战
微信·机器人·企业微信·企业微信scrm·企业微信二次开发·企业微信api
yiangL_16 小时前
Python 学习笔记:递归、turtle绘图、字符串与函数
笔记·python·学习
人生!?17 小时前
Linux 从入门到进阶 | 基础语法
linux·笔记·教程
优化Henry18 小时前
LTE 站点 S1 链路反复闪断导致小区频闪退服故障排查
运维·网络·学习·信息与通信·tdd
wangxiaoxuan21720 小时前
如何设计机器人 API:类型、单位、坐标系与失败语义
机器人·科沃斯八界
深蓝学院21 小时前
机器人控制算法 MPC 的预测模型从哪来?完整公式推导
机器人·强化学习·机器人控制
蓝天居士21 小时前
ROS2从入门到精通(13)
机器人·ros·ros 2