Continued to add mavlink commands