FRC604 2022 Code Release

This includes:

FRC-2022: 2022 robot code
FRC-2022-NEW: Work in progress. Re-implementation of 2022 robot code. Focus on learning & code cleanup.
quikplan-swerve: Swerve drive trajectory optimization
quixpf: Particle filter localization that runs on the driver station