Improved OBD Library ready for test