Integrator added, AccelGyro improvements