算法模板3.1 扩展卡尔曼滤波本地化
3.2 无损卡尔曼滤波本地化
3.3 粒子滤波本地化
3.4 直方图滤波本地化
四、映射
4.1 高斯网格映射
4.2 光线投射网格映射
4.3 k均值物体聚类
4.4 圆形拟合物体形状识别
五、SLAM
5.1 迭代最近点匹配
5.2 EKF SLAM
5.3 FastSLAM 1.0
5.4 FastSLAM 2.0
5.5 基于图的SLAM
算法模板3.1 扩展卡尔曼滤波本地化
3.2 无损卡尔曼滤波本地化
3.3 粒子滤波本地化
3.4 直方图滤波本地化
四、映射
4.1 高斯网格映射
4.2 光线投射网格映射
4.3 k均值物体聚类
4.4 圆形拟合物体形状识别
五、SLAM
5.1 迭代最近点匹配
5.2 EKF SLAM
5.3 FastSLAM 1.0
5.4 FastSLAM 2.0
5.5 基于图的SLAM
有个疑问 掉头时间忽略不计, 那就不存在0 的情况呀。
原来是-1 , 掉头就马上变成1 啦。
我觉得是要建立一个蚂蚁列表
ants_list = [[位置,朝向],[位置,朝向],[位置,朝向],[位置,朝向]..]
约定左边位置小 , 右边位置大。
循环
秒数+1 然后根据朝向来来变动位置值,
变动完后,遍历蚂蚁列表 , 判断有没有一样的位置值, 如果有,把两个朝向都改变(1变-1, -1变1)。
这样逻辑就简单了。