normalize vector

calculate smallAngle and make it easier to change 
trollAngleCorrection : simplify and remove extra float operation 
+minor format and uint16_t AccInflightCalibrationArmed