With working reporting of sensors, angles and gyro.
With direct controling of the motors from ground station. 
Fixed the delay bug on received commands.
Fixed problems with communications with GroundStation.
Added support for configuring the rotor alghoritms remotely.