Update ahrs.cpp

Erreur idiote !