Нашел ошибку в драйвере серв M128-DS, вчера для M128-S исправил, а тут забыл

Вот пофиксенные версии:
Добавлено спустя 1 час 33 минуты 38 секунд:Приступим к дальнейшему развитию проекта.
В общем и целом направление - что-то типа командной оболочки, может быть даже help встроим в прошивку, чтобы на инструкции не переключаться из терминала

Итак основные идеи:
1. Оболочка будет поддерживать множество контроллеров на общей шине RoboBus[i2c], т.е. подав команду на головной можно будет обеспечить её выполнение на любом из подчиненных;
2. Для этого все парсеры "человеческих не-i2c" команд будут переводить полученную команду в i2c-формат и отправлять на вполнение на этот или подчиненный контроллер;
Переключение между контроллерами будет выполняться отдельной командой "
!<controller_number>" при этом за каждым номером кроме 0 будет закреплён свой i2c-адрес подчиненного контроллера. Под номером 0 всегда будет локальный контроллер. Для назначения и сканирования на предмет драйверов любого контроллера с номером >0 нужно будет дать команду "
@<controller_number>=<i2c_address>"
Внутри каждый парсер будет отвечать за какую-то букву, с которой будут начинаться команды для него. Кроме того каждый "человеческий" парсер будет выбирать из предложенных ему UIDов драйверов выбранного контроллера тот, который наиболее ему удобен. Так же каждый парсер будет иметь свою справку по синтаксису - в короткой версии выдаваемой со списком команд по запросу "?" и в полной версии выдаваемой по запросу "?<первый символ команды>".
Так что мы разделим парсинг всех команд типа "L", "C", "V" и "S" по отдельным файлам, что упростит отладку и ликвидирует возможность внести баги в одну команду при правке другой.
Добавлено спустя 4 минуты 12 секунд:Например на запрос "?" будет выдаваться что-то типа:
ORFA version 0.8.3, list of currently supported commands:
L - Set local i2c-address, example: "L40<cr>"
V - Get firmware version, example: "V<cr>"
B - Goto bootloader for firmware update, example: "B<cr>"
S - Execute i2c-request, example: "S40 00 00 S41 01 P<cr>"
# - Servo control, example: "#0 P1500 T1000<cr>"
For detail syntax type "?{cmd}<cr>", example: "?S<cr>"