Code builds and deploy with GradleRIO https://github.com/wpilibsuite/GradleRIO

Pathfinder works with: https://github.com/JacisNonsense/Pathfinder/

Victors SP, Encoder AMT103-V, Gyro SPI ADXL362

CSV Pathfinder trajectories generated with: https://github.com/Endoman123/motion-profile-generator

Motion Variables which work: Units: Metric Fir Method: Cubic Time Step: 0.05 Velocity: 2 Jerk: 1.5 Acceleraction 20.0

Robot Specification: Robot Width: 1 Robot Depth: 0.7 Drive Base: Tank Wheel Base: 0.85