Arms are dangerous, please please be careful!
That is: start testing at very low coefficients, and first just verify directions.
Repository:
https://tinyurl.com/CommandRevSwerve
( https://shorturl.at/mwqEn )
(and please watch the previous video to understand the code for swerve drive)