Started programming the automode mission planner for Frobit_v2_demo