saving values before changing from RotationMatrix  to angular
Removed gravity influence on accelerometer
Merge remote-tracking branch 'origin/master' into TiagoBranch