先把这里面的地址换成你自己的 fin.open("/home/~/point.txt"); fine.open("/home/~/point.txt"); 然后编译，catkin_make 运行rosrun follow follow

压缩包中包含4个文件，所以文件都需要放在同一目录下，且最好不要有中文路径，文件采用的是matlab 2018b版本，低于此版本可能打不开，解压后直接用simulink打开.slx文件就能运行，plot_1主要是车位尺寸和道路边界信息，可以在运行simulink文件前先在matlab运行plot_1，不要关闭绘图窗口，然后运行simulink文件，可以更直观的观察到车辆的运动，plot_2主要是绘图代码，具体内容可参考我写的文章《平行泊车系统路径跟踪控制（2）》

全自动泊车系统的车位智能识别与泊车路径跟踪控制.caj

矿用铰接式车辆路径跟踪控制研究现状与进展.docx

人机共驾系统驾驶员扭矩估计和路径跟踪控制.pdf

龚建伟第二版书中可行的程序，遇到问题大家一起留言讨论进步学习。

路径跟踪问题是智能车辆研究的一项关键技术，其重点在于寻找一种合适的控制算法去控制车辆精确的跟随规划好的路径。文章主要研究了线性二次型最优控制（LQR）在智能车路径跟踪方面的应用，包括智能车辆模型搭建、算法应用、路径工况选择的具体过程，指出了 LQR 控制算法在该领域应用的优缺点。

为了降低泊车系统对驾驶人车速控制要求，针对泊车过程中驾驶人车速控制失误致使车辆偏离泊车路径最终导致泊车失败的问题，提出了结合定点跟踪的非时间参考的路径跟踪控制策略（ Ｎｏｎ － Ｔｉｍｅ　Ｂａｓｅｄ　Ｐａｔｈ　Ｔｒａｃｋｉｎｇ ｃｏｍｂｉｎｅｄ　ｗｉｔｈ　Ｐｏｉｎｔ　Ｔｒａｃｋｉｎｇ ， ＮＴＢＰＴｃｗＰＴ ）。设计了定点跟踪控制律，建立了 ＮＴＢＰＴｃｗＰＴ 控制模型，并进行了泊车路径跟踪仿真。结果表明：基于 ＮＴＢ －ＰＴｃｗＰＴ 的泊车控制策略降低了控制器对驾驶人速度控制的要求； ＮＴＢＰＴｃｗＰＴ 策略的位姿调整功能提高了泊车成功率；基于 ＮＴＢＰＴｃｗＰＴ策略的控制器可实现车辆规范停放。

基于CarSim与Matlab的泊车路径跟踪控制模型设计，硕士毕业论文，可参考作为入门的学习文件。全自动泊车，路径规划，车辆控制

为在嵌入式控制器开发环境下提高智能车辆的路径跟踪精度，采用车辆动力学模型和多点道路预瞄模型，以 预瞄窗口内的跟踪偏差为目标函数，结合 LQR 最优控制原理，提出了一种基于多点预瞄最优控制路径跟踪控制方法。针对实车应用，通过离线计算最优增益的方法，提高算法实时性。在仿真及红旗 H7 实车环境下进行试验，结果显示，该方法在保证跟踪精度的同时具有良好的算法实时性。