Термограф

Указатель «куда смотрю — туда ракета»: 3DoF-пушка вместо стиков

Замена стиков ручного управления на устройство, которое задаёт направление наклоном корпуса. Документ отвечает на три вопроса: что это даёт физически, как это собрать, и где проходит граница, за которую лучше не ходить.


1. Что вы на самом деле просите

Формулировка «куда пушка показывает, туда ракета» описывает командование углом, а не полёт в точку. Разница принципиальная:

Поэтому честная формулировка задачи: выбрать направление схода с направляющей и удерживать его, а не «навести на точку».

Оценка для учебной ракеты 75 мм / 3 кг (тяга ~8 g, работа 1.8 с):

Наклон на бустеБоковое ускорениеСкорость к отсечкеСнос к апогеюСмещение точки падения
5°6.7 м/с²12 м/с~60 м~70 м
10°13 м/с²24 м/с~120 м~140 м
20°26 м/с²47 м/с~235 м~280 м

Отсюда практическая точность: 1° ошибки наведения ≈ 10–15 м по точке падения. То есть «попасть в пятачок» нельзя в принципе, а «выбрать, в какую сторону от площадки упадёт» — можно, и это ровно то, что нужно для безопасности.

Чего это не даёт: наведения на объект, самонаведения, посадки в точку, полёта «за горизонт». Если когда-нибудь захочется — это уже не хобби, см. раздел 8.


2. Почему не очки и не геймпад

ВариантЗадержкаПроблема
DIY: ESP32 + MPU6050 в корпусе пушки5–10 мсничего, кроме сборки — рекомендую
Геймпад с гироскопом (Joy-Con, DualSense)25–50 мсBLE-хост на ESP32, спаривание, свой протокол HID, дрейф
Контроллер VR-шлема30–60 мснужен ПК/шлем рядом, батарея, привязка
Сам VR-шлем как указатель60–120 мснельзя: ракета полетит за вашим взглядом

Последний пункт стоит пояснить: если направление задаёт голова, то, отвернувшись посмотреть, где ракета, вы развернёте ракету. Указатель должен быть в руке и не быть связан с тем, куда вы смотрите.

Геймпад имеет смысл только если он у вас уже есть: тогда мост «BLE → CRSF» пишется отдельно и живёт на том же ESP32, что и пушка.


3. Как устроена связь (и почему не Wi-Fi)

Наивное решение «ESP-NOW с пушки на плату в ракете» разваливается на дальности: ESP-NOW — это Wi-Fi, 200–500 м по прямой. Ракета уходит на 300–600 м по высоте, плюс крен и экранировка корпусом — канал рвётся именно тогда, когда нужен.

Правильная схема — использовать готовый радиотракт:

 ПУШКА                              РАКЕТА
 ESP32 + MPU6050                    ELRS RX (2.4 ГГц)
   расчёт направления                  │ SBUS / PPM
   CRSF по UART 400 кбод ──► ELRS TX ──┼──► полётный ПК
   (26 байт, 16 каналов)    модуль     │      (manual.ino)

Альтернатива без ELRS — CRSF по проводу на стенде, для отладки на столе.

Что нужно купить дополнительно:

Позиция₽
ELRS TX-модуль (2.4 ГГц, micro)3 000–5 000
ELRS RX (в ракету)1 500–2 500
ESP32 + MPU6050 + кнопки1 500
Аккумулятор 1S 500 мА·ч + зарядка700
Корпус (3D-печать или детский пистолет)0–2 000
Итого~7 000–11 000

4. Как считается направление (без магнитометра)

Магнитометр на ручном указателе бесполезен: рядом металл, вы сами, машина. Но он и не нужен — есть более устойчивый способ.

Акселерометр даёт вектор «вверх» в системе координат пушки (в покое он показывает, куда верх). Ствол — ось +Z корпуса. Тогда:

up   = normalize(acc)                 // «вверх» в системе пушки
elev = asin( up · (0,0,1) )           // возвышение ствола, 0…90°
h    = normalize( (0,0,1) − (up·(0,0,1))·up )   // горизонтальная составляющая ствола
az   = угол между h и h₀ вокруг up    // h₀ — горизонталь, запомненная при калибровке

Ключевой момент: азимут тоже берётся из гравитации, а не интегрируется по гироскопу. Никакого дрейфа, никакой калибровки смещения, никаких 60° ухода за минуту. Гироскоп вообще не нужен для расчёта (он остаётся в запасе для режима «по скорости»).

Калибровка — в два положения, иначе никак: глядя в зенит, невозможно одновременно задать «вперёд», потому что горизонтальная составляющая ствола там равна нулю и азимут не определён.

  1. Зенит. Поднять ствол вертикально (засчитывается всё выше 70°), нажать CAL. Запоминается ноль наклона.
  2. По трассе. Опустить ствол горизонтально в направлении пуска (ниже 40°), снова CAL. Запоминается «вперёд» — азимут отсчитывается от этого направления.
  3. Индикатор подсказывает: одна вспышка — нужен шаг 1, две — шаг 2, медленное мигание — готово. Пока обе калибровки не сделаны, каналы стоят в центре и арминг не проходит.

Дальше — просто целитесь в точку неба: ракета наклоняется к ней на угол 90° − elev, ограниченный 20°. Когда ствол смотрит точно в зенит, азимут не определён (h → 0), прошивка держит последнее валидное значение и не дёргает рули.

Почему «вперёд» надо задавать вручную: у ракеты нет компаса, у пушки тоже (магнитометр в руках бесполезен — рядом металл). Обе системы получают общий ноль только из калибровки. Это ограничение не обходится, его надо принять.


5. Крен — главная засада

Команда «наклон вправо» задаётся в связанной системе координат ракеты, а ракета вращается. Если она кренанулась на 40°, ваша «правая» сторона уже не там, куда вы целитесь: ошибка направления равна углу крена.

Три способа жить с этим, по возрастанию сложности:

  1. Подавить крен рулями (дифференциальное отклонение). Уже есть в manual.ino, но коэффициент слабый (KD*0.5): для указателя его надо усилить, иначе за 2 секунды набежит 180°.
  2. Оценить крен интегрированием gyro[2] от момента старта и повернуть команду: p' = p·cos r + y·sin r, y' = −p·sin r + y·cos r. За 3 секунды дрейф мал, этого достаточно.
  3. Магнитометр — не советую, помехи от двигателя и сервоприводов.

Пока крен не удержан в пределах ±20°, абсолютный азимут врёт на тот же угол. Это первое, что надо проверить на стенде.


6. Задержки

Звеномс
IMU + фильтр3–5
расчёт и упаковка CRSF<1
ELRS (250 Гц)5–15
приёмник → SBUS → полётный ПК5–10
итого электроника15–30
человек200–250

Электроника добавляет немного; всё остальное — это человек. Поэтому указатель не делает полёт «точным», он делает его понятным: рука задаёт направление естественным движением, а не абстрактным стиком.


7. Стендовая проверка (до ракеты)

  1. Стенд «пушка → ноутбук». Подключить CRSF по проводу, смотреть каналы в конфигураторе ELRS или самописным скриптом. Убедиться: пушка в зените — каналы в центре; наклон вправо — отклонение вправо.
  2. Знаки. В config_gun.h есть SIGN_PITCH / SIGN_YAW. Проверять не «на глаз», а по реакции рулей на столе (режим «стабилизация»).
  3. Мёртвая зона. Дрожание руки ±1° не должно шевелить рули.
  4. Потеря связи. Выключить пушку — приёмник должен уйти в failsafe, рули в нейтраль, в течение 0.4 с. Это самый важный тест.
  5. Крен. Раскрутить макет на стене, посмотреть, насколько уезжает команда.
  6. Дальность. Положить «ракету» (приёмник) в 300 м, проверить, что канал держится при всех положениях пушки.

8. Безопасность и границы

Это самая важная часть документа, потому что «пушка, которая наводит ракету» — это ровно то, что выглядит как оружие, даже когда им не является.

Жёсткие рамки, за которые проект не выходит:

Правовая сторона. Сама по себе модель ракеты без полезной нагрузки — не оружие. Но комбинация «управляемая ракета + устройство прицеливания» в глазах проверяющего может выглядеть как самодельное управляемое средство поражения, а оборот оружия и взрывчатых веществ в РФ регулируется уголовным законом. Практические следствия:


9. Что в репозитории

src/gun/config_gun.h    пины, пределы, знаки
src/gun/gun.ino         прошивка указателя: IMU -> углы -> CRSF

Порядок запуска:

  1. Собрать на макетке: ESP32, MPU6050, три кнопки, светодиод.
  2. Прошить, открыть монитор порта — на стенде прошивка печатает углы.
  3. Подключить ELRS TX-модуль, настроить канал и мощность.
  4. В ракете — ELRS-приёмник, подключённый к H743 по CRSF: принимает команды src/flight/crsf.h, SBUS и RC_PROTOCOL больше не нужны.
  5. Прогнать раздел 7 целиком.

10. Ограничения