Двухотсчетный СКВТ, алгоритм обработки Опции

[Andrew-S]

Добрый день! Применяю синусно-косинусный датчик СКТД-6465. У него есть точная и грубая обмотки, коэффициент 32. С датчика получаю sin_t, cos_t, sin_g, cos_g в виде 16 разрядных чисел, вычисляю два угла - точный и грубый и преобразую эти два отсчета в результирующий угол. С коротким кабелем до датчика алгоритм работает прекрасно. Проблема возникает при увеличении длины кабеля. По кодам наблюдаю что алгоритм "склеивания" сбоит на границах точного отсчета где нужно принимать решение о секторе результирующего угла (угол резко переходит в соседний сектор). Может кто сталкивался подскажите как с этим бороться программно? Или это аппаратная проблема?

[Yura_K]

Код сшивки на ассемблере AVR

Код

; ГО - CH DH DL - Старш. Сред. Младш.
; ТО - CL AH AL - Старш. Сред. Младш.
;-----------------------------"сшивка" кодов точного и грубого каналов
;   согласование отсчетов
     lsl    DL               ;   сдвиг кода ГО на 5 разрядов
     rol    DH
     rol    CH
     lsl    DL
     rol    DH
     rol    CH
     lsl    DL
     rol    DH
     rol    CH
     lsl    DL
     rol    DH
     rol    CH
     lsl    DL
     rol    DH
     rol    CH
     mov    BH,CH
     andi   CH,0x07
     ldi    XH,0
     ldi    XL,KodTO_Lo
     ld     AL,X+
     ld     AH,X+
     ld     CL,X
     andi   CL,0x07
     ldi    BL,0x08
     sub    CH,CL
     brcs   sh0
     cpi    CH,0x04
     brcs   sh1
     add    BH,BL           ;   добавить единицу в код ГО
     rjmp   sh1
sh0: com    CH
     cpi    CH,0x04
     brcs   sh1
     sub    BH,BL           ;   вычесть единицу из кода ГО
sh1: andi   BH,0xf8
     or     BH,CL