Needs some cleanup, as this is quite experimental.
Also TODOs:
Make less hacky
Fix Odom
Adjust path planning to utilize new walking capabilities
Add robot specific parameter overrides
Proposed changes
Use sideways linear acceleration as an indicator. After performing several trials on the robot this seems to be most correlated with the robots phase. We look for the point where the acceleration is near zero. This is the case if we stop accelerating using one leg and start breaking with the other.
Summary
Adds an imu based phase reset.
Needs some cleanup, as this is quite experimental.
Also TODOs:
Proposed changes
Related issues
314
Closes #437
Checklist
colcon build