无人小巴自动寻迹(二)底盘和pl(路径规划)程序解读(sv2惯导+激光雷达)

本文详细解析了无人小巴自动寻迹的底盘程序和路径规划(PL)流程,包括CAN通信、惯导数据采集、路径点处理、UDP通信以及核心的寻迹算法,阐述了如何通过最小路径点和目标点的寻找实现自动寻迹功能。
摘要由CSDN通过智能技术生成

底盘和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数据中对自动寻迹有用的数据:经纬度、速度、转向角。

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值