Расчет контрольной суммы

[Demagog]

Работаю с прибором ПЧС-1 фирмы "Контакт" по интерфейсу RS-485. Пока на стадии планирования и подготовки. Мое будущее приложение будет отправлять запросы по следующему шаблону: Адрес, код команды, размер блока данных n+1, данные 1, данные 2...Данные n. КСмл, КСст.

Остановился на подсчете контрольной суммы CRC-16. В описании прибора есть пример запроса: 255 164 4 188 0 2 36 216. Последние два байта - контрольная сумма. Я процедурку написал, но для этого примера она мне считает контрольную сумму не верно. Всю голову сломал - добрые люди, помогите исправить неработающую процедуру)

procedure CRC16 (data: array of byte; size: byte; var  crc1, crc2: byte);
var
    crc: word;
    n,b: byte;
    ok: boolean;
begin
    CRC:=$ffff;
    n:=1;
    b:=0;
    REPEAT
      CRC:=data[n] xor (CRC and $ff);
      b:=0;
          REPEAT
          if (CRC and 1)=1 then ok:=true else ok:=false;  
          CRC:=CRC shr 1; 
          if ok then CRC:= CRC XOR $A001;  
          b:=b+1;
          UNTIL b>7;
      n:=n+1;
    UNTIL n>size;
    ShowMessage(inttostr(crc));
    crc1:=crc and $FF; 
    crc2:=(crc shr 8) and $FF; 
end;

procedure TForm1.Button2Click(Sender: TObject); 
var
    data: array [1..8] of byte;
    i: integer;
begin
    edit1.Clear;
    data [1]:=255;
    data [2]:=164;
    data [3]:=4;
    data [4]:=188;
    data [5]:=0;
    data [6]:=2;
    CRC16(data,6,data[7],data[8]);
    for i:=1 to 8 do
        edit1.Text:=edit1.Text+inttostr(data[i])+'  ';
end;

В примере получается КСмл=36, КСст=216, а у меня 0 и 51.... правило расчета КС прилагаю в джипеге