[ahrs] Integer rate integration fix
Quadshot height loop simplification