Added new code to the UAV_control section

New code sets servos to default middle position, reads and prints out
positions and changes in position of the compass, and magnetometer.