Hello! For the upcoming season, our team is trying to create a “Swerve Diagnostics program” Allowing us to detect issues and breaks in the swerve drive before each match in competition. One thing to consider is that we use YAGSL, which does not immediately give us direct access to the motors.
In the past, we have created a command to work through the YAGSL system and directly set the drive and azimuth motors to full power. From there, we check the output speed and current of each.
Are there any suggestions on a more in depth and accurate system + potentially simpler code using YAGSL? Thanks!