Для аккуратности, в расширенном режиме редактирования сообщения оборачивайте код в теги [CODE].
И можете ещё спойлером закрыть длинную простыню.
спойлер с кодом:
На первый взгляд именно обработка строки выглядит убедительно.
Создайте тестовую программу и вместо принятых из порта байт отправляйте символы из подготовленной строки - так и взаимодействие и корректность проверите.
Когда мне нужно проверить регулятор - пишу тестовые программы с моделями задвижек, резервуаров, насосов, теплосетей (инерционных температурных объектов).
И Вы так поступайте.

