Add ALL_AXIS, change YAW_KP to 5