- Complete the TODOS in behavior_planner_FSM.cpp
- Complete the TODOs in cost_functions.cpp
- Complete the TODOs in motion_planner.cpp
- Complete the TODOs in velocity_profile_generator.cpp
- Complete the TODOs in planning_params.h
By completing the above tasks the following was the result: