Mission: add set current command method
Mission: example sketch tests set current command
Copter: integrate AP_Mission set_current_cmd
Mission: add replace_cmd method