Rewrote since I had misinterpreted the protocol, now it should be j1850-compliant