Improve USART interrupt handler
Add sensor_data struct and formatter