Add the TODO comment
Fix the wrong msgid of "mission_set_current"
Basic implementation of "mission_set_new_current_waypoint"