Skip to content

Commit

Permalink
Removed Debug Print Statements
Browse files Browse the repository at this point in the history
Removed debug print statements for angle and timeUntilMagnetizationStop variables in MagnetizePIDPoseAlign
  • Loading branch information
Acrenos committed Jan 16, 2025
1 parent be7cd97 commit 7a7f870
Showing 1 changed file with 0 additions and 2 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -235,14 +235,12 @@ class MagnetizePIDPoseAlign(
var angle = abs(atan2(controllerDesVel.vxMetersPerSecond,
controllerDesVel.vyMetersPerSecond) -
atan2(pose.translation.x, pose.translation.y))
println(angle)
if (angle > Math.PI) {
angle = 2 * Math.PI - angle
}

if (angle > 1.74533) {
timeUntilMagnetizationStop -= 0.02
println(timeUntilMagnetizationStop)
} else {
timeUntilMagnetizationStop = magnetizationStopTime
}
Expand Down

0 comments on commit 7a7f870

Please sign in to comment.