Use IMU to determine if the robots velocity is 0

EZ-Robotics / EZ-Template

Simple plug-and-play PROS template that handles drive base functions for VEX robots.

https://ez-robotics.github.io/EZ-Template/

Mozilla Public License 2.0

69 stars 27 forks source link

Use IMU to determine if the robots velocity is 0 #102

Closed ssejrog closed 3 months ago

ssejrog commented 3 months ago

When exit conditions are running, velocity is determined by the current derivative in PID. This should be accomponied with IMU data. This fixes the edge case where wheels are spinning but the robot isn't moving because the robot got stuck.