- PVSM.RU - https://www.pvsm.ru -

Подключение STM32 к аппаратуре радиоуправления

Подключение STM32 к аппаратуре радиоуправления - 1
Понадобилось мне реализовать дистанционное управление несколькими двигателями постоянного тока.
В магазинах доступны готовые комплекты радиоуправления для разных ездящих-летающих игрушек и «не игрушек», и появилось желание использовать именно такое управление.
Сигналы на выходе приёмника такого комплекта — это импульсы для управления сервомашинками,
и задача сводится к тому, чтобы измерить длительность имульса 0,8..2,3 мс в каждом из шести каналов, затратив как можно меньше ресурсов контроллера.
Дальше описано как реализовано измерение длительности импульсов с шести каналов, используя особенности периферии STM32 микроконтроллеров.

Железо, на котором проводилась отладка — аппаратура радиоуправления HobbyKing HK-T6A и контроллер STM32F100C8T.

На выходе приёмника имеем такие сигналы:
Подключение STM32 к аппаратуре радиоуправления - 2

Очевидное решение — запустить 6 таймеров и каждый канал измерять отдельным таймером.
По переднему фронту импульса сбрасываем таймер, начинаем отсчёт. По заднему фронту смотрим сколько таймер насчитал с момента сброса, это и будет длительность импульса.

Для сокращения количества задействованных таймеров попробуем завести несколько каналов на один таймер, но так, чтобы было как можно меньше программной обработки.

Будем использовать режим таймера для работы с Hall sensor.
Бесколлекторные двигатели иногда в качестве датчика положения ротора имеют три датчика холла, установленных со смещением. Картинка ниже даёт наглядное изображение как это происходит.
Подключение STM32 к аппаратуре радиоуправления - 3

Для обработки датчика холла бесколлекторного электродвигателя некоторые таймеры в STM32 могут быть настроены таким образом, что:
— по переднему фронту на любом из трёх входов CC1, CC2, CC3 таймер сбрасывается,
— по заднему фронту, на любом из этих входов, в регистре capture compare CCMR1 защёлкивается значение счётчика таймера — по факту длительность импульса.

Таким образом, в одном регистре последовательно имеем значения длительности импульсов по трём каналам.

Программно можно как-то разделить эти значения, но проще оставить только два канала ch2 и ch3, значения от них будут защёлкиваться в CCR2 и CCR3 регистрах, а сбрасываться таймер будет по переднему фронту на любом из этих каналов.
Пин, на который назначен вход ch1, настроим на выход, чтобы не ловить помехи на неиспользуемом входе.

На рисунке ниже: красная стрелочка показывает путь сигнала сброса таймера, зелёные стрелочки — путь сигнала защёлкивания значения таймера.
Подключение STM32 к аппаратуре радиоуправления - 4

В итоге, для чтения 6 каналов будем использовать 3 таймера, и без дополнительных программных ухищрений, в регистрах CCR таймеров иметь требуемые значения.

Небольшой сюрприз.
Когда это всё уже было реализовано, но я в очередной раз забыл распиновку выхода приёмника, то при поиске в интернете наткнулся на интересную картинку.
Подключение STM32 к аппаратуре радиоуправления - 5
Взято отсюда [1]

Поизучав интернет, сделал для себя открытие.
Оказалось, что вход, используемый для питания и привязки приёмника к передатчику, на выходе имеет сигнал, объединяющий все 6 выходов.

Только измерять надо не длительность импульсов, а время между импульсами.
Подключение STM32 к аппаратуре радиоуправления - 6

Называется он PPM [2] и широко используется для подключения аппаратуры радиоуправления к компьютеру в качестве джойстика для симулятора (через адаптер, разумеется).
Есть разные версии адаптеров, и даже на основе недорого USBasp [3] программатора.

При наличии PPM выхода задача упростилась: измерить время между шестью последовательными импульсами, началом к измерению будет достаточно длительная пауза.
По переднему фронту импульса сохраняем значение таймера и сразу сбрасываем таймер.
Когда импульсы не поступают, происходит прерывание по переполнению таймера, в этот момент готовимся к приёму импульсов, настраиваем DMA так, чтобы сложить 7 значений в массив.
Первый импульс синхронизирует процесс измерения, значение таймера в этот момент нас не интересует, последующие 6 значений будут хранить время между импульсами.
При каждом последующем импульсе значение таймера защёлкивается, таймер сбрасывается, защёлкнутое значение по DMA сохраняется в массив.

Выводим все результаты измерения первым и вторым способом в UART, видим, что работает, на отклонения рукояток реагирует.

Подключение STM32 к аппаратуре радиоуправления - 7
При отклонении рукояток значения меняются в диапазоне 3200..5700 единиц
Только вот значения измеренные первым и вторым способом отличаются, но логический анализатор то же самое показывает, так что это особенности аппаратуры.

Грабли, на которые удалось наступить в процессе разработки.
Поведение программы выглядит так — при включении питания программа работает, но при работе с отладчиком вылетает в HardFault_Handler. Программатор подключён по SWD линии (SWDIO, SWIO, GND).

Оказалось:
— при ресете программатором не очищается регистр статуса таймера TIM1->SR, там остаются флаги запроса на прерывание,
— при инициализации таймера разрешается прерывание от TIM1,
— прерывание для TIM1 и TIM15 общее, и когда обращаемся к структуре htim15, то она ещё не определена, поэтому улетаем в HardFault_Handler.

Вот так выглядит процедура прерывания

void TIM1_BRK_TIM15_IRQHandler(void)
{
/* USER CODE BEGIN TIM1_BRK_TIM15_IRQn 0 */

/* USER CODE END TIM1_BRK_TIM15_IRQn 0 */
HAL_TIM_IRQHandler(&htim1);
HAL_TIM_IRQHandler(&htim15);
/* USER CODE BEGIN TIM1_BRK_TIM15_IRQn 1 */

/* USER CODE END TIM1_BRK_TIM15_IRQn 1 */
}

Весь этот код сгенерирован Cub-ом автоматически, поэтому пришлось перед всей инициализацией добавить строчку htim15.Instance = TIM15.

Приложения:
1. Проект для Cube [4]
2. Данные 6 каналов + PPM сохранённые с USB логического анализатора Logic-U [5]

Автор: r_o_m_k_a

Источник [6]


Сайт-источник PVSM.RU: https://www.pvsm.ru

Путь до страницы источника: https://www.pvsm.ru/stm32/99560

Ссылки в тексте:

[1] Взято отсюда: https://www.hobbyking.com/hobbyking/forum/forum_posts.asp?TID=19313

[2] PPM: http://thomaspfeifer.net/ppm2usb_adapter_en.htm

[3] USBasp: http://www.instructables.com/id/Hacking-a-USBasp-dongle-into-a-PPM2USB-RC-SIM-dong/

[4] Проект для Cube: https://drive.google.com/open?id=0BwcHtbof8_8wQkEwNWpfa18yWEk

[5] Данные 6 каналов + PPM сохранённые с USB логического анализатора Logic-U: https://drive.google.com/open?id=0BwcHtbof8_8wb1BmSXpJSGFMQjA

[6] Источник: http://geektimes.ru/post/263002/