Added command count and telemetry count to diagnostic message.
Merge branch 'master' of https://github.com/bluerobotics/SolarSurferComm