Replace AHRSupdate routine and fixed issue with xerogyro for ADXL345