Revert "Revert "Use roll-yaw-pitch order to calculate the euler angle from accelerometer""

This reverts commit c784a8ebe686b9107b518777df939af4c915d04b.

Conflicts:
	firmware/ahrs/ahrs.c
Normalize the accel data before estimate the euler angle