Super rough

Autonomous is still rough

Added the conveyor code and fixed a silly mistake to Imp2