底盘和pl程序:
底盘main.cpp中包含RecvFromCAN、RecvFromPL、Process、SendToCAN、RecvFromIMU、AnalysisIMU、SendCarState七个线程。
1.RecvFromCAN线程:
void *RecvFromCAN_pthread(void *arg)
vcu_vstate1_st是一个关于车辆各个信息状态的结构体,先对结构体vcu_vstate1_st和vcu_dstate_st进行memset初始化
memset(&g_vcu_vstate1, 0, sizeof(vcu_vstate1_st));
memset(&g_vcu_dstate, 0, sizeof(vcu_dstate_st));
然后为了获取到vcu_vstate1_st和vcu_dstate_st结构体数据,需要与底盘can口建立通信,所以接下来进行can通信初始化和can数据接受,来填充结构体数据。
将底盘frame.data中的数据传输给g_vcu_vstate1中。
2.RecvFromIMU线程:
这个线程的功能类似于人工采集路径点的过程,思想还是一样,就是提取sv2惯导GPS数据中对自动寻迹有用的数据:经纬度、速度、转向角。
无人小巴自动寻迹(二)底盘和pl(路径规划)程序解读(sv2惯导+激光雷达)
最新推荐文章于 2023-12-25 17:19:08 发布
本文详细解析了无人小巴自动寻迹的底盘程序和路径规划(PL)流程,包括CAN通信、惯导数据采集、路径点处理、UDP通信以及核心的寻迹算法,阐述了如何通过最小路径点和目标点的寻找实现自动寻迹功能。
摘要由CSDN通过智能技术生成