C++ Builder6를 사용하고 있습니다. comm 컴포넌트를 이용해서 시리얼 데이터를 수신중입니다.

데이터가 0xa5 0xa5 0xa5 0xa5 0xae length data~~~  0xaf
이런식으로 들어옵니다. 데이터를 length에 따라 입력받는 숫자가 틀려집니다.
그래서 0xa5 네번을 체크하고 length를 가지고 데이터를 저장하려고 하는데
잘 안되네요. 어느부분을 잘 못하고 있는건지 도움좀 부탁드리겠습니다.


//#define NMS_STX        0xAE
//#define NMS_ETX        0xAF
//#define NMS_PREAMBLE    0xA5

unsigned int serial_number = 0;
void __fastcall TForm1::Comm1RxChar(TObject *Sender, DWORD Count)
{

        static unsigned char serial_data[1024],stuff_data[1024];
        DWORD i;
        int nms_len;

        Comm1->Read(serial_data,Count);
        for(i=0;i<Count;i++)
        {
                if((serial_data[i]==NMS_PREAMBLE)&&(serial_data[i+1]==NMS_PREAMBLE)&&
                  (serial_data[i+2]==NMS_PREAMBLE)&&(serial_data[i+3]==NMS_PREAMBLE))
                {
                        nms_len = ((serial_data[i+5]<<8)+serial_data[i+6]);
                        serial_number = 0;
                }
                else
                {
                        serial_number++;
                        if(serial_number>=1024) serial_number = 0;
                }

                if((nms_len+4)<serial_number)
                {
                        int stuff_cnt;

                        for(stuff_cnt=5;stuff_cnt<nms_len;stuff_cnt++);
                        {
                                stuff_data[stuff_cnt-5] = serial_data[stuff_cnt];
                        }
                        serial_number = 0;
                }
        }