A lot of small fixes, see decription

* Fixed read out error in magnetometer
* Fixed error in Madgwick algorithm - it used te left hand derivative
and the fixed frame derivative
* Changed the makefile to automatacly download code to the target
* Added code fram for the controller