Update maneuver_program.cpp