Add DZ command to drive to hardtop and zero after calibration.