ChopX & Xandros
ChopX
Слышал, ты умеешь переводить трюки на велосипеде в код. А я вот хочу добавить немного гравитации. Хочешь прототипировать самобалансирующийся скейт, который делает сальто с бордюра? Представь, как будто это представление, но с математикой. Что скажешь?
Xandros
Конечно, разделим задачу на конкретные этапы: контроллер динамической устойчивости, исполнитель переворота на основе крутящего момента и датчик аварий, который будет фиксировать причины сбоев. Я напишу решатель дифференциальных уравнений для оценки траектории переворота, а затем запущу его в PID-цикл, чтобы держать платформу в вертикальном положении в воздухе. Безопасность прежде всего – добавим амортизирующий бафер, который будет рассчитывать силы удара в реальном времени. Я смоделирую это в MATLAB, потом перенесу на Arduino. Тебе понадобится прочная платформа, легкий гироскоп и сервопривод, который сможет выдержать нагрузку в 0.5 кг. Готов считать?
ChopX
Ну, давай зажигать! Кидай спецификации и первую строчку кода, я тебе такую раскладку сделаю – закачаешься, без всяких тормозов, только чистый драйв. Погнали!
Xandros
Вес: не более 100 килограмм.
Дека: 460 мм x 178 мм, карбон, толщиной 20 мм.
Двигатели: два бесколлекторных мотора 12 вольт, по 250 ватт каждый, 3330 об/мин.
Датчик крутящего момента: пиковый 50 Нм, частота дискретизации 500 Гц.
Гироскоп/акселерометр: MPU-6050, диапазон 16G, частота обновления 1 кГц.
Аккумулятор: литий-ионный, 36 вольт, 10 ампер-часов, ёмкость 400 Вт*ч.
Плата управления: Arduino Mega + shield CAN шина.
Сервопривод для переворота: сервопривод на 5 килограмм, размах 180 градусов, время отклика 200 миллисекунд.
Программное обеспечение: PID-регулятор в реальном времени с циклом 100 Гц.
Первая строка кода (Arduino C):
```cpp
float gyroAngle = readMPU();
```
ChopX
Эта палуба – зверь, карбон, восемнадцать на семь, идеальна для переворота. Моторы и гироскоп на месте – отлично. Только помни: если у сервомотора семь килограмм крутящего момента, не пытайся провернуть его на триста шестьдесят градусов сразу – он моментально заблокируется. Считывай угол гироскопа, подавай его в ПИД-регулятор, чтобы доска оставалась ровной, и посмотрим, получится ли у нас сделать этот перекат за двести миллисекунд без заноса при посадке. Давай проверим – нажми кнопку сброса и смотри, как это заработает.
Xandros
Конечно, вот основной цикл на простом Arduino-синтаксисе, без лишнего — только математика:
```cpp
const float Kp = 0.8; // пропорциональный коэффициент
const float Ki = 0.1; // интегральный коэффициент
const float Kd = 0.05; // дифференциальный коэффициент
float integral = 0;
float prevError = 0;
void loop() {
float gyroAngle = readMPU(); // текущий угол крена от гироскопа
float error = 0 - gyroAngle; // целевой угол — ноль
integral += error * 0.01; // обновление 100 Гц
float derivative = (error - prevError) / 0.01;
prevError = error;
float output = Kp*error + Ki*integral + Kd*derivative;
output = constrain(output, -5, 5); // ограничение крутящего момента для моторов
// Применяем крутящий момент к моторам: масштабирование левого и правого сторон
setMotorSpeeds(output);
// Если нужен триггер для переворота:
if (triggerFlip) {
servo.write(180); // 200 мс размах до 180°
delay(200);
servo.write(0); // сброс
triggerFlip = false;
}
}
```
Это минимальный набор. Подключи `readMPU()`, `setMotorSpeeds()` и определения `servo`, нажми на сброс, и пусть плата попробует этот перекид. Следи за логами — увидишь, как стабилизируется угол, двигается сервопривод, и плата либо перекидывается, либо падает. Удачи в ковыряниях.
ChopX
Отлично, петля выглядит надёжной – PID настроил как надо, крутящий момент ограничен, серво готов к работе. Только несколько доработок, чтобы сделать её более живой: увеличь предел интеграла, чтобы не разгонялся как сумасшедший скутер, может, ограничь до ±50, чтобы избежать неконтролируемого отклонения. И если вибрации гироскопа начнут влиять на производную, сбрось 0.01 и используй скользящее среднее или просто игнорируй производную на первых нескольких циклах. Как только начнёшь логировать, чуть увеличь Kp, если видишь, что плата всё ещё заваливается — добавь ей немного изюминки. Нажми сброс, посмотри на этот сальто и, если он шлёпнется обратно на землю, просто добавим амортизирующий слой и скажем, что это был трюк. Пора заставить эту платформу взлететь, дружище.
Xandros
Отличная идея насчёт интегрального зажима — установим ±50, и обернём это в `integral = constrain(integral, -50, 50);`.
По производной, пропустим первые десять измерений:
```cpp
static int sample = 0;
if (sample++ > 10) derivative = (error - prevError) / dt;
```
Когда будешь испытывать с полётом, следи за логами. Если угол будет выше ±2°, постепенно увеличивай Kp с 0.8 до 1.0 небольшими шагами. Через несколько попыток увидишь, как он вернётся к оси. Если всё равно будет срываться, просто приклей туда этот демпфер. Давай посмотрим, как он переворачивается — сбрось и дай числам показать себя.