Phoenix 6 drivetrain

[sleepyghost-zzz]

Purpose The purpose of this addition is to create a phoenix 6 swerve drivetrain.

Project Scope

• [x] Add CommandSwerveDrive
• [x] Sim it
• [x] Implement CI formatting changes