Skip to content

Commit

Permalink
basic paths all done, will add rerouting stuff at future date
Browse files Browse the repository at this point in the history
  • Loading branch information
jopy-wng committed Aug 9, 2024
1 parent 50bd894 commit 9b6af67
Show file tree
Hide file tree
Showing 28 changed files with 798 additions and 46 deletions.
2 changes: 1 addition & 1 deletion src/main/deploy/pathplanner/paths/F Shoot ALT to E.path
Original file line number Diff line number Diff line change
Expand Up @@ -43,7 +43,7 @@
"rotateFast": false
},
"reversed": false,
"folder": "FGH",
"folder": "HGF",
"previewStartingState": {
"rotation": 17.734765504348854,
"velocity": 0
Expand Down
2 changes: 1 addition & 1 deletion src/main/deploy/pathplanner/paths/F Shoot to A.path
Original file line number Diff line number Diff line change
Expand Up @@ -43,7 +43,7 @@
"rotateFast": false
},
"reversed": false,
"folder": "FGH",
"folder": "HGF",
"previewStartingState": {
"rotation": -16.0,
"velocity": 0
Expand Down
2 changes: 1 addition & 1 deletion src/main/deploy/pathplanner/paths/F Shoot to C.path
Original file line number Diff line number Diff line change
Expand Up @@ -49,7 +49,7 @@
"rotateFast": false
},
"reversed": false,
"folder": "FGH",
"folder": "HGF",
"previewStartingState": {
"rotation": -3.382897056838466,
"velocity": 0
Expand Down
2 changes: 1 addition & 1 deletion src/main/deploy/pathplanner/paths/F Shoot to E.path
Original file line number Diff line number Diff line change
Expand Up @@ -49,7 +49,7 @@
"rotateFast": false
},
"reversed": false,
"folder": "FGH",
"folder": "HGF",
"previewStartingState": {
"rotation": -3.5408335937068656,
"velocity": 0
Expand Down
2 changes: 1 addition & 1 deletion src/main/deploy/pathplanner/paths/F Shoot to G.path
Original file line number Diff line number Diff line change
Expand Up @@ -43,7 +43,7 @@
"rotateFast": false
},
"reversed": false,
"folder": "FGH",
"folder": "HGF",
"previewStartingState": {
"rotation": -6.680432083088365,
"velocity": 0
Expand Down
2 changes: 1 addition & 1 deletion src/main/deploy/pathplanner/paths/F to Shoot ALT.path
Original file line number Diff line number Diff line change
Expand Up @@ -49,7 +49,7 @@
"rotateFast": false
},
"reversed": false,
"folder": "FGH",
"folder": "HGF",
"previewStartingState": {
"rotation": -27.35687342191869,
"velocity": 0
Expand Down
2 changes: 1 addition & 1 deletion src/main/deploy/pathplanner/paths/F to Shoot.path
Original file line number Diff line number Diff line change
Expand Up @@ -43,7 +43,7 @@
"rotateFast": false
},
"reversed": false,
"folder": "FGH",
"folder": "HGF",
"previewStartingState": {
"rotation": -27.729825561933676,
"velocity": 0
Expand Down
2 changes: 1 addition & 1 deletion src/main/deploy/pathplanner/paths/G Shoot to F.path
Original file line number Diff line number Diff line change
Expand Up @@ -49,7 +49,7 @@
"rotateFast": false
},
"reversed": false,
"folder": "FGH",
"folder": "HGF",
"previewStartingState": {
"rotation": -9.481237644879682,
"velocity": 0
Expand Down
2 changes: 1 addition & 1 deletion src/main/deploy/pathplanner/paths/G Shoot to H.path
Original file line number Diff line number Diff line change
Expand Up @@ -49,7 +49,7 @@
"rotateFast": false
},
"reversed": false,
"folder": "FGH",
"folder": "HGF",
"previewStartingState": {
"rotation": -8.909069649342515,
"velocity": 0
Expand Down
2 changes: 1 addition & 1 deletion src/main/deploy/pathplanner/paths/G to Shoot.path
Original file line number Diff line number Diff line change
Expand Up @@ -43,7 +43,7 @@
"rotateFast": false
},
"reversed": false,
"folder": "FGH",
"folder": "HGF",
"previewStartingState": {
"rotation": -15.0,
"velocity": 0
Expand Down
2 changes: 1 addition & 1 deletion src/main/deploy/pathplanner/paths/H Shoot to G.path
Original file line number Diff line number Diff line change
Expand Up @@ -49,7 +49,7 @@
"rotateFast": false
},
"reversed": false,
"folder": "FGH",
"folder": "HGF",
"previewStartingState": {
"rotation": -5.742284345235014,
"velocity": 0
Expand Down
2 changes: 1 addition & 1 deletion src/main/deploy/pathplanner/paths/H to Shoot.path
Original file line number Diff line number Diff line change
Expand Up @@ -43,7 +43,7 @@
"rotateFast": false
},
"reversed": false,
"folder": "FGH",
"folder": "HGF",
"previewStartingState": {
"rotation": -57.0617176721166,
"velocity": 0
Expand Down
161 changes: 161 additions & 0 deletions src/main/deploy/pathplanner/paths/Point Locations.path
Original file line number Diff line number Diff line change
@@ -0,0 +1,161 @@
{
"version": 1.0,
"waypoints": [
{
"anchor": {
"x": 2.9,
"y": 7.0
},
"prevControl": null,
"nextControl": {
"x": 2.8606755147290057,
"y": 6.160145784763296
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 0.25,
"y": 5.55
},
"prevControl": {
"x": 0.23853011040910355,
"y": 5.685869940164359
},
"nextControl": {
"x": 0.26146988959089645,
"y": 5.4141300598356406
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 2.9,
"y": 5.55
},
"prevControl": {
"x": 2.89563193569979,
"y": 5.358936627062242
},
"nextControl": {
"x": 2.90436806430021,
"y": 5.741063372937758
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 2.9,
"y": 4.1
},
"prevControl": {
"x": 2.910352370185796,
"y": 4.231098373366762
},
"nextControl": {
"x": 2.889647629814204,
"y": 3.9689016266332375
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 8.28,
"y": 7.44
},
"prevControl": {
"x": 7.180548926469876,
"y": 6.917676610673163
},
"nextControl": {
"x": 8.69419010200492,
"y": 7.63677199205437
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 8.28,
"y": 5.77
},
"prevControl": {
"x": 8.28838041697661,
"y": 6.311456818590719
},
"nextControl": {
"x": 8.269224286337115,
"y": 5.073783611933209
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 8.28,
"y": 4.1
},
"prevControl": {
"x": 8.286182106596115,
"y": 4.544857124277373
},
"nextControl": {
"x": 8.271362241199185,
"y": 3.4784370294187017
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 8.28,
"y": 2.44
},
"prevControl": {
"x": 8.274967786914742,
"y": 3.4775236245040944
},
"nextControl": {
"x": 8.282900374354867,
"y": 1.842011230029793
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 8.28,
"y": 0.77
},
"prevControl": {
"x": 8.266410625083155,
"y": 1.8410385351276657
},
"nextControl": null,
"isLocked": false,
"linkedName": null
}
],
"rotationTargets": [],
"constraintZones": [],
"eventMarkers": [],
"globalConstraints": {
"maxVelocity": 3.0,
"maxAcceleration": 3.0,
"maxAngularVelocity": 540.0,
"maxAngularAcceleration": 720.0
},
"goalEndState": {
"velocity": 0,
"rotation": 0,
"rotateFast": false
},
"reversed": false,
"folder": null,
"previewStartingState": null,
"useDefaultConstraints": false
}
2 changes: 1 addition & 1 deletion src/main/deploy/pathplanner/paths/Source to H.path
Original file line number Diff line number Diff line change
Expand Up @@ -70,7 +70,7 @@
"rotateFast": false
},
"reversed": false,
"folder": "FGH",
"folder": "HGF",
"previewStartingState": {
"rotation": -60.0,
"velocity": 0
Expand Down
Original file line number Diff line number Diff line change
@@ -0,0 +1,34 @@
package com.stuypulse.robot.commands.auton.ADEF;

import com.pathplanner.lib.path.PathPlannerPath;
import com.stuypulse.robot.commands.auton.FollowPathAlignAndShoot;
import com.stuypulse.robot.commands.auton.FollowPathAndIntake;
import com.stuypulse.robot.commands.shooter.ShooterScoreSpeaker;
import com.stuypulse.robot.commands.shooter.ShooterWaitForTarget;
import com.stuypulse.robot.commands.shooter.SwerveDriveToShoot;

import edu.wpi.first.wpilibj2.command.SequentialCommandGroup;

public class FivePieceADEF extends SequentialCommandGroup {

public FivePieceADEF(PathPlannerPath... paths) {
addCommands(
new ShooterScoreSpeaker(),

new ShooterWaitForTarget()
.withTimeout(1.0),

new FollowPathAndIntake(paths[0]),
new SwerveDriveToShoot(),

new FollowPathAndIntake(paths[1]),
new FollowPathAlignAndShoot(paths[2], new SwerveDriveToShoot()),

new FollowPathAndIntake(paths[3]),
new FollowPathAlignAndShoot(paths[4], new SwerveDriveToShoot()),

new FollowPathAndIntake(paths[5])
);
}

}
Original file line number Diff line number Diff line change
@@ -0,0 +1,36 @@
package com.stuypulse.robot.commands.auton.BF_Series;

import com.pathplanner.lib.path.PathPlannerPath;
import com.stuypulse.robot.commands.auton.FollowPathAlignAndShoot;
import com.stuypulse.robot.commands.auton.FollowPathAndIntake;
import com.stuypulse.robot.commands.shooter.ShooterScoreSpeaker;
import com.stuypulse.robot.commands.shooter.ShooterWaitForTarget;
import com.stuypulse.robot.commands.shooter.SwerveDriveToShoot;

import edu.wpi.first.wpilibj2.command.SequentialCommandGroup;

public class FivePieceBFAC extends SequentialCommandGroup {

public FivePieceBFAC(PathPlannerPath... paths) {

addCommands(
new ShooterScoreSpeaker(),

new ShooterWaitForTarget()
.withTimeout(1.0),

new FollowPathAndIntake(paths[0]),
new SwerveDriveToShoot(),

new FollowPathAndIntake(paths[1]),
new FollowPathAlignAndShoot(paths[2], new SwerveDriveToShoot()),

new FollowPathAndIntake(paths[3]),
new FollowPathAlignAndShoot(paths[4], new SwerveDriveToShoot()),

new FollowPathAndIntake(paths[5])
);

}

}
Original file line number Diff line number Diff line change
@@ -0,0 +1,36 @@
package com.stuypulse.robot.commands.auton.BF_Series;

import com.pathplanner.lib.path.PathPlannerPath;
import com.stuypulse.robot.commands.auton.FollowPathAlignAndShoot;
import com.stuypulse.robot.commands.auton.FollowPathAndIntake;
import com.stuypulse.robot.commands.shooter.ShooterScoreSpeaker;
import com.stuypulse.robot.commands.shooter.ShooterWaitForTarget;
import com.stuypulse.robot.commands.shooter.SwerveDriveToShoot;

import edu.wpi.first.wpilibj2.command.SequentialCommandGroup;

public class FivePieceBFCA extends SequentialCommandGroup {

public FivePieceBFCA(PathPlannerPath... paths) {

addCommands(
new ShooterScoreSpeaker(),

new ShooterWaitForTarget()
.withTimeout(1.0),

new FollowPathAndIntake(paths[0]),
new SwerveDriveToShoot(),

new FollowPathAndIntake(paths[1]),
new FollowPathAlignAndShoot(paths[2], new SwerveDriveToShoot()),

new FollowPathAndIntake(paths[3]),
new FollowPathAlignAndShoot(paths[4], new SwerveDriveToShoot()),

new FollowPathAndIntake(paths[5])
);

}

}
Loading

0 comments on commit 9b6af67

Please sign in to comment.