这个算法用于无人机群避障一个加入机群的无人机，算法分为两种思路：(1)加入者的路径规划主动机动规避编队机群、(2)编队微调避让加入者。目前只做了第一种思路。唯一已知信息是原机群的运动轨迹F(x，y，z，t)|each plane，对于第一种思路：对于补位飞机唯一的输入参数是无人机编队时间帧和每架飞机的对应位置，即F(x，y，z，t)|each plane，输出参数是规划的单条路径。对于第二种思路：让正常飞行的编队可以保持在其原始轨迹周围(即，边界条件，规避机动范围<Δv球)，补位无人机穿越他们的空隙到达目标位置，输出为需要避碰的其他无人机的机动向量。第一种思路采用三维A*+分段局部规划

Project for ROB 550. Implementing SLAM using LIDAR, wheel encoders and IMU on MBot.