Z moves have been deliberately broken. This will be fixed in the next checkin.
routine executes in 6.5 microseconds, so we shouldn't have any trouble driving the steppers fast...