Create the macro function for registering the mission
Fix the mission_write_waypoint_list
remove the function "push_waypoint_node"

*Reason: Too slow, will delay the transaction of mavlink
Clear the waypoint count in the function "mission_clear_waypoint"