Extension to the USBL communication infrastructure and debugging on the real system.