[mikets]

I think the fastest is to take one of the sample code that resembles most to your robot and make minor modifications to it to match your robot. You should be able to have a runnable TeleOp by this method. Then you need to prioritize what you need to get working next and add code for each subsystems one at a time. With your current situation, I would give up autonomous.