Added unit tests, almost finished ObdSerial