Changed drive code to have 4 motors and shifting solenoids. Other miscellaneous changes.