Semi auto lift

Version 1 of SemiAutoLift used in new main CBRobotMain.c