Move new Lift and Drive code into CBRobotMain & CBRobotMainLib