Skip to content

Commit 639a1ce

Browse files
committed
formatting
1 parent bbd28a0 commit 639a1ce

File tree

2 files changed

+13
-5
lines changed

2 files changed

+13
-5
lines changed

ramsete-controller/drivetrain.py

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -110,7 +110,7 @@ def resetOdometry(self, pose: wpimath.geometry.Pose2d):
110110
self.gyro.getRotation2d(),
111111
self.leftEncoder.getDistance(),
112112
self.rightEncoder.getDistance(),
113-
pose
113+
pose,
114114
)
115115

116116
def getPose(self) -> wpimath.geometry.Pose2d:

ramsete-controller/robot.py

Lines changed: 12 additions & 4 deletions
Original file line numberDiff line numberDiff line change
@@ -40,7 +40,7 @@ def robotInit(self):
4040
wpimath.geometry.Pose2d(3, 0, wpimath.geometry.Rotation2d.fromDegrees(0)),
4141
wpimath.trajectory.TrajectoryConfig(
4242
wpimath.units.feetToMeters(3.0), wpimath.units.feetToMeters(3.0)
43-
)
43+
),
4444
)
4545

4646
# The Ramsete Controller to follow the trajectory.
@@ -78,7 +78,9 @@ def autonomousPeriodic(self):
7878
desiredPose = self.trajectory.sample(self.timer.get())
7979

8080
# Get the reference chassis speeds from the Ramsete controller.
81-
refChassisSpeeds = self.ramseteController.calculate(self.drive.getPose(), desiredPose)
81+
refChassisSpeeds = self.ramseteController.calculate(
82+
self.drive.getPose(), desiredPose
83+
)
8284

8385
# Set the linear and angular speeds.
8486
self.drive.drive(refChassisSpeeds.vx, refChassisSpeeds.omega)
@@ -88,13 +90,19 @@ def autonomousPeriodic(self):
8890
def teleopPeriodic(self):
8991
# Get the x speed. We are inverting this because Xbox controllers return
9092
# negative values when we push forward.
91-
xSpeed = -self.speedLimiter.calculate(self.controller.getLeftY()) * Drivetrain.kMaxSpeed
93+
xSpeed = (
94+
-self.speedLimiter.calculate(self.controller.getLeftY())
95+
* Drivetrain.kMaxSpeed
96+
)
9297

9398
# Get the rate of angular rotation. We are inverting this because we want a
9499
# positive value when we pull to the left (remember, CCW is positive in
95100
# mathematics). Xbox controllers return positive values when you pull to
96101
# the right by default.
97-
rot = -self.rotLimiter.calculate(self.controller.getRightX()) * Drivetrain.kMaxAngularSpeed
102+
rot = (
103+
-self.rotLimiter.calculate(self.controller.getRightX())
104+
* Drivetrain.kMaxAngularSpeed
105+
)
98106

99107
self.drive.drive(xSpeed, rot)
100108

0 commit comments

Comments
 (0)