Lift Preset Codes

Added more debug code for lift presets and got the low, medium and
collect presets somewhat working. The lift stutters when moving on
presets, and the collect preset doesn't work if the robot is controlled
manually and then the button is pressed.