Разбор старых прошивок: что было починено
Историческая справка. Проверялись ESP32-версии (
src/manual,src/rocket_stab,src/recovery), которых в репозитории больше нет: их заменила однаsrc/flight/. Документ оставлен как запись решений — все исправления перенесены в новую прошивку, и здесь видно, откуда они взялись.
Ниже — только то, что реально влияло на полёт, с точными ссылками на строки. Стилистика и мелочи опущены.
| # | Где | Серьёзность | Суть |
|---|---|---|---|
| 1 | config_manual.h:14,31 | блокирующая | пин 27 занят дважды |
| 2 | manual.ino:275 | высокая | защита «крен > 70°» не срабатывает |
| 3 | manual.ino:132 | высокая | режим «УДЕРЖАНИЕ» держит крен вместо курса |
| 4 | manual.ino:195 | средняя | в «РУЧНОМ» режиме стик почти не влияет на рули |
| 5 | recovery.ino:169 | средняя | детект старта может сработать без выдержки |
| 6 | manual.ino:31 | средняя | IRAM_ATTR не соберётся на Nano/AVR |
| 7 | sim/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 без шедулинга контур либо вялый на старте, либо раскачивает ракету на максимальном напоре.
Что можно не трогать
- Микширование четырёх рулей (
p+r,y+r,-p+r,-y+r) — корректное. slewServosс ограничением скорости — корректно, для H–M поднять лимит.- Логика арминга и состояния
ST_IDLE/ARMED/FLIGHT/DONE— корректна. - Разделение
recoveryиstabilizationна две платы — правильное решение, не объединять.