ynu_mpu add vertical guidance

Fork of YNU_MPUd2 by hige dura

no such method: docs