Set up motor for new 4 Wheel Chassis

Added New code for Chassis, and Set up motors to work in Tandem