Режим работы Электро Усилителя Руля на STM32F103C8T6

Для электро усилителя руля активация режимов Comfort, Normal, Спорт.  STM32F103C8T6 по CAN шине  шлет сообщение формата:
4F1 8 00 00 00 00 00 00 00 00
Для запроса и смены режима работы ЭУР ( при первом нажатии на смену режима работы, сначала высвечивается текущий режим и последующие нажатия уже меняют его),  меняет сообщение на
4F1 8 00 00 00 01 00 01 00 00
В ответ на это сообщение ЭУР меняет сообщение на
5E4 3 00 10 00 — режим Comfort : Led зелёная 
5E4 3 00 08 00 — режим Normal :  Led синяя           3 режима индикаций.
5E4 3 00 09 00 — режим Спорт :    Led красная
смена режима нажатия на кнопку