Balancierroboter-Demo: Neigungswinkel driftet oder zittert, und das Streamen der Tuning-Daten führt zu rate_limit-Trennungen
Von English mit KI übersetzt ·
Nebenprojekt für unseren Stand auf einer Messe: ein zweirädriger Balancierroboter, der seine eigenen Live-Daten auf einem Hermetry-Dashboard anzeigt. ESP32, MPU6050 über I2C, zwei 12-V-Getriebemotoren mit Encodern an einem TB6612FNG-Treiber. Balanceregelung und Telemetrie laufen im selben Sketch.Zwei Probleme, vermutlich zusammenhängend.Der Winkel. Allein aus dem Beschleunigungssensor (atan2(ax, az)) zittert die Neigung stark, sobald die Motoren laufen. Allein aus dem Gyroskop (Integration von gy) ist der Winkel zwar glatt, driftet aber um einige Grad pro Minute. Mit einem PID auf dem Winkel aus dem Beschleunigungssensor schwingt der Roboter immer stärker und fällt innerhalb von 3 Sekunden um.Die Daten. Zum Tunen wollte ich Diagramme von Winkel, PID-Ausgang und Motordrehzahl, daher veröffentliche ich in jeder Schleife mit 200 Hz nach v1/telemetry. Innerhalb von Sekunden wird das Gerät getrennt, und der Log-Tab zeigt rate_limit als Grund an.
Side project for our booth at a trade show: a two-wheeled balancing robot that shows its own live data on a Hermetry dashboard. ESP32, MPU6050 over I2C, two 12 V gear motors with encoders on a TB6612FNG driver. Balancing loop and telemetry in the same sketch.
Two problems, possibly related.
The angle. From the accelerometer alone (atan2(ax, az)) the tilt jitters a lot when the motors run. From the gyro alone (integrating gy) it’s smooth but drifts a few degrees per minute. With a PID on the accelerometer angle the robot oscillates harder and harder and falls within 3 seconds.
The data. To tune I wanted charts of angle, PID output and motor speed, so I publish every loop at 200 Hz to v1/telemetry. Within seconds the device is disconnected, and the Log tab shows rate_limit as the reason.
Von English mit KI übersetzt ·
Könnten Sie das DMP des MPU6050 verwenden? Ich dachte, es übernimmt die Winkelberechnung für Sie.
Could you use the DMP on the MPU6050? I thought it does the angle maths for you.
Von English mit KI übersetzt ·
Auf der Datenseite: Ein Geräteprofil erlaubt standardmäßig 10 Telemetrienachrichten pro Sekunde. Bei 200 pro Sekunde überschreiten Sie dieses Limit, und ein Gerät, das dies dauerhaft tut, wird getrennt, indem seine Sitzung geschlossen wird.
On the data side: a device profile allows 10 telemetry messages a second by default. At 200 a second you blow through it and a device that keeps doing that gets its session closed.
Von English mit KI übersetzt ·
Das erklärt die Verbindungsabbrüche. Wie bekommen Leute schnelle Daten zum Tunen, ohne rausgeworfen zu werden?
That explains the disconnects. So how do people get fast data for tuning, without getting kicked?
Von English mit KI übersetzt ·
Habe vor ein paar Jahren eines davon mit meinem Kind gebaut und beide Fehler gemacht.Winkel: Kombiniere die beiden Sensoren mit einem komplementären Filter. Das Gyroskop ist kurzfristig gut, der Beschleunigungssensor langfristig:
// fixed 200 Hz loop from a hardware timer, dt = 0.005
float accAngle = atan2f(ax, az) * RAD_TO_DEG;
angle = 0.98f * (angle + gy * dt) + 0.02f * accAngle;
Verwende eine feste Schleifenrate von einem Timer statt millis()-Differenzen in einer ausgelasteten Schleife, und halte MQTT vollständig aus dieser Schleife heraus. Wilsons DMP-Ansatz funktioniert auch, bindet dich aber an die Bibliothek dieses Chips.PID: Beginne nur mit P und erhöhe es, bis der Roboter um die aufrechte Position schwingt, dann füge D hinzu, bis die Schwingung abklingt, danach ein kleines I gegen Drift. Und addiere das Totband der Motoren zum Ausgang, Getriebemotoren drehen sich unterhalb weniger Prozent Tastverhältnis nicht.Daten: Sammle Samples in der schnellen Schleife, dezimiere auf 20 Hz und sende eine Nachricht pro Sekunde als Array von Datensätzen mit eigenen Zeitstempeln:
[
{"ts": 1767600000000, "values": {"bal.angle": 0.42, "bal.out": 12.5, "bal.speed": 3.1}},
{"ts": 1767600000050, "values": {"bal.angle": 0.38, "bal.out": 11.9, "bal.speed": 3.0}},
...
]
Das ergibt 1 Nachricht pro Sekunde mit 20 x 3 = 60 Datenpunkten, innerhalb der Standardwerte pro Gerät (10 Nachrichten pro Sekunde, 200 Punkte pro Sekunde und 6.000 pro Minute). Dein Tarif hat außerdem ein organisationsweites Limit für Datenpunkte pro Minute, also prüfe unter Nutzung, falls andere Geräte stark ausgelastet sind. Der ESP32 benötigt NTP-Zeit für ts, andernfalls lasse ts weg. Ein Diagramm über die letzten 24 Stunden zeigt jeden Rohpunkt, sodass die Tuning-Kurven scharf bleiben. Payload-Formate: MQTT-Themen und Payload-Referenz.
Built one of these with my kid a couple of years ago and made both mistakes.
Angle: combine the two sensors with a complementary filter. The gyro is good short-term, the accelerometer long-term:
// fixed 200 Hz loop from a hardware timer, dt = 0.005
float accAngle = atan2f(ax, az) * RAD_TO_DEG;
angle = 0.98f * (angle + gy * dt) + 0.02f * accAngle;
Use a fixed loop rate from a timer, not millis() differences in a busy loop, and keep MQTT out of that loop entirely. Wilson’s DMP route works too, it just ties you to that chip’s library.
PID: start with P only and raise it until the robot oscillates around upright, then add D until the oscillation dies down, then a small I for drift. And add the motors‘ deadband to the output, gear motors don’t move below a few percent duty.
Data: collect samples in the fast loop, decimate to 20 Hz, and send one message per second as an array of records with their own timestamps:
[
{"ts": 1767600000000, "values": {"bal.angle": 0.42, "bal.out": 12.5, "bal.speed": 3.1}},
{"ts": 1767600000050, "values": {"bal.angle": 0.38, "bal.out": 11.9, "bal.speed": 3.0}},
...
]
That is 1 message a second with 20 x 3 = 60 data points, inside the per-device defaults (10 messages a second, 200 points a second and 6,000 a minute). Your plan has an organisation-wide data points per minute limit too, so check Usage if other devices are busy. The ESP32 needs NTP time for ts, otherwise leave ts out. A chart over the last 24 hours shows every raw point, so the tuning curves stay sharp. Payload forms: MQTT topics and payload reference.
Von English mit KI übersetzt ·
Für das wirklich feine Tuning würde ich zusätzlich die volle 200 Hz auf eine SD-Karte loggen und Hermetry für das Messe-Dashboard behalten. Zwei verschiedene Aufgaben.
For the really fine tuning I’d also log the full 200 Hz to an SD card and keep Hermetry for the booth dashboard. Two different jobs.
Von English mit KI übersetzt ·
Komplementärfilter mit 0,98 und eine timergesteuerte Schleife, dabei bleibt es. Eingestellt mit P=18, D=0,6, einem winzigen I-Anteil sowie einer 6-%-Totzone. Die Batches mit 1 Nachricht pro Sekunde bei 20 Hz funktionieren, kein rate_limit mehr, und das Winkeldiagramm auf dem Messestand-Board sieht super aus. Mein Fehler war, aus der Regelschleife heraus zu publizieren; jede Veröffentlichung hat die Schleife verlängert und die Schwingung ebenfalls verschlimmert.
Complementary filter at 0.98 and a timer-driven loop, and it stands. Tuned it with P=18, D=0.6, a tiny I, plus a 6 % deadband. The 1 message per second batches at 20 Hz work, no more rate_limit, and the angle chart on the booth board looks great. My mistake was publishing from inside the control loop, every publish stretched the loop and made the oscillation worse too.
- Du musst angemeldet sein, um auf dieses Thema antworten zu können.
Mitdiskutieren
Melde dich an, um Fragen zu stellen und zu beantworten, hilfreiche Beiträge mit „Gefällt mir“ zu markieren und die Antwort zu kennzeichnen, die dein Problem gelöst hat. Jeder Beitrag bringt Punkte und Stufen.

