Lagt till kod för vinkelhastighetssensorn i AD-loopen