Got drive code working. almost done w/ intake and shooter. will start testing after it is built.