Created a DroneKit script for an auto mission that switches from auto to guided mode and then back to auto mode, simulated on mp (works well, allows for intermediate waypoints ie. the output of path deflection algorithm). Aborted flight-test midway due to safety.
Guided mode controls is ready
Wrapping up decision module for vfh
completed unit tests for lidar_parser, finishing vfh and decision module unit tests. working on integration tests next week.