Removed motor header and changed motors to DigitalOuts