Modify the implementation of the function "send_package"
Add file mavlink_types.h into the "mavlink" directory
Enable the Ground Station mode
Add some simple test of the MavLink