Tilt compensation for self-balancing on slopes #600

Closed
opened 2026-03-14 14:55:23 -04:00 by sl-jetson · 0 comments
Collaborator

Extend the balance PID controller to handle inclines up to 15°. Problem: on a slope, the gravity vector offset tricks the balance controller into thinking it is tilting. Solution: estimate the slope angle from sustained accelerometer bias and subtract it from the tilt measurement. Add a slow-adapting (tau=5s) slope estimator. Limit slope compensation to ±15°. Add JLINK telemetry for slope_estimate_deg. Unit tests with simulated slope scenarios.

Extend the balance PID controller to handle inclines up to 15°. Problem: on a slope, the gravity vector offset tricks the balance controller into thinking it is tilting. Solution: estimate the slope angle from sustained accelerometer bias and subtract it from the tilt measurement. Add a slow-adapting (tau=5s) slope estimator. Limit slope compensation to ±15°. Add JLINK telemetry for slope_estimate_deg. Unit tests with simulated slope scenarios.
Sign in to join this conversation.
No Label
1 Participants
Notifications
Due Date
No due date set.
Dependencies

No dependencies set.

Reference: seb/saltylab-firmware#600
No description provided.