updated kazmath - NB yawpitchroll changed sustantially