Added debug messages to chestbelt driver to display messages with wrong
length