Added a range of functions for setting the mode of the mavlink device, tidied up handling the device mode/status and fixed up the statustext
Changes to test modes