Our team has started coding a homebrew version of YAGSL this year on our MK4i Swerve modules. We have had some issues with heading and X posing on rotation. Currently, we have a “working” drivetrain with correct rotation and correct translation but, we are having power delivery issues with translational movement, our rotational movement is completely fine, but our translational movement is weak. We think it is a PID issue, but we are not sure how to address this issue. I link our github below.
Any help is appreciated!
Thanks