这些代码为陈烨柯和公冶在田在SRTP后半阶段所写，针对CICT（论文名）的实物部分。作用为通过交互界面，获得全局导航图数据，在线或离线处理实车点云、相机、gps、底盘、imu数据，根据位姿截取局部导航图，使所有数据同步并按格式保存于本地，并对数据进行滤波处理和做相应的pm、ipm变换，得到网络所需输入输出。
数据存放于data文件夹中，由于部分代码在服务器中使用，这些代码中的部分路径与当前运行环境并不匹配
获得运行的全局导航地图
左键右键点击获得gps坐标
右键点击的点会被记录下来
中键点击撤销
全局的示意图如下：
局部的示意图如下：
通过读取message，获取、处理并保存位姿、速度、加速度、角速度、点云、GPS等信息
可以在线读取，也可以回放bag数据读取
最新的代码可以通过ekf得到imu和GPS融合后的结果，并保存
通过位姿信息（pos.txt或者ekf.txt）得到未来位姿在当前相机图像的投影，包含了异常数据检测和滤波等功能
通过pm和激光雷达数据得到势场图如图：
单独通过gps数据生成导航图，减少get_real_data的负担，增加代码实时性，生成导航图的时候需要map和navigation两张图片
imu和GPS数据融合的代码主体，使用x,y,theta,v为状态量，w(z轴角速度),a(x轴加速度)为控制量，被控对象为四轮差分的小车。融合后效果显著提升于gps。
效果对比如下（前者为未滤波，后者为滤波后）：
一些对位置、角度量平滑化的滤波器尝试，主要是简单的二维kf，用来对每一个数据做平滑处理。效果一般。
播放指定文件夹下的图片，并生成视频。
对比EKF与纯GPS得到的轨迹，并可视化