Управление серво джойстиком: map, сглаживание, detach

Управление камерой одним пальцем — самая честная причина купить джойстик: наклон ручки превращается в поворот платформы, отпустили — камера стоит. Такой привод я собрал за вечер: серво SG90 на D11, ось X джойстика на A0, скетч из первой ссылки поисковика с одной строкой map(x, 0, 1023, 0, 180). Работало — ровно до первой попытки навести камеру на окно: серво дёргалось у центра, прыгало на 3-4 градуса само, а после отпускания ручки продолжало гудеть и теплеть. При этом Serial показывал честную ось: x= менялся как надо, дрожало не чтение, а результат — первый признак, что чинить надо не датчик, а связку ось-угол.

Три проблемы, и все решаются за один вечер: дрожь в центре лечится мёртвой зоной, рывки при быстром наклоне — сглаживанием, гул и нагрев при простое — командой detach(). Ни одна не видна в учебном скетче из пяти строк, и именно поэтому они заслуживают отдельного разбора: в железе всё будет так же, только заметно тише.

К концу урока у вас скетч, который ведёт себя как приличный привод: держит угол, пока ручка в покое, ходит плавными шагами и отпускает серво, когда тишина длится дольше двух секунд. Джойстик здесь — ручка управления камерой или манипулятором; саму серво и её аппетиты вспомним по вводному уроку про SG90, а платформа из двух серво появится в конце урока.

Арифметика перевода — одна строка: map(x, 0, 1023, 0, 180) сжимает показания АЦП в градусы. До упора влево — 0 градусов, до упора вправо — 180, центр — около 90. Точно около: если центр вашего модуля 505, карта даст 88 градусов, и платформа встанет на два градуса мимо. Лечится калибровкой из первого урока: подставьте свой центр серединой входного диапазона, и покой совпадёт с желаемым углом без подгонки механики. Запомните и обратную сторону map: аргументы можно дать в обратном порядке — map(x, 0, 1023, 180, 0) развернёт ось, и лево станет правом; иногда это нужно, чаще — симптом перепутанного провода.

Ту же арифметику мы делали с потенциометром в уроке про ручное управление серво — разница в характере источника: джойстик возвращается в центр сам, а ползунок остаётся там, где его поставили. Отсюда поведение привода: отпустили ручку — цель вернулась к 90 градусам, серво поедет домой. Для камеры это часто нежелательно: тогда держите цель фиксированной, пока ручка в мёртвой зоне, — и камера стоит там, куда вы её навели, сколько бы ни длился покой.

Мёртвая зона — единственная защита от дрожи. Разброс центра 500-523 плюс шум АЦП в пару единиц превращаются в качание цели на 2-4 градуса, и серво честно отрабатывает каждое: ток, гул, износ редуктора. Коридор 480-540 по оси X: чтение внутри — цель не трогаем, снаружи — пересчитываем. Ширина подбирается под ваш экземпляр, но меньше сорока единиц на дешёвых партиях я бы не ставил.

Плавность — вопрос цикла, а не библиотеки. Резкий наклон ручки даёт скачок цели с 90 сразу на 160, и серво телепортируется за 150 миллисекунд — быстрее, чем глаз успевает заметить. Лечат двумя приёмами. Первый — шаг: за один цикл серво двигается не больше чем на 1-2 градуса; при цикле 20 миллисекунд полный ход 0-180 занимает полторы-три с половиной секунды, и движение читается как управляемое. Второй — среднее: берите среднее из 5-10 чтений оси и отдавайте его в map; ручка начинает ехать с запаздыванием около десятой доли секунды, зато шум оси гасится ещё на входе. Цикл в 20 миллисекунд выбран не с потолка: серво-библиотека шлёт импульсы на частоте 50 герц, то есть раз в те же 20 миллисекунд, — шагать чаще бессмысленно, серво всё равно не услышит.

Приёмы не конкурируют, а складываются: среднее успокаивает вход, шаг — выход. Механику плавного хода мы разбирали в уроке про плавное движение и в интерполяции без delay; для ручки управления хватает простого шага, который не занимает память и не требует таймеров.

Удержание стоит тока: SG90, запертый на месте против лёгкой нагрузки, берёт порядка ста миллиампер, корпус теплеет за десятки минут, редуктор шумит. Ручке камеры это не нужно: навели кадр — пусть серво отдыхает. Логика в скетче простая: следим за millis() с последнего движения; тишина дольше двух секунд — motor.detach(). Пришло новое отклонение цели от текущего угла — attach(11) и продолжаем. Ток покоя и нагрев мы мерили в уроке про ток и нагрев — цифры там получены именно на удержании, а не на движении. Отсчёт тишины ведите от последнего реально выполненного шага, а не от последнего нажатия: ручка, отпущенная в движении, доработает до цели, и только потом начнётся честный отсчёт.

Одна деталь, которую я однажды пропустил: после detach() вал серво поддаётся рукой — платформа с камерой может съехать от ветра или неосторожного касания. Для штатива это плюс, для крана с грузом — минус: там удержание полезно, и detach применяют только на полном простое. Решение принимает задача, а не скетч; в симуляторе состояние видно в кадрах строкой sv=: единица — связано, ноль — отпущено.

Порог тишины я подгоняю под задачу: штативу с камерой хватает двух секунд, а крану, держащему груз, ставлю минуту — там detach оправдан только на обеденном перерыве. Константа одна, а поведение меняется целиком: поставьте TISHINA=5000 в симуляторе и посмотрите в кадрах sv=, как связка рвётся заметно позже.

Есть и третья ступень плавности, о которой редко пишут: скорость самого серво. SG90 без нагрузки проходит 60 градусов примерно за 0,1 секунды — около 600 градусов в секунду. Наш шаг в 2 градуса за 20 миллисекунд даёт 100 градусов в секунду: вшестеро медленнее предела, и это осознанно — ручка камеры не должна пугать кадр резкостью. Если нужен скоростной привод, поднимайте шаг до 5-6 градусов, но следите за током: разгон и торможение у упоров съедают пиковые токи, и слабый USB-кабель роняет питание платы. Мой компромисс для пан-тилта — 3 градуса за цикл: ход 0-180 занимает 1,2 секунды, и камера на кадре не дрожит.

Ось Y — готовый второй канал: та же map, тот же шаг, второй объект Servo на своём пине, и ручка превращается в пульт пан-тилт — горизонталь и вертикаль независимы. В симуляторной макетке одно серво, поэтому второй канал остаётся планом: код расширяется механически, никакой новой логики не появляется. Готовую платформу с раскладкой осей и питанием мы собрали в уроке про пан-тилт для камеры — джойстик туда встаёт вместо двух потенциометров. Только не забудьте про питание: два серво в движении — уже 400-500 миллиампер пиками, и это уже внешний БП с общей землёй, как в уроке про внешнее питание.

Дальше по стеку — кнопка. Одной осью удобно водить, но режимы (ручной ход, авто-обзор, фиксация кадра) переключаются нажатием SW под стержнем: этому посвящён следующий урок кластера со счётом нажатий, меню из трёх режимов и пиком подтверждения.