Include the "mavlink.h" in "QuadCopterConfig.h"
Add the TODO comment
Fix the wrong msgid of "mission_set_current"
Basic implementation of "mission_set_new_current_waypoint"