10
10
from wpimath .trajectory import (
11
11
TrajectoryConfig ,
12
12
TrajectoryGenerator ,
13
- TrapezoidProfileRadians
13
+ TrapezoidProfileRadians ,
14
14
)
15
15
from wpimath .controller import (
16
16
HolonomicDriveController ,
17
17
PIDController ,
18
- ProfiledPIDControllerRadians
18
+ ProfiledPIDControllerRadians ,
19
19
)
20
20
21
21
from constants import AutoConstants , DriveConstants , OIConstants
@@ -100,7 +100,7 @@ def getAutonomousCommand(self) -> commands2.Command:
100
100
# Constraint for the motion profiled robot angle controller
101
101
kThetaControllerConstraints = TrapezoidProfileRadians .Constraints (
102
102
AutoConstants .kMaxAngularSpeedRadiansPerSecond ,
103
- AutoConstants .kMaxAngularSpeedRadiansPerSecondSquared
103
+ AutoConstants .kMaxAngularSpeedRadiansPerSecondSquared ,
104
104
)
105
105
106
106
kPXController = PIDController (1.0 , 0.0 , 0.0 )
@@ -113,7 +113,7 @@ def getAutonomousCommand(self) -> commands2.Command:
113
113
kPIDController = HolonomicDriveController (
114
114
kPXController , kPYController , kPThetaController
115
115
)
116
-
116
+
117
117
swerveControllerCommand = commands2 .SwerveControllerCommand (
118
118
exampleTrajectory ,
119
119
self .robotDrive .getPose , # Functional interface to feed supplier
0 commit comments