Auto Balance and Path Following Corrections

[schineaj23]

This implements automatic balancing via the AutoBalance command, and uses PPSwerveCommand to band-aid our FollowTrajectory problems.

[schineaj23]

In person code review with Ayidana. It passed. My benchmarks: it works My unit tests: Assert(true)