Add tests for diagnostics module - all passing.
Testing rx/tx of diagnostics on bus 2.
Remove resolved TODO - use CAN1 as default for writes.