Программирование HART модема

Для чтения заводской инфы я использу такой код:

могут быть небольшие ошибки, я его почистил от лишнего, а для команд 0х01, 0х02, и т.д. нужно использовать длинный фрейм, в котором адрес уже не 1 байт, а 5 - эти байты ты собственно и получаешь командой 0х00;

struct data_00
{
BYTE preamb1,preamb2,preamb3,preamb4,preamb5,preamb6;
BYTE frame;
BYTE addr1;
BYTE command;
BYTE ByteCount;
BYTE CheckSum;
};

struct data_03
{
BYTE preamb1,preamb2,preamb3,preamb4,preamb5,preamb6;
BYTE frame;
BYTE addr1,addr2,addr3,addr4,addr5;
BYTE command;
BYTE ByteCount;
BYTE CheckSum;
};

struct otvet_00
{
BYTE addr1;
BYTE command;
BYTE ByteCount;
BYTE status1,status2;
BYTE x254;
BYTE manuf_ID;
BYTE device_type;
BYTE num_preambles;
BYTE com_revision;
BYTE cmd_revision;
BYTE soft_revision;
BYTE hard_revision;
BYTE func_flags;
BYTE IDnumber1,IDnumber2,IDnumber3;
BYTE CheckSum;
};

struct otvet_03
{
BYTE addr1,addr2,addr3,addr4,addr5;
BYTE command;
BYTE ByteCount;
BYTE status1,status2;
BYTE milliamper[4];
BYTE PVunits;
BYTE PV[4];
BYTE SVunits;
BYTE SV[4];
BYTE TVunits;
BYTE TV[4];
BYTE FVunits;
BYTE FV[4];
BYTE CheckSum;
};

BYTE aa;
float ff,aa1;

TForm1 *Form1;
HANDLE Comport=NULL;
DCB dcb1;
COMMTIMEOUTS comtimeouts;
COMSTAT statistic;

data_00 data0;
data_03 data1,data_d;
otvet_03 otvet1,otvet_d;
otvet_00 otvet0;
BYTE recv;

    DWORD nNumberOfBytesToWrite; 
    DWORD lpNumberOfBytesWritten; 

void __fastcall TForm1::Button3Click(TObject *Sender)
{
int i,k;

Comport = CreateFile(ComboBox1->Text.c_str(),
    GENERIC_READ | GENERIC_WRITE,
    0,    /* comm devices must be opened w/exclusive-access */
    NULL, /* no security attrs */
    OPEN_EXISTING, /* comm devices must use OPEN_EXISTING */
    0,    /* not overlapped I/O */
    NULL  /* hTemplate must be NULL for comm devices */
    );

if (Comport!=INVALID_HANDLE_VALUE)
{

GetCommState(Comport, &dcb1);
dcb1.BaudRate=1200;
dcb1.fBinary=1;
dcb1.fParity=1;
dcb1.fDtrControl=1;
dcb1.Parity=1;
dcb1.ByteSize=8;
dcb1.StopBits = ONESTOPBIT;
SetCommState(Comport, &dcb1);

comtimeouts.ReadIntervalTimeout=0;
comtimeouts.ReadTotalTimeoutMultiplier=0;
comtimeouts.WriteTotalTimeoutMultiplier=0;
comtimeouts.ReadTotalTimeoutConstant=750;
comtimeouts.WriteTotalTimeoutConstant=750;
SetCommTimeouts(&Comport,&comtimeouts);

PurgeComm(Comport,PURGE_TXCLEAR);
PurgeComm(Comport,PURGE_RXCLEAR);

i=1; - адрес устройства

data0.preamb1=0xff;
data0.preamb2=0xff;
data0.preamb3=0xff;
data0.preamb4=0xff;
data0.preamb5=0xff;
data0.preamb6=0xff;
data0.frame=0x02;
data0.addr1=128+i;
data0.command=0x00;
data0.ByteCount=0x00;
data0.CheckSum=data0.frame^data0.addr1^data0.command^data0.ByteCount;

if (WriteFile(
    Comport, // handle to file to write to
    &data0, // pointer to data to write to file
    sizeof(data0), // number of bytes to write
    &lpNumberOfBytesWritten, // pointer to number of bytes written
    NULL  // pointer to structure needed for overlapped I/O
   ))
{
Sleep(700);
   ClearCommError(Comport,NULL,&statistic);
   if (statistic.cbInQue>0)
for (recv=0x01,k=0;(recv!=0x06) && (statistic.cbInQue>0) ;k++)
{
   ClearCommError(Comport,NULL,&statistic);
   if (k>22) break;
   if (statistic.cbInQue>0)
   ReadFile(
    Comport, // handle of file to read
    &recv, // address of buffer that receives data
    1, // number of bytes to read
    &lpNumberOfBytesWritten, // address of number of bytes read
    NULL // address of structure for data
   );
}

   ClearCommError(Comport,NULL,&statistic);
   if (statistic.cbInQue>=sizeof(otvet0))
   {
   ReadFile(
    Comport, // handle of file to read
    &otvet0, // address of buffer that receives data
    sizeof(otvet0), // number of bytes to read
    &lpNumberOfBytesWritten, // address of number of bytes read
    NULL // address of structure for data
   );
}
}
}
}
else Label1->Caption=ComboBox1->Text+" can't open!!!";
}