Corrected bugs that were preventing successful communication between the brain and the path planner. The high level part of the control works :)