Cleaned up code, added dpad support, added dpad controls to the drive system