Handle gcode G28, add z platform offset