updated motor driver to read error status and publish the right diagnostic messages