File tree 2 files changed +5
-5
lines changed
2 files changed +5
-5
lines changed Original file line number Diff line number Diff line change @@ -221,7 +221,6 @@ public void configureSubsystems() {
221
221
drivetrain .registerTelemetry (driveTelemetry ::telemeterize );
222
222
drivetrain .setPoseSupplier (driveTelemetry ::getFieldToRobot );
223
223
drivetrain .setVelocitySupplier (driveTelemetry ::getVelocity );
224
- drivetrain
225
224
}
226
225
227
226
if (FeatureFlags .runScoring ) {
Original file line number Diff line number Diff line change 18
18
import com .pathplanner .lib .util .HolonomicPathFollowerConfig ;
19
19
import com .pathplanner .lib .util .PIDConstants ;
20
20
import com .pathplanner .lib .util .ReplanningConfig ;
21
-
22
21
import edu .wpi .first .math .MathUtil ;
23
22
import edu .wpi .first .math .controller .PIDController ;
24
23
import edu .wpi .first .math .geometry .Pose2d ;
@@ -557,12 +556,14 @@ public boolean atPathfindPose() {
557
556
}
558
557
559
558
public void driveToPose (Pose2d targetPose ) {
560
- pathfindCommand = getPathfindCommand (targetPose );
561
- pathfindCommand .schedule ();
559
+ if (!demo ) {
560
+ pathfindCommand = getPathfindCommand (targetPose );
561
+ pathfindCommand .schedule ();
562
+ }
562
563
}
563
564
564
565
public void driveToPath (String pathName ) {
565
- if (pathName == lastCommandedPath ) {
566
+ if (pathName == lastCommandedPath || demo ) {
566
567
return ;
567
568
} else {
568
569
lastCommandedPath = pathName ;
You can’t perform that action at this time.
0 commit comments