Tuned Swerve PIDs

CurtinFRC · Aug 22, 2023 · 2442452 · 2442452
1 parent e3c96fb
commit 2442452
Show file tree

Hide file tree

Showing 2 changed files with 8 additions and 4 deletions.
diff --git a/src/main/cpp/Robot.cpp b/src/main/cpp/Robot.cpp
@@ -216,6 +216,10 @@ void Robot::TeleopPeriodic() {
   if (map.controllers.test.GetBButtonPressed()){
     swerve->GetActiveBehaviour()->Interrupt();
   }
+
+  if (map.controllers.test.GetAButtonPressed()){
+    swerve->SetIndividualTuning(1, 270_deg, 0_m/1_s);
+  }
 }
 
 

diff --git a/src/main/include/RobotMap.h b/src/main/include/RobotMap.h
@@ -149,11 +149,11 @@ struct RobotMap {
     // Setting the PID path and values to be used for SwerveDrive and SwerveModules
     wom::SwerveModule::angle_pid_conf_t anglePID {
       "/drivetrain/pid/angle/config",
-      14_V / 180_deg,
+      13.2_V / 180_deg,
       0.0_V / (100_deg * 1_s),
-      0_V / (100_deg / 1_s),
-      1_deg,
-      0.5_deg / 2_s
+      0_V / (100_deg / 1_s)
+      //1_deg,
+      //0.5_deg / 2_s
     };
     wom::SwerveModule::velocity_pid_conf_t velocityPID{
       "/drivetrain/pid/velocity/config",