Demo de robot equilibrista: el ángulo de inclinación deriva o tiembla, y al transmitir los datos de ajuste me desconecta por rate_limit
Traducido del English por IA ·
Proyecto paralelo para nuestro stand en una feria comercial: un robot equilibrista de dos ruedas que muestra sus propios datos en vivo en un panel de Hermetry. ESP32, MPU6050 por I2C, dos motorreductores de 12 V con encoders en un driver TB6612FNG. El bucle de equilibrio y la telemetría están en el mismo sketch.Dos problemas, posiblemente relacionados.El ángulo. Solo con el acelerómetro (atan2(ax, az)) la inclinación tiembla mucho cuando los motores funcionan. Solo con el giroscopio (integrando gy) es suave, pero deriva unos grados por minuto. Con un PID sobre el ángulo del acelerómetro, el robot oscila cada vez más fuerte y se cae en 3 segundos.Los datos. Para ajustar quería gráficas del ángulo, la salida del PID y la velocidad de los motores, así que publico en cada iteración a 200 Hz en v1/telemetry. En cuestión de segundos el dispositivo se desconecta, y la pestaña Log muestra rate_limit como motivo.
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.
Traducido del English por IA ·
¿Podrías usar el DMP del MPU6050? Pensaba que hace los cálculos del ángulo por ti.
Could you use the DMP on the MPU6050? I thought it does the angle maths for you.
Traducido del English por IA ·
En cuanto a los datos: un perfil de dispositivo permite por defecto 10 mensajes de telemetría por segundo. Con 200 por segundo se supera ese límite, y un dispositivo que siga haciéndolo ve cerrada su sesión.
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.
Traducido del English por IA ·
Eso explica las desconexiones. Entonces, ¿cómo consigue la gente datos rápidos para el ajuste sin que los expulsen?
That explains the disconnects. So how do people get fast data for tuning, without getting kicked?
Traducido del English por IA ·
Construí uno de estos con mi hijo hace un par de años y cometí ambos errores.Ángulo: combina los dos sensores con un filtro complementario. El giroscopio es bueno a corto plazo, el acelerómetro a largo plazo:
// 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;
Usa una frecuencia de bucle fija desde un temporizador, no diferencias de millis() en un bucle muy cargado, y mantén MQTT completamente fuera de ese bucle. La ruta DMP de Wilson también funciona, pero te ata a la biblioteca de ese chip.PID: empieza solo con P y súbelo hasta que el robot oscile alrededor de la vertical, luego añade D hasta que la oscilación se apague, y después una pequeña I para la deriva. Además, añade la zona muerta de los motores a la salida, los motorreductores no se mueven por debajo de unos pocos por ciento de ciclo de trabajo.Datos: recoge muestras en el bucle rápido, reduce a 20 Hz y envía un mensaje por segundo como un array de registros con sus propias marcas de tiempo:
[
{"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}},
...
]
Eso es 1 mensaje por segundo con 20 x 3 = 60 puntos de datos, dentro de los valores predeterminados por dispositivo (10 mensajes por segundo, 200 puntos por segundo y 6.000 por minuto). Tu plan también tiene un límite de puntos de datos por minuto para toda la organización, así que revisa Uso si otros dispositivos están muy ocupados. El ESP32 necesita la hora NTP para ts; si no, deja ts fuera. Un gráfico de las últimas 24 horas muestra cada punto sin procesar, así que las curvas de ajuste se mantienen nítidas. Formatos de payload: Temas MQTT y referencia de payloads.
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.
Traducido del English por IA ·
Para el ajuste realmente fino, también registraría los 200 Hz completos en una tarjeta SD y mantendría Hermetry para el panel del stand. Dos trabajos distintos.
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.
Traducido del English por IA ·
Filtro complementario en 0,98 y un bucle controlado por temporizador, y se mantiene. Lo ajusté con P=18, D=0,6, una I muy pequeña y una zona muerta del 6 %. Los lotes de 1 mensaje por segundo a 20 Hz funcionan, sin más rate_limit, y el gráfico de ángulo en el panel del stand se ve genial. Mi error fue publicar desde dentro del bucle de control: cada publicación alargaba el bucle y empeoraba también la oscilación.
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.
- Debes estar registrado para responder a este debate.
Únete a la conversación
Inicia sesión para preguntar y responder, dar me gusta a las publicaciones útiles y marcar la respuesta que resolvió tu problema. Cada aportación suma puntos y niveles.

