Calculate postion from acceleration using CHR-6dm AHRS sensor