Made some progress!

Completed:

• Trajectory generation to bumps using compact code
• Removed trig from polar slew rate and replaced with vector math (so much cleaner)
• Fixed some axis inversion with the contorller input causing weird behavior.
• Broke bump paths unintentionally but fixed it again
• Fixed some landmark positions and zone coordinates that were incorrect
• Increased kp in heading requests to make it snappier

I am pretty surprised at the amount of things that I was about to work on and get done in this 5 hour period of time. I did a lot of testing, involving digging through past commits for direction issues and narrowing down issues with the bump stuff, and I also made sure not to ignore the small details like cleaning up old code and keeping things readable and compact.

Next:

Honestly I might take a small break from this robot. I did have a cool idea of generating PathPlanner trajectories with continuous math functions. But I might do that in another repository and move it over to this after.

Signing off,
Ash-ioL