relocated calculateAngle method
stopping the motors only once in the positionManager before anything else
is done