Edited stabilizator class mostly. It is crucial to add the offsets for accel and compass in the SensorsService constructor for the correct work.