Added angle conversion testing, added battery settings option, added option to set MAVLink ID of groundstation

 Changed for a simpler way unit tests can be set up and run. Now tests can be simple classes which implement the tests