Added a few fields to the diagnostic message.
Fixed unit test.
Merge branch 'master' of https://github.com/bluerobotics/SolarSurferComm