Рейтинг@Mail.ru

Чтение энкодера ИДМ39А по BiSS-C через микросхемы Ftdi

aave автор: aave
Be the first to comment! Электроника
Print Friendly, PDF & Email

Как подружить промышленный энкодер с дифференциальным интерфейсом BiSS-C и обычным ПК, не покупая специализированный контроллер. С подводными камнями MPSSE, «магической» константой в CRC и собственным парсером для Saleae Logic 2.

Задача

Нужно было считать абсолютные показания углового положения и количества оборотов вала с промышленного энкодера ИДМ39А-4096-MT-BISS. Датчик выдаёт данные по цифровому интерфейсу BiSS-C, но в ПК нет ни одного готового порта BiSS-C, но есть USB. Готовые шлюзы BiSS-C↔USB стоят неприлично дорого, а задача разовая. Решено было собрать собственный интерфейс на доступных компонентах.

1Многооборотный энкодер ИДМ39А-4096-MT-BISS

ИДМ39А-4096-MT-BISS – это многооборотный абсолютный энкодер с разрешением 4096 позиций на оборот (12 бит) и счётчиком до 5400 оборотов. Ключевые характеристики:

  • Диапазон измерения углов: 0…360°
  • Информационная ёмкость: 12 бит на оборот
  • Количество оборотов: 5400
  • Погрешность: ±0,5°
  • Максимальная частота интерфейса BiSS: 4 МГц
  • Период обновления: не более 50 мкс
  • Ток потребления: до 120 мА
  • Питание: 5 В
  • Интерфейс: BiSS-C, дифференциальный RS-422

Физически от энкодера отходят восемь проводов (согласно официальной документации – шесть):

№ОбозначениеНазначениеЦвет
1+Питание 5 Вкрасный
2DPВыход данных, положительныйбелый
3DNВыход данных, отрицательныйсерый
4CPВход тактовой частоты, положительныйзелёный
5CNВход тактовой частоты, отрицательныйкоричневый
6GОбщий (0 В)чёрный
7 Установка нуляжёлтый
8 Установка направленияоранжевый

В документации не описано как делать установку нуля и направления. Из разрозненной переписки с производителем узнал следующее. Чтобы сделать сброс угла и счётчика оборотов, достаточно на 1 сек заземлить жёлтый провод (проверено: работает). Установка направления хитрее: на две минуты заземлить оранжевый провод (это я не проверял).

Также энкодер имеет окошко, в котором виден текущий статус устройства по световой индикации. Энкодер весело мигает разными цветами, но что означают разные цвета и периодичность в документации не указано. Эмпирически – при чтении показаний энкодер ИДМ39А мигает светло-голубым, в режиме простоя циклично мигает сериями по 3 вспышки разными цветами.

2Дифференциальный последовательный протокол BiSS-C

BiSS-C (Bidirectional Synchronous/Serial — Compact) — это простой полудуплексный последовательный интерфейс, разработанный для датчиков. Мастер (контроллер) генерирует такты, слейв (энкодер) отвечает кадром фиксированной длины. Никаких линий запроса, никаких адресов — только такты и данные.

Кадр ИДМ39А содержит 37 бит (в спецификации указано «35 бит»; документация здесь особенно доставляет):

Бит3635343332…2019…8765…0
ПолеMSB=1Ack=0Start=1CDSTURNS[12:0]ANGLE[11:0]EWCRC
Длина11111312116

TURNS – счётчик оборотов, от 0 до 5399.

ANGLE – текущий код угла поворота. Для перевода в градусы: ANGLE / 4096 * 360°.

E – это флаг ошибки определения угла (инверсный, «1» – нет ошибки).

W – предупреждение о выходе амплитуды сигнала сенсорной системы за пределы диапазона нормальной работы (большой или малый зазор между статором и ротором).

Здесь стоит остановиться на важном моменте: поле TURNS[12:0] — это 13 бит, а не 12 (как указано в таблице в официальной документации). Иначе невозможно закодировать заявленные 5400 оборотов (12 бит дали бы максимум 4095). Эта деталь стоила мне пары часов отладки, о чём ниже.

CRC считается полиномом X^6 + X^1 + X^0 (0x43) с инверсией результата. Окно расчёта — биты данных от старшего бита счётчика оборотов до W включительно.

3Выбор интерфейса: микросхема FT2232D

Для связи с ПК я выбрал микросхему FT2232D. Причины:

  • работает с 5-вольтовой логикой (в отличие от FT2232H, который 3,3 В) — это важно, так как энкодер питается от 5 В;
  • поддерживает режим MPSSE — аппаратный движок для SPI/I²C/JTAG, который позволяет генерировать такты и читать данные на скоростях до 6 МГц без участия процессора;
  • есть готовая библиотека FTD2XX.NET для .NET;
  • распространена и недорога.

Однако FT2232D выдаёт однополярные TTL-сигналы, а энкодер ждёт дифференциальные RS-422. Напрямую соединять их нельзя — ни по уровням, ни по принципу передачи.

4Схема подключения через RS-422 драйвер

Между FT2232D и энкодером необходим полнодуплексный RS-422 трансивер. Я использовал связку на базе MAX485. Схема получилась такая:

  • ADBUS0 (TCK/SCLK) FT2232D → вход DI передатчика тактов трансивера → выходы CP/CN энкодера;
  • выход RO приёмника данных трансивера → ADBUS2 (TDO/MISO) FT2232D; входы A/B приёмника ← DP/DN энкодера;
  • ADBUS1 (TDI/MOSI) остаётся в покое — BiSS-C полудуплексный, мастер ничего не пишет в линию данных;
  • DE трансивера подтянут к VCC, RE — к GND (приёмник и передатчик всегда активны);
  • общая земля источника питания 5 В, FT2232D и энкодера обязательно соединяется в одной точке.

Питание 5 В для энкодера (до 120 мА) лучше брать от внешнего стабилизатора, а не с VCC самого модуля FT2232D: USB-порт не всегда вытягивает такую нагрузку стабильно.

Драйверы RS-422 (на MAX485) для связи с энкодером ИДМ39А
Драйверы RS-422 (на MAX485) для связи с энкодером ИДМ39А

5Движок MPSSE: команды и особенности

Весь обмен с MPSSE идёт через FT_Write / FT_Read библиотеки FTD2XX. Первым делом микросхему нужно перевести в режим MPSSE и настроить такты:

' Инициализация MPSSE
ftdi.SetBitMode(0, FT_BIT_MODES.FT_BIT_MODE_RESET)
ftdi.SetBitMode(0, FT_BIT_MODES.FT_BIT_MODE_MPSSE)

' Делитель тактовой частоты. Базовая частота 60 МГц.
' Формула: TCK = 60 МГц / (2 * (Divisor + 1))
' Для 100 кГц: Divisor = 299 = 0x012B
Dim initBytes As Byte() = {
    &H86, &H2B, &H01,  ' Set TCK divisor → 100 кГц
    &H80, &H00, &H0B,  ' ADBUS0(TCK)=Out, ADBUS1(TDI)=Out, ADBUS2(TDO)=In
    &H82, &H00, &H00   ' ACBUS все входы
}

Для чтения кадра от энкодера нужна одна команда, которая одновременно генерирует 40 тактов и читает 5 байт с TDO. На TDI ничего не пишется — мастер в BiSS-C молчит.

Я перепробовал несколько вариантов и пришёл к такой паре команд:

' 0x20 — Clock Data Bytes In, -VE Clock, LSB First
' 0x04, 0x00 — длина = 4 + 1 = 5 байт (40 бит)
' 0x87 — Send Immediate (КРИТИЧНО!)
Dim readCmd As Byte() = { &H20, &H04, &H00, &H87 }

Без байта 0x87 FTDI не отправляет прочитанные данные на хост сразу, а копит их в буфере до 64 байт или до USB-таймаута (16 мс). Из-за этого у меня сначала приходило то 40 бит, то 64, то 24 — данные от нескольких вызовов склеивались в буфере. Send Immediate решает эту проблему.

Читаем ровно 5 байт:

ftdi.Purge(FT_PURGE_RX Or FT_PURGE_TX)
ftdi.Write(readCmd, readCmd.Length, bytesWritten)

' Ждём появления 5 байт в RX-буфере
Dim rxBytes As UInteger = 0
Do While rxBytes < 5
    Await Task.Delay(1)
    ftdi.GetQueueStatus(rxBytes)
Loop

Dim buffer(4) As Byte
ftdi.Read(buffer, 5, bytesRead)

6Сборка кадра и разбор полей

Из 40 прочитанных битов полезными являются младшие 37 — старшие 3 отбрасываются маской:

Dim raw40 As ULong = (CULng(buffer(0)) << 32) Or
                     (CULng(buffer(1)) << 24) Or
                     (CULng(buffer(2)) << 16) Or
                     (CULng(buffer(3)) << 8) Or
                     CULng(buffer(4))

Dim data37 As ULong = raw40 And &H1FFFFFFFFFUL   ' маска на 37 бит

' Проверка префикса кадра
Dim msb   = (data37 >> 36) And 1
Dim ack   = (data37 >> 35) And 1
Dim start = (data37 >> 34) And 1
If msb <> 1 OrElse ack <> 0 OrElse start <> 1 Then
    ' кадр невалиден
End If

' Разбор полей
turns = CInt((data37 >> 20) And &H1FFF) ' 13 бит (биты 32…20)
angle = CInt((data37 >> 8)  And &HFFF)  ' 12 бит (биты 19…8)
hasError   = ((data37 >> 7) And 1) = 0      ' E инверсный
hasWarning = ((data37 >> 6) And 1) = 1
crcRx = CByte(data37 And &H3F)

7Расчёт контрольной суммы CRC-6

Реализация CRC по спецификации — полином 0x43, init=0, инверсия результата. Но работала она только при малых оборотах. На конце диапазона (примерно от 4096) CRC переставал сходиться.

Эмпирически я обнаружил, что если к рассчитанному CRC применить XOR с числом 0b1001 = 9, то всё сходится. Но хардкодить константу — плохое решение. Разобраться помогла математика:

CRC линеен по данным. Если пропустить один бит в фиксированной позиции, разница между правильным и «обрезанным» CRC — это вклад единичного бита на этой позиции, то есть x^n mod p(x). Для бита 32 и полинома x^6 + x + 1:

x^32 mod (x^6 + x + 1) = x^3 + 1 = 0b001001 = 9

Ровно та константа, что я нашёл эмпирически! Вывод: в окне расчёта CRC не хватало бита 32 — старшего бита поля TURNS[12] (на тот момент я ещё не знал, что TURNS 13-битный, а не 12-битный, как указано в официальной документации). Пока оборотов было меньше 4096, этот бит был равен нулю и не влиял на CRC. Как только вал перешагивал отметку 4096 — появлялась ошибка ровно на 9.

Собственно, функция расчёта CRC-6 для энкодера ИДМ39А:

Private Shared Function CalculateBissCrc6(data As ULong) As Byte
    
        Const POLYNOM As Byte = &H3 ' X^6 + X^1 + X^0 = 1000011 - без старшего бита
        Const MASK As Byte = &H3F

        Dim crc As Byte = 0
        For i As Integer = 32 To 6 Step -1

            Dim bit As Byte = CByte((data >> i) And 1UL)
            Dim msb As Byte = CByte((crc >> 5) And 1)

            crc = (crc << 1) And MASK 'сдвигаем и оставляем 6 бит

            ' XOR с полиномом, если старший бит CRC == 1
            If ((msb Xor bit) <> 0) Then
                crc = crc Xor POLYNOM
            End If
        Next

        ' Инвертируем результат согласно спецификации
        crc = crc Xor MASK

        Return crc
		
End Function

8 Отладка через Saleae Logic 2

Без логического анализатора отладка BiSS-C превращается в гадание. У меня есть Saleae Logic 2; его двух каналов (SCLK + MISO) хватило, чтобы снять весь кадр.

Встроенный SPI-анализатор Saleae корректно нарезал поток на байты, но интерпретировать их как BiSS-кадры не умел. Пришлось написать собственный High Level Analyzer (HLA) на Python. HLA в Logic 2 — это надстройка, которая получает на вход фреймы от низкоуровневого анализатора (в нашем случае SPI) и выдаёт свои, уже осмысленные.

Ключевые моменты реализации:

  • HLA не имеет прямого доступа к цифровым каналам — только через LLA (SPI);
  • объекты времени в новых версиях Saleae — это SaleaeTime, а не float; арифметика с ними работает через операторы и to_nanoseconds();
  • SPI-анализатор отдаёт данные в ключе miso как bytearray;
  • автоматический поиск выравнивания по префиксу 1-0-1 и CRC снимает проблему «сдвига на 4/5 бит».
Код парсера энкодера ИДМ39А (разворачивается)
from saleae.analyzers import HighLevelAnalyzer, AnalyzerFrame, ChoicesSetting

MASK37 = 0x1FFFFFFFFF  # 37 бит


class Hla(HighLevelAnalyzer):
    """
    BiSS-C для ИДМ39А-4096-MT-BISS. Вход: SPI-анализатор (MISO = линия SLO).

    Кадр 37 бит (нумерация по PDF, MSB = 35):
      [36]=1  [35]=Ack(0)  [34]=Start(1)  [33]=CDS
      [32..20]=TURNS(12)  [19..8]=ANGLE(12)  [7]=E(инв.)  [6]=W  [5..0]=CRC6
    CRC: полином X^6+X^1+X^0 (0x43), инвертированный, считается по битам 32..6.
    """

    alignment = ChoicesSetting(choices=('Auto (поиск 1-0-1 + CRC)', 'Fixed (отбросить 4 бита)'))
    crc_check = ChoicesSetting(choices=('On', 'Off'))

    result_types = {
        'biss_frame': {
            'format': '{{data.status}} Turns={{data.turns}}; Angle={{data.angle_deg}}° {{data.flags}}'
        },
        'biss_bad': {
            'format': 'BiSS: {{data.reason}}'
        },
    }

    # Пауза между посылками. По PDF таймаут t_out = 1..20 мкс,
    # значит разрыв больше 1ms — это точно новый кадр.
    GAP_S = 1e-3 #1 ms

    def __init__(self):
        self._bits = []
        self._start = None
        self._last_end = None

    def _reset(self):
        self._bits = []
        self._start = None

    def decode(self, frame: AnalyzerFrame):
        if frame.type == 'enable':
            self._reset()
            return None

        if frame.type != 'result':
            return None

        raw_bytes = frame.data.get('miso')
        if raw_bytes is None:
            return None
        if isinstance(raw_bytes, int):
            raw_bytes = bytes([raw_bytes])

        for byte in raw_bytes:
            for i in range(7, -1, -1):
                self._bits.append((byte >> i) & 1)
                if self._start is None:
                    self._start = frame.start_time

        # Когда накопили достаточно битов, пытаемся найти валидный кадр
        if len(self._bits) >= 40:
            result = self._process(frame.end_time)
            if result is not None:
                # Нашли валидный кадр — сбрасываем буфер
                self._reset()
                return result
            else:
                # Не нашли — сдвигаемся на 1 бит и пробуем снова
                self._bits.pop(0)
                if len(self._bits) == 0:
                    self._start = None

        return None

    # ---------- разбор кадра ----------

    def _process(self, end_time):
        raw40 = 0
        for b in self._bits[-40:]:
            raw40 = (raw40 << 1) | b

        candidates = []
        if self.alignment.startswith('Fixed'):
            candidates = [raw40 & MASK37]
        else:
            for shift in (4, 3, 2, 1, 0):
                candidates.append((raw40 >> shift) & MASK37)

        chosen = None
        for cand in candidates:
            prefix_ok = (((cand >> 36) & 1) == 1 and
                         ((cand >> 35) & 1) == 0 and
                         ((cand >> 34) & 1) == 1)
            crc_ok = ((cand & 0x3F) == self._crc6(cand))
            if prefix_ok and (crc_ok or self.crc_check == 'Off'):
                chosen = cand
                break
        
        if chosen is None:
            # Кадр невалиден — возвращаем None, чтобы сдвинуться на бит
            return None

        raw = chosen
        msb    = (raw >> 36) & 1
        ack    = (raw >> 35) & 1
        start  = (raw >> 34) & 1
        cds    = (raw >> 33) & 1
        turns  = (raw >> 20) & 0x1FFF
        angle  = (raw >> 8) & 0xFFF
        e_bit  = (raw >> 7) & 1
        w_bit  = (raw >> 6) & 1
        crc_rx = raw & 0x3F
        crc_calc = self._crc6(raw)

        prefix_ok = (msb == 1 and ack == 0 and start == 1)
        crc_ok = (crc_rx == crc_calc)
        has_error = (e_bit == 0)
        has_warning = (w_bit == 1)
        angle_deg = angle * 360.0 / 4096.0

        flags = ''
        if has_error:
            flags += '[E]'
        if has_warning:
            flags += '[W]'
        #if self.crc_check == 'On' and not crc_ok:
            flags += '[CRC rx={:02X} calc={:02X}]'.format(crc_rx, crc_calc)

        ok = prefix_ok and (crc_ok or self.crc_check == 'Off')

        return AnalyzerFrame('biss_frame', self._start, end_time, {
            'status': 'OK' if ok else 'ERR',
            'turns': turns,            
            'angle_deg': round(angle_deg, 2),
            'flags': flags,
            'raw_hex': '{:09X}'.format(raw),
            'raw_bin': '{:037b}'.format(raw),
            'cds': cds,
            'e_bit': e_bit,
            'w_bit': w_bit,
            'crc_rx': '{:02X}'.format(crc_rx),
            'crc_calc': '{:02X}'.format(crc_calc),
            'crc_ok': 'yes' if crc_ok else 'no',
            'prefix_ok': 'yes' if prefix_ok else 'no',
        })

    @staticmethod
    def _crc6(raw37: int) -> int:
        POLY = 0x03
        MASK = 0x3F 
        crc = 0
        for i in range(32, 5, -1):
            bit = (raw37 >> i) & 1
            feedback = ((crc >> 5) & 1) ^ bit
            crc = (crc << 1) & MASK
            if feedback:
                crc ^= POLY
        return crc ^ 0x3F

Скачать парсер для Saleae Logic можно с GitHub.

9 Подводные камни, о которые я набил шишки

  1. Буферизация MPSSE. Без Send Immediate (0x87) FTDI копит данные и отдаёт их пачками. Всегда добавляйте 0x87 в конец команды чтения.
  2. Длина посылки в документации. В PDF написано «35 бит», но в действительности – 37 бит. Всегда проверяйте арифметику таблицы, а не верьте заголовку.
  3. TURNS — 13 бит, а не 12. Иначе на 4096-м обороте счётчик обнулится, а CRC перестанет сходиться.
  4. Бит 32 входит в CRC. Окно расчёта — 32…6, а не 31…6.
  5. Общая земля. Без соединения GND источника питания 5 В, FT2232D и энкодера дифференциальный приёмник трансивера не сможет корректно определять уровни.
  6. Питание 120 мА. Не тяните с USB-порта через FT2232D — используйте отдельный стабилизатор.

В приложении к статье я положил архив, в котором программа для чтения показаний энкодера ИДМ39А через микросхемы FTDI, а также парсер для логического анализатора.

Внешний вид программы считывания показаний энкодера ИДМ39А и парсера с типичной временной диаграммой

Для использования программы в операционной системе должен быть установлен драйвер для микросхем фирмы FTDI.

10 Итоги и выводы

Связка FT2232D + RS-422 трансивер + FTD2XX + собственный HLA-парсер обошлась в копейки и закрыла задачу полностью. Главное, что я вынес из этой работы: в BiSS-C, как и в любом «простом» последовательном протоколе, дьявол живёт в деталях — в количестве бит окна CRC, в длине поля счётчика оборотов, в команде Send Immediate. И без логического анализатора отладка превращается в мучение.

Если у вас похожая задача — не покупайте готовый шлюз BiSS-C↔USB, пока не попробуете собрать его сами. Получится дешевле, а понимание протокола останется с вами надолго.

Энкодер ИДМ39А и FT2232D
Энкодер ИДМ39А и FT2232D

Download attachments:

Last modified onПятница, 13 Ноябрь 2026 19:29 Read 228 times
Ключевые слова: :

Поблагодарить автора:

Поделиться

Print Friendly, PDF & Email