Рейтинг@Mail.ru

Как подключить магнитный энкодер AS5600

Print Friendly, PDF & Email

Небольшой отчёт о том, как сделать точный датчик угла с USB-интерфейсом.

Задача была простая на вид: нужен точный датчик угла для одного самодельного устройства. Крутить энкодер с квадратурными выходами — лень, точность хочется градусов в 0,1, а подключать надо к ПК по USB. Перебрав варианты, остановился на AS5600 от ams — бесконтактный магнитный датчик, 12 бит разрешения, I²C, стоит копейки, магнитик в комплекте. А в качестве моста между I²C и USB — FT2232H, у него есть режим MPSSE, который «из коробки» реализует SPI/I²C/JTAG. Была написана простенькая отладочная программа на C#, приложу к статье.

1 Что такое энкодер AS5600

Это крошечная микросхема в корпусе SOIC-8, внутри которой массив Холла и процессор, крутящий CORDIC (Coordinate Rotation Digital Computer). Сверху над ней должен крутиться магнит (обязательно диаметральная намагниченность — один полюс на половине, второй на другой). Микросхема выдаёт абсолютный угол 0–4095 на оборот, что даёт около 0,088° на отсчёт. Обновляется до 1,2 кГц, адрес I²C жёстко зашит как 0x36.

Питание: 3,3 В или 5 В (зависит от версии). Выходы: I²C, аналоговый, PWM (ШИМ). Есть программируемые фильтры, гистерезис, watchdog, low-power режимы и OTP-память на 3 цикла записи настроек.

Ключевые характеристики энкодера AS5600

  • Разрешение: 12 бит (0–4095)
  • Полный диапазон: 0–360°
  • Частота обновления: до 1,2 кГц (в зависимости от настроек фильтров)
  • Напряжение питания: 3,3 В (VDD3V3) или 5 В (VDD5V)
  • Интерфейсы вывода: I²C, аналоговый (ratiometric), PWM
  • Адрес I²C: фиксированный 0x36
  • Программируемые параметры: гистерезис, watchdog, быстрые и медленные фильтры, режимы питания, начальная/конечная точка диапазона
  • Энергонезависимая память (OTP): до 3 циклов записи
  • Корпус: SOIC-8

Китайская белая плата и резистор R4

AS5600 на AliExpress обычно продаётся в виде двух плат: белой прямоугольной с самим датчиком и чёрной круглой с магнитом. Так вот, на белой плате между выводом OUT и землёй (или питанием) стоит резистор R4 на 1 кОм. Он фактически замыкает аналоговый выход на землю или питание, из-за чего некоторые режимы не будут выставляться. Решение — аккуратно выпаять R4. Если используете только I²C — тоже рекомендую выпаять на всякий случай, хуже не будет.

Типичная плата с энкодером AS5600
Типичная плата с энкодером AS5600

На некоторых ревизиях при питании от 5 В ещё и R1 мешает — но это уже по ситуации.

2 Интерфейсы связи энкодера AS5600

I²C — основной рабочий интерфейс. Скорость до 1 МГц (Fast-mode Plus), стандартные подтяжки 4,7 кОм на шине. Аналоговый выход OUT — напряжение пропорционально углу. PWM — частота настраивается, скважность по углу.

Вывод OUT выдаёт напряжение, пропорциональное углу. В режиме OUTS=00b — полный диапазон от 0 до VDD, в режиме OUTS=01b — от 10% до 90% VDD (удобно для работы с АЦП микроконтроллеров, у которых есть «мёртвые зоны» у рельсов питания). Выход ratiometric — напряжение привязано к VDD, что снижает влияние нестабильности питания.

При OUTS=10b вывод OUT работает как ШИМ. Частота задаётся полем PWMF регистра CONF (115, 230, 460 или 920 Гц), скважность пропорциональна углу.

Есть ещё трёхпроводной режим программирования через OUT. Это альтернативный способ конфигурации через вывод OUT без использования I²C. Применяется редко, в основном на этапе производства. Я его не трогал.

Главное — не забыть, что на китайской плате он притянут к земле или питанию через R4, и не удивляться, почему аналоговый режим «не работает». Выпаяли R4 — и всё ок.

3 Карта регистровэнкодера AS5600

АдресИмяЧто внутри
0x00ZMCOСчётчик записей в OTP (0..3)
0x01–0x02ZPOSНачальная позиция
0x03–0x04MPOSКонечная позиция
0x05–0x06MANGДиапазон угла
0x07–0x08CONFКонфигурация (фильтры, гистерезис, режимы)
0x0BSTATUSФлаги магнита: MD, ML, MH
0x0C–0x0DRAW_ANGLEСырой угол (до применения ZPOS/MPOS)
0x0E–0x0FANGLEМасштабированный угол
0x1AAGCАвтоусиление (0–255)
0x1B–0x1CMAGNITUDEАмплитуда сигнала Холла
0xFFBURNКоманда записи в OTP

Регистр STATUS

Регистр STATUS — первый, куда смотрим при отладке. Бит 5 (MD, Magnet Detected) — магнит в зоне энкодера, бит 4 (ML, Magnet Too Weak) — слишком слабо (или далеко), бит 3 (MH, Magnet Too Strong) — слишком сильно (или близко). Если MD=1, а ML и MH=0 — всё хорошо, можно верить показаниям.

Регистр CONF

Регистр CONF (адреса 0x07–0x08) — 16 бит, в нём лежат настройки PWMF, OUTS, HYST, WD, FTH, SFTH, PM. Заводской дефолт — 0x0000. Записывать его просто, но есть нюанс: если хотя бы раз выполнялся BURN CONF (запись в OTP), то некоторые поля, особенно OUTS, становятся read-only навсегда. Перед записью всегда проверяйте ZMCO и делайте обратную вычитку. И да, значение OUTS=3 в обычном AS5600 зарезервировано — не пишите его, микросхема проигнорирует.

БитыПолеРазмерНазначение
15–14PWMF2Частота ШИМ: 0=115 Гц, 1=230 Гц, 2=460 Гц, 3=920 Гц
13–12OUTS2Режим выхода: 00=аналоговый 0…100%, 01=аналоговый 10…90%, 10=ШИМ, 11=зарезервировано
11–10HYST2Гистерезис: 0=выкл, 1=1 LSB, 2=2 LSB, 3=3 LSB
9–8PM2Режим питания: 0=NOM, 1–3=LPM1/LPM2/LPM3
5WD1Watchdog: 0=выкл, 1=вкл
4–2FTH3Порог быстрого фильтра (0=только медленный, 1–6=6..24 LSB)
1–0SF2Порог медленного фильтра: 0=16×, 1=8×, 2=4×, 3=2×

4 Софт:как я оживил энкодер

Софт писал на C# под .NET 4.5, UI — WPF. Основная идея: класс-обёртка над библиотекой ftd2xx_net, которая реализует битбанговый I²C через MPSSE. Ниже — полный код класса FtdiI2cMaster, на нём построено всё остальное.

Код мастера I2C (разворачивается)
using System.Collections.Generic;
using System.Threading;
using FTD2XX_NET;

namespace As5600Enkbdr
{
    /// <summary>
    /// I2C мастер на базе MPSSE FT2232H.
    /// Реализация по Application Note AN_255 от FTDI.
    /// SCL  = ADBUS0 (TCK)
    /// SDAo = ADBUS1 (TDI/DO)
    /// SDAi = ADBUS2 (TDO/DI)
    /// </summary>
    public sealed class FtdiI2cMaster
    {
        private static readonly FTDI _ftdi = new FTDI();

        public int GetNumberOfDevices()
        {
            uint n = 0;
            var s = _ftdi.GetNumberOfDevices(ref n);
            return (int)n;
        }

        // MPSSE Command Opkbds
        private const byte MSB_FALLING_EDGE_CLOCK_BYTE_OUT = 0x11;
        private const byte MSB_RISING_EDGE_CLOCK_BIT_IN    = 0x22;
        private const byte MSB_RISING_EDGE_CLOCK_BYTE_IN   = 0x20;
        private const byte MSB_FALLING_EDGE_CLOCK_BIT_OUT  = 0x13;
        private const byte SET_DATA_BITS_LOW_BYTE          = 0x80;
        private const byte SEND_IMMEDIATE                  = 0x87;

        // Pin Masks (AD0 = SCL, AD1 = SDA_OUT, AD2 = SDA_IN)
        private const byte PIN_SCL     = 0x01;
        private const byte PIN_SDA_OUT = 0x02;
        private const byte PIN_SDA_IN  = 0x04;

        public bool Open(uint deviceIndex = 0, uint clockSpeedHz = 100000)
        {
            if (_ftdi.OpenByIndex(deviceIndex) != FTDI.FT_STATUS.FT_OK)
                return false;

            _ftdi.ResetDevice();
            _ftdi.Purge(FTDI.FT_PURGE.FT_PURGE_RX | FTDI.FT_PURGE.FT_PURGE_TX);
            _ftdi.SetTimeouts(1000, 1000);
            _ftdi.SetLatency(2); // Low latency for faster I2C turnaround

            // Reset and enable MPSSE mode
            _ftdi.SetBitMode(0x00, FTDI.FT_BIT_MODES.FT_BIT_MODE_RESET);
            Thread.Sleep(20);
            _ftdi.SetBitMode(0x00, FTDI.FT_BIT_MODES.FT_BIT_MODE_MPSSE);
            Thread.Sleep(20);

            // Configure MPSSE:
            //  - Disable divide-by-5 (60MHz base clock)
            //  - Disable adaptive clocking
            //  - Enable 3-phase clocking (required for I2C!)
            uint clockDivisor = (60000000 / (clockSpeedHz * 2)) - 1;
            byte[] setupCommands = new byte[]
            {
                0x8A,                                                         // Disable clock divide by 5
                0x97,                                                         // Turn off adaptive clocking
                0x8C,                                                         // Enable 3-phase data clocking
                0x86, (byte)(clockDivisor & 0xFF),
                      (byte)((clockDivisor >> 8) & 0xFF),        // Set clock divisor
                0x85                                                          // Disable loopback
            };
            WriteBytes(setupCommands);
            SetIdleState();
            return true;
        }

        private void SetIdleState()
        {
            byte[] idle = { SET_DATA_BITS_LOW_BYTE,
                            PIN_SCL | PIN_SDA_OUT,
                            PIN_SCL | PIN_SDA_OUT };
            WriteBytes(idle);
        }

        public void SendStart()
        {
            var cmds = new List<byte>();

            // Ensure SCL & SDA are High
            for (int i = 0; i < 4; i++)
                cmds.AddRange(new byte[] { SET_DATA_BITS_LOW_BYTE,
                                           PIN_SCL | PIN_SDA_OUT,
                                           PIN_SCL | PIN_SDA_OUT });

            // Pull SDA Low while SCL stays High (Start Condition)
            for (int i = 0; i < 4; i++)
                cmds.AddRange(new byte[] { SET_DATA_BITS_LOW_BYTE,
                                           PIN_SCL,
                                           PIN_SCL | PIN_SDA_OUT });

            // Pull SCL Low to prepare for data transmission
            cmds.AddRange(new byte[] { SET_DATA_BITS_LOW_BYTE, 0x00,
                                       PIN_SCL | PIN_SDA_OUT });
            WriteBytes(cmds.ToArray());
        }

        public void SendStop()
        {
            var cmds = new List<byte>();

            // Ensure SCL Low, SDA Low
            for (int i = 0; i < 4; i++)
                cmds.AddRange(new byte[] { SET_DATA_BITS_LOW_BYTE, 0x00,
                                           PIN_SCL | PIN_SDA_OUT });

            // Release SCL High while SDA stays Low
            for (int i = 0; i < 4; i++)
                cmds.AddRange(new byte[] { SET_DATA_BITS_LOW_BYTE, PIN_SCL,
                                           PIN_SCL | PIN_SDA_OUT });

            // Release SDA High while SCL is High (Stop Condition)
            for (int i = 0; i < 4; i++)
                cmds.AddRange(new byte[] { SET_DATA_BITS_LOW_BYTE,
                                           PIN_SCL | PIN_SDA_OUT,
                                           PIN_SCL | PIN_SDA_OUT });
            WriteBytes(cmds.ToArray());
        }

        /// <summary>
        /// Writes a single byte over I2C and returns true if ACK was received.
        /// </summary>
        public bool WriteByte(byte data)
        {
            var cmds = new List<byte>
            {
                // Clock out 8 bits on falling edge
                MSB_FALLING_EDGE_CLOCK_BYTE_OUT, 0x00, 0x00, data,
                // Release SDA (set AD1 as input/tri-state) so slave can pull it low for ACK
                SET_DATA_BITS_LOW_BYTE, 0x00, PIN_SCL,
                // Clock in 1 bit (ACK/NACK) on rising edge
                MSB_RISING_EDGE_CLOCK_BIT_IN, 0x00,
                // Force immediate flush back to PC
                SEND_IMMEDIATE
            };
            WriteBytes(cmds.ToArray());

            byte[] rxBuffer = ReadBytes(1);

            // Restore SDA pin as output (Low)
            WriteBytes(new byte[] { SET_DATA_BITS_LOW_BYTE, 0x00,
                                    PIN_SCL | PIN_SDA_OUT });

            // Bit 0 is the ACK bit (0 = ACK, 1 = NACK)
            return (rxBuffer[0] & 0x01) == 0;
        }

        /// <summary>
        /// Reads a single byte over I2C and sends ACK (true) or NACK (false).
        /// </summary>
        public byte ReadByte(bool sendAck)
        {
            byte ackBit = sendAck ? (byte)0x00 : (byte)0x80; // MSB first
            var cmds = new List<byte>
            {
                // Set SDA as input (tri-state) so slave can drive it
                SET_DATA_BITS_LOW_BYTE, 0x00, PIN_SCL,
                // Clock in 8 bits on rising edge
                MSB_RISING_EDGE_CLOCK_BYTE_IN, 0x00, 0x00,
                // Set SDA back as output to send ACK/NACK bit
                SET_DATA_BITS_LOW_BYTE, 0x00, PIN_SCL | PIN_SDA_OUT,
                // Clock out 1 bit (ACK or NACK)
                MSB_FALLING_EDGE_CLOCK_BIT_OUT, 0x00, ackBit,
                SEND_IMMEDIATE
            };
            WriteBytes(cmds.ToArray());

            byte[] rxBuffer = ReadBytes(1);
            return rxBuffer[0];
        }

        private void WriteBytes(byte[] buffer)
        {
            uint bytesWritten = 0;
            _ftdi.Write(buffer, buffer.Length, ref bytesWritten);
        }

        private byte[] ReadBytes(uint count)
        {
            byte[] buffer = new byte[count];
            uint bytesRead = 0;
            _ftdi.Read(buffer, count, ref bytesRead);
            return buffer;
        }

        public void Close()
        {
            _ftdi.Close();
        }
    }
}

Ключевые моменты

  • Трёхфазное тактирование (команда 0x8C) — без неё на частотах выше ~100 кГц начинаются нарушения setup/hold таймингов I²C. /li>
  • Latency timer = 2 мс — если оставить дефолтные 16 мс, каждая транзакция будет ждать полного таймаута USB-буфера, и опрос на 20 Гц превратится в мучение.
  • SEND_IMMEDIATE (0x87) — после команд, от которых ждём ответ (чтение ACK, чтение байта), обязательно пихаем эту команду, иначе FT2232H будет держать ответ в буфере до следующего обмена.
  • Направление SDA — в момент чтения ACK или байта от slave вывод SDA_OUT отпускается (через SET_DATA_BITS_LOW_BYTE с нужной маской направления), чтобы ведомый мог сам притянуть линию к земле.

Класс As5600Reader — надстройка над I²C

Поверх FtdiI2cMaster живёт As5600Reader, который знает про адрес 0x36 энкодера AS5600, про repeated start и про то, что 16-битные регистры читаются парой байт с автоинкрементом адреса. Там же — INotifyPropertyChanged, чтобы WPF-окно само подхватывало состояние IsConnected, и методы чтения угла, статуса магнита, конфигурации.

Главное: всегда проверяйте ACK после каждого байта. Если адрес не отозвался — не надо продолжать транзакцию, лучше бросить исключение и переподключиться. Иначе MPSSE уйдёт в рассинхрон, и следующие команды поедут.

Внешний вид отладочной программы для AS5600
Внешний вид отладочной программы для AS5600

5 3D-печатныйкорпус

Чтобы вся эта конструкция не болталась на столе и магнит всегда был на правильном расстоянии от датчика, был спроектирован корпус и распечатан на 3D-принтере. В корпусе предусмотрены посадочные места под белую плату AS5600, отверстие под магнит на оси (использую 15-мм подшипник). Зазор между магнитом и корпусом микросхемы — около 0,5 мм, этого хватает для стабильных показаний без перекоса. При большем зазоре штатного магнита мало, и он всё время выставляет флаг Magnet Too Low, хотя показания угла при этом всё равно измеряет довольно чётко.

Самодельный корпус для платы с энкодером AS5600
Самодельный корпус для платы с энкодером AS5600

Итого

AS5600 — отличная штука за свои деньги. Если не считать пары аппаратных сюрпризов от китайской платы и необходимости внимательно читать про MPSSE, всё собирается за вечер. Точность в районе 0,1° достигается без танцев с бубном, корпус на 3D-принтере делает конструкцию законченной, а FT2232H даёт честный USB без всяких Arduino-посредников.

Также в приложении к статье лежит пример диаграммы обмена с энкодером AS5600. Открывается программой Saleae Logic.

Последнее изменениеВторник, 17 Ноябрь 2026 13:28 Прочитано 10 раз
Теги :

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

Поделиться

Print Friendly, PDF & Email

Другие материалы в этой категории:

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