Ты что-то сильное употребил

Я сейчас думаю немного изменить серво драйвер 0x0031.
Изменить включение, вместо битовой маски (которую прочитать нельзя

) сделать так:
По умолчанию сервы отключены. Если подать команду "установить положение", то серва включится если была выключена.
Если установить положение 0, то выключится.
Мне это кажется более удобным.
И разве нужно регенерировать все параметры при установке одного порта?
Разве не достаточно обновить параметры только этой пары?