一. Stanley

1. 算法原理

参考链接：

https://blog.csdn.net/renyushuai900/article/details/98460758

记录此前遇到的问题：

• 运动模型差异性
• 串口数据发送时延
• 参数优化
• 航向角估计