Skip to content

Commit

Permalink
s
Browse files Browse the repository at this point in the history
  • Loading branch information
dannynotsmart committed Apr 7, 2023
1 parent 9817f2a commit 671ea20
Showing 1 changed file with 4 additions and 6 deletions.
10 changes: 4 additions & 6 deletions src/main/java/org/sciborgs1155/robot/commands/Autos.java
Original file line number Diff line number Diff line change
Expand Up @@ -3,7 +3,6 @@
import static org.sciborgs1155.robot.Constants.Positions.*;

import com.pathplanner.lib.PathPlanner;
import com.pathplanner.lib.PathPlannerTrajectory;
import com.pathplanner.lib.auto.SwerveAutoBuilder;
import edu.wpi.first.math.geometry.Pose2d;
import edu.wpi.first.math.geometry.Rotation2d;
Expand Down Expand Up @@ -117,10 +116,11 @@ public Command fullBalance() {
// trajectory.getInitialState(), DriverStation.getAlliance());
// Pose2d initialPose = new Pose2d(
// initialState.poseMeters.getTranslation(), initialState.holonomicRotation);

// return Commands.runOnce(() -> drive.resetOdometry(initialPose), drive)
// .andThen(drive.follow(trajectory, false, true))
return drive.follow("balance", false, true)
return drive
.follow("balance", false, true)
// followAutoPath("balance")
.andThen(drive.balance())
.withTimeout(10)
Expand Down Expand Up @@ -163,9 +163,7 @@ public Command frontHighCubeScore() {
/** no PPL */
public Command cubeBalance() {
return Commands.sequence(
backHighCubeScore(),
placement.goTo(BALANCE, false).withTimeout(2.5),
fullBalance());
backHighCubeScore(), placement.goTo(BALANCE, false).withTimeout(2.5), fullBalance());
}

/** no PPL */
Expand Down

0 comments on commit 671ea20

Please sign in to comment.