Added lift control, needs calib