Отправлено #8 10 января 2006 г. 03:05 В ответ на: Если кому не влом скоректируйте трансляцию из С в дельфи отправлено <font color=gray>TamTam 1</font> 10 января 2006 г. 01:33

bool WINAPI RxFrame(DWORD To, unsigned char &ADD, unsigned char &CMD,
unsigned char &N, unsigned char *Data)
{
  int i;
  unsigned char b = 0, crc = CRC_Init; //init CRC
  ComTo.ReadTotalTimeoutConstant = To; //set timeout
  if (!SetCommTimeouts(hCom, &ComTo))
    return 0; //set timeouts error
  for (i = 0; i < 512 && b != FEND; i++)
    if (!RxByteCOM(b)) 
      break; //frame synchronzation
  if (b != FEND) 
    return 0; //timeout or sync error
  DowCRC(b, crc); //update CRC
  N = 0; ADD = 0;
  for (i = -3; i<=N; i++)
  {
    if (!RxByteCOM(b)) 
      break; //timeout error
    if (b == FESC)
      if (!RxByteCOM(b)) 
        break; //timeout error
    else
    {
      if (b == TFEND)
        b = FEND; //TFEND <- FEND
      else
        if (b == TFESC)
          b = FESC; //TFESC <- FESC
        else
          break;
    }
    DowCRC(b, crc); //update CRC
    if (i == -3)
      if ((b & 0x80) == 0) 
      { 
        CMD = b; i++; 
      } //CMD (b.7=0)
      else 
        ADD = b & 0x7F; //ADD (b.7=1)
    else
    if (i == -2)
      if ((b & 0x80) != 0)
         break; //CMD error (b.7=1)
      else
        CMD = b; //CMD
    else
      if (i == -1)
         N = b; //N
      else
       if (i != N)
         Data[i] = b; //data
  }
  return ((i==N+1) && !crc); //RX or CRC error
}
/* -------------------------------------------------------- */
bool WINAPI RxFrame(DWORD To, unsigned char &ADD, unsigned char &CMD,
unsigned char &N, unsigned char *Data)
{
  int i;
  unsigned char b = 0, crc = CRC_Init; //init CRC
  ComTo.ReadTotalTimeoutConstant = To; //set timeout
  if (!SetCommTimeouts(hCom, &ComTo))
    return 0; //set timeouts error
  for (i = 0; i < 512 && b != FEND; i++)
  {
    if (!RxByteCOM(b)) 
      break; //frame synchronzation
  }
  if (b != FEND) 
    return 0; //timeout or sync error
  DowCRC(b, crc); //update CRC
  N = 0; ADD = 0;
  for (i = -3; i<=N; i++)
  {
    if (!RxByteCOM(b)) 
      break; //timeout error
    if (b == FESC)
    {
      if (!RxByteCOM(b)) 
        break; //timeout error
    }
    else
    {
      if (b == TFEND)
        b = FEND; //TFEND <- FEND
      else
      {
        if (b == TFESC)
          b = FESC; //TFESC <- FESC
        else
          break;
      }
    }
    DowCRC(b, crc); //update CRC
    if (i == -3)
    {
      if ((b & 0x80) == 0) 
      { 
        CMD = b; 
        i++; 
      } //CMD (b.7=0)
      else 
        ADD = b & 0x7F; //ADD (b.7=1)
    }
    else
    if (i == -2)
    {
      if ((b & 0x80) != 0)
         break; //CMD error (b.7=1)
      else
        CMD = b; //CMD
    }
    else
    {
      if (i == -1)
        N = b; //N
      else
      {
       if (i != N)
         Data[i] = b; //data
      }
    }
  }
  return ((i==N+1) && !crc); //RX or CRC error
}

E-mail: info@telesys.ru