Fixing some errors in STM32_publisher.py