Термограф

Разбор старых прошивок: что было починено

Историческая справка. Проверялись ESP32-версии (src/manual, src/rocket_stab, src/recovery), которых в репозитории больше нет: их заменила одна src/flight/. Документ оставлен как запись решений — все исправления перенесены в новую прошивку, и здесь видно, откуда они взялись.

Ниже — только то, что реально влияло на полёт, с точными ссылками на строки. Стилистика и мелочи опущены.

#ГдеСерьёзностьСуть
1config_manual.h:14,31блокирующаяпин 27 занят дважды
2manual.ino:275высокаязащита «крен > 70°» не срабатывает
3manual.ino:132высокаярежим «УДЕРЖАНИЕ» держит крен вместо курса
4manual.ino:195средняяв «РУЧНОМ» режиме стик почти не влияет на рули
5recovery.ino:169средняядетект старта может сработать без выдержки
6manual.ino:31средняяIRAM_ATTR не соберётся на Nano/AVR
7sim/sim.py:11средняяобещан гейн-шедулинг, в коде его нет

1. Пин 27 занят дважды (блокирующая)

config_manual.h:

#define PIN_PPM 27            // строка 14
...
#define PIN_SERVO_ROLL  27    // строка 31

PPM-вход и сервопривод крена висят на одном выводе. В лучшем случае не работает крен, в худшем — сервопривод дёргает вход приёмника и кадры сыплются.

Исправлено. PPM перенесён на пин 33, крен оставлен на 27.

#define PIN_PPM 33

Пины 34–39 не подошли: у них нет внутренней подтяжки, а в rcInit() стоит INPUT_PULLUP — при выключенном приёмнике вход висел бы в воздухе.

Проверить после правки: rcAlive() не должен сбрасываться при движении сервоприводов.


2. Защита по крену не работает (высокая)

manual.ino:275:

bool tilted = (fabs(angX) > 70.0f * DEG_TO_RAD) || (fabs(angY) > 70.0f * DEG_TO_RAD);

angX — не угол в радианах. Это смесь: accX = -acc[0]/aMag лежит в диапазоне [-1; 1] (это синус угла), а gyro*dt — в радианах. В установившемся режиме |angX| ≤ 1, а порог равен 1.22. Значит по акселерометру условие не срабатывает никогда — только если гироскоп успел «наинтегрировать» больше 1.22, что при дрейфе займёт секунды.

Исправлено — угол считается явно по акселерометру, как в rocket_stab.ino:224, порог вынесен в DISABLE_TILT_DEG (config_manual.h):

float aMagTilt = sqrtf(acc[0]*acc[0] + acc[1]*acc[1] + acc[2]*acc[2]);
if (aMagTilt < 0.2f) aMagTilt = 0.2f;
float tiltRad = acosf(constrain(acc[2] / aMagTilt, -1.0f, 1.0f));
bool tilted = tiltRad > DISABLE_TILT_DEG * DEG_TO_RAD;

Побочный эффект, о котором надо знать: ракета, лежащая горизонтально с включённым армингом, теперь штатно уходит в нейтраль (90° > 70°). Стендовые проверки — в пределах ±45°.


3. «УДЕРЖАНИЕ» держит не то (высокая)

manual.ino:132:

headingEst += gyro[2] * dt;     // комментарий: "интеграл по рысканию"

При монтаже, где ось Z направлена вдоль корпуса (это следует из rocket_stab.ino:165 и из того, что gyro[2] используется как скорость крена), gyro[2] — это крен, а не рыскание. Рыскание — gyro[0] (её же использует демпфер uYaw в строке 203).

Итог: режим «УДЕРЖАНИЕ» (строки 206–214) сравнивает holdHeading с углом крена и командой по рысканию пытается удержать крен. Ракета будет медленно закручиваться, а контур — бороться с этим каналом рыскания.

Исправлено:

headingEst += gyro[0] * dt;   // рыскание

И проверить знак: uYaw использует -KD * gyro[0], значит и ошибка должна входить с тем же знаком, что и в errPitch/uPitch — проверяется на столе пунктом 3 из README-manual.md.


4. В «РУЧНОМ» режиме стик почти ничего не делает (средняя)

manual.ino:195:

uPitch = sPitch * (MANUAL_RATE_DEG_S * DEG_TO_RAD) / 500.0f - KD * gyro[1];

При полном отклонении стика: 250°/с = 4.36 рад/с, делим на 500 → 0.0087 рад = 0.5° руля. Демпфер при угловой скорости 1 рад/с даёт KD·ω = 0.08 рад = 4.6°. То есть пилот управляет рулём в 9 раз слабее, чем собственный демпфер: ракета «не слушается», хотя формально команда есть.

Правка — стик задаёт долю полного хода руля:

uPitch = sPitch * SERVO_MAX_DEG * DEG_TO_RAD - KD * gyro[1];

Тогда полный стик = полный ход руля, а KD остаётся демпфером.


5. Детект старта без выдержки (средняя)

recovery.ino:169-178:

if (state == ST_ARMED && accMagG >= LAUNCH_ACCEL_G) {
  static uint32_t over = 0;
  if (!over) over = now;
  if (now - over >= LAUNCH_HOLD_MS) { ... }
  return;
}

over не обнуляется, когда перегрузка пропала. Один случайный толчок на столе (уронили крышку, хлопнули по корпусу) взводит over, и через минуту настоящий пуск сработает мгновенно, без выдержки 80 мс. В rocket_stab.ino:216 это сделано правильно (else overGsince = 0;).

Правка:

if (state == ST_ARMED && accMagG >= LAUNCH_ACCEL_G) {
  ...
} else if (state == ST_ARMED) {
  over = 0;            // over вынести в файловую область
}

6. IRAM_ATTR и обещание поддержки Nano (средняя)

manual.ino:31:

void IRAM_ATTR ppmISR() { ... }

IRAM_ATTR — макрос ESP32. На Arduino Nano (AVR) он не определён, и скетч не соберётся, хотя README.md:67 обещает поддержку Nano. Плюс сам обработчик использует micros() и массив на 9 элементов — на AVR это допустимо, но attachInterrupt там другой.

Правка:

#if defined(ESP32)
  #define ISR_ATTR IRAM_ATTR
#else
  #define ISR_ATTR
#endif
void ISR_ATTR ppmISR() { ... }

Либо честно убрать Nano из README и оставить ESP32/STM32.


7. Симулятор обещает шедулинг, но не делает его (средняя)

sim/sim.py:11-12:

Закон управления: delta = clamp(Kp*(theta_cmd - theta) - Kd*omega) с делением на q,
чтобы момент не зависел от скорости (gain scheduling).

sim.py:54:

delta = kp * (cmd - th) - kd * om      # никакого деления на q

При этом момент M_упр ∝ q, а q меняется от 1.5 кПа (50 м/с) до 29 кПа (220 м/с) — почти в 20 раз. Один и тот же Kp даёт разное петлевое усиление, отсюда и «на грани перерегулирования» при Kp = 0.7 в README.

Правка — либо реализовать то, что написано:

q_sched = max(q, 500.0)
delta = (kp * (cmd - th) - kd * om) * min(max(3000.0 / q_sched, 0.25), 4.0)

либо убрать обещание из докстринга. Первое правильнее: на H–M без шедулинга контур либо вялый на старте, либо раскачивает ракету на максимальном напоре.


Что можно не трогать