Павел_Хабаровск после формирования запроса нужно посчитать CRC, прилепить ее к запросу и отправить. Не смотрел по коду, что там за CRC, если строго такая же как у Modbus, то при приеме ответа кидаем его целиком в расчет CRC и должны получить 0, если другой расчет, то посылать только ответ, вычислять CRC и сравнивать с полученной.