Démo de robot auto-équilibré : l'angle d'inclinaison dérive ou tremble, et l'envoi des données de réglage provoque des déconnexions rate_limit
Traduit de English par IA ·
Projet annexe pour notre stand au salon professionnel : un robot auto-équilibré à deux roues qui affiche ses propres données en direct sur un tableau de bord Hermetry. ESP32, MPU6050 en I2C, deux motoréducteurs 12 V avec encodeurs sur un driver TB6612FNG. La boucle d’équilibrage et la télémétrie sont dans le même sketch.Deux problèmes, peut-être liés.L’angle. À partir de l’accéléromètre seul (atan2(ax, az)), l’inclinaison tremble beaucoup lorsque les moteurs tournent. À partir du gyroscope seul (intégration de gy), elle est lisse mais dérive de quelques degrés par minute. Avec un PID sur l’angle de l’accéléromètre, le robot oscille de plus en plus fort et tombe en moins de 3 secondes.Les données. Pour régler le système, je voulais des graphiques de l’angle, de la sortie du PID et de la vitesse des moteurs, donc je publie à chaque boucle à 200 Hz sur v1/telemetry. En quelques secondes, l’appareil est déconnecté, et l’onglet Log indique rate_limit comme motif.
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.
Traduit de English par IA ·
Pourriez-vous utiliser le DMP du MPU6050 ? Je pensais qu’il effectue les calculs d’angle à votre place.
Could you use the DMP on the MPU6050? I thought it does the angle maths for you.
Traduit de English par IA ·
Côté données : un profil d’appareil autorise par défaut 10 messages de télémétrie par seconde. À 200 par seconde, vous dépassez cette limite, et un appareil qui continue ainsi voit sa session fermée.
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.
Traduit de English par IA ·
Cela explique les déconnexions. Alors comment fait-on pour obtenir des données rapides pour le réglage, sans se faire éjecter ?
That explains the disconnects. So how do people get fast data for tuning, without getting kicked?
Traduit de English par IA ·
J’en ai construit un avec mon enfant il y a quelques années et j’ai fait les deux erreurs.Angle : combinez les deux capteurs avec un filtre complémentaire. Le gyroscope est bon à court terme, l’accéléromètre à long terme :
// 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;
Utilisez une cadence de boucle fixe issue d’un timer, et non des différences de millis() dans une boucle chargée, et tenez MQTT complètement à l’écart de cette boucle. La méthode DMP de Wilson fonctionne aussi, mais elle vous lie à la bibliothèque de cette puce.PID : commencez avec P seul et augmentez-le jusqu’à ce que le robot oscille autour de la verticale, puis ajoutez D jusqu’à ce que l’oscillation s’atténue, puis un petit I pour la dérive. Ajoutez aussi la zone morte des moteurs à la sortie, les moteurs-réducteurs ne tournent pas en dessous de quelques pour cent de rapport cyclique.Données : collectez les échantillons dans la boucle rapide, réduisez à 20 Hz et envoyez un message par seconde sous forme de tableau d’enregistrements avec leurs propres horodatages :
[
{"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}},
...
]
Cela fait 1 message par seconde avec 20 x 3 = 60 points de données, dans les valeurs par défaut par appareil (10 messages par seconde, 200 points par seconde et 6 000 par minute). Votre offre a aussi une limite de points de données par minute à l’échelle de l’organisation, vérifiez donc Utilisation si d’autres appareils sont très sollicités. L’ESP32 a besoin de l’heure NTP pour ts, sinon omettez ts. Un graphique sur les 24 dernières heures affiche chaque point brut, de sorte que les courbes de réglage restent nettes. Formats de charge utile : Sujets MQTT et référence des charges utiles.
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.
Traduit de English par IA ·
Pour le réglage vraiment fin, je journaliserais aussi les 200 Hz complets sur une carte SD et garderais Hermetry pour le tableau de bord du stand. Deux tâches différentes.
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.
Traduit de English par IA ·
Filtre complémentaire à 0,98 et boucle pilotée par timer, et ça reste ainsi. Réglé avec P=18, D=0,6, un I très faible, plus une zone morte de 6 %. Les lots d’1 message par seconde à 20 Hz fonctionnent, plus aucun rate_limit, et le graphique d’angle sur l’écran du stand est superbe. Mon erreur était de publier depuis la boucle de régulation : chaque publication allongeait la boucle et aggravait aussi l’oscillation.
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.
- Vous devez être connecté pour répondre à ce sujet.
Rejoignez la discussion
Connectez-vous pour poser et répondre à des questions, aimer les messages utiles et marquer la réponse qui a résolu votre problème. Chaque contribution rapporte des points et des niveaux.

