Update FourWheelDriveBase.c

huskyroboticsteam · Aug 8, 2023 · d87b9fb · d87b9fb
1 parent fc821d4
commit d87b9fb
Showing 1 changed file with 1 addition and 0 deletions.
diff --git a/src/swerve_drive/FourWheelDriveBase.c b/src/swerve_drive/FourWheelDriveBase.c
@@ -26,6 +26,7 @@ FourWheelDriveBase* SwerveDrive(FourWheelDriveBase* driveBase, double xvel, doub
             setPower(&((*driveBase).wh[i]), vel);
             setSteeringTarget(&((*driveBase).wh[i]), theta);
         }
+        printf("POWER SETTING: %f, %f \n", (d.wh[i]).control.steeringTarget, (d.wh[i]).control.wheelSpeed);
     } else {
         printf("CONDITION: in motion\n");
         evec3 r_orbit = EVcross(newVec3(0.0, 0.0, 1.0 / thetavel), v);