PLS5618/Reefscape-2025
6
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Compare commits

base: PLS5618:3f546b61d6f082a914cb9252e7c71651b6412f96
Branches Tags
PLS5618:main PLS5618:grimpe PLS5618:requin PLS5618:pince PLS5618:elevateur PLS5618:Limelight PLS5618:Swerve PLS5618:Led
..
compare: PLS5618:main
Branches Tags
PLS5618:main PLS5618:grimpe PLS5618:requin PLS5618:pince PLS5618:elevateur PLS5618:Limelight PLS5618:Swerve PLS5618:Led

1 Commits
3f546b61d6 ... main

Author SHA1 Message Date
Antoine PerreaultE
1d5e627dbf mode auto 2026-01-21 18:04:59 -05:00
27 changed files with 53 additions and 1922 deletions
Expand all files Collapse all files

57
src/main/deploy/pathplanner/autos/BlueBas1.auto
View File

@@ -1,57 +0,0 @@
{
"version": "2025.0",
"command": {
"type": "sequential",
"data": {
"commands": [
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueBasStart"
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "L4"
}
}
]
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralExpire"
}
}
]
}
},
"resetOdom": true,
"folder": null,
"choreoAuto": false
}

151
src/main/deploy/pathplanner/autos/BlueBas2.auto
View File

@@ -1,151 +0,0 @@
{
"version": "2025.0",
"command": {
"type": "sequential",
"data": {
"commands": [
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueBasStart"
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "L4"
}
}
]
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralExpire"
}
},
{
"type": "wait",
"data": {
"waitTime": 1.0
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueBasChercher"
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "Station"
}
}
]
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralExpire"
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "path",
"data": {
"pathName": "BlueBasPorter"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "L4"
}
}
]
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralExpire"
}
}
]
}
},
"resetOdom": true,
"folder": null,
"choreoAuto": false
}

126
src/main/deploy/pathplanner/autos/BlueBas3 sans composantes.auto
View File

@@ -1,126 +0,0 @@
{
"version": "2025.0",
"command": {
"type": "sequential",
"data": {
"commands": [
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueBasStart"
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
}
]
}
},
{
"type": "wait",
"data": {
"waitTime": 1.0
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueBasChercher"
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
}
]
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "path",
"data": {
"pathName": "BlueBasPorter"
}
}
]
}
},
{
"type": "wait",
"data": {
"waitTime": 1.0
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueBasChercher2"
}
},
{
"type": "sequential",
"data": {
"commands": []
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
}
]
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueBasPorter2"
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
}
]
}
}
]
}
},
"resetOdom": true,
"folder": null,
"choreoAuto": false
}

245
src/main/deploy/pathplanner/autos/BlueBas3.auto
View File

@@ -1,245 +0,0 @@
{
"version": "2025.0",
"command": {
"type": "sequential",
"data": {
"commands": [
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueBasStart"
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "L4"
}
}
]
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralExpire"
}
},
{
"type": "wait",
"data": {
"waitTime": 1.0
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueBasChercher"
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "Station"
}
}
]
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralInspire"
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "path",
"data": {
"pathName": "BlueBasPorter"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "L4"
}
}
]
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralExpire"
}
},
{
"type": "wait",
"data": {
"waitTime": 1.0
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueBasChercher2"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "CoralInspire"
}
}
]
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralInspire"
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueBasPorter2"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "CoralExpire"
}
}
]
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralExpire"
}
}
]
}
},
"resetOdom": true,
"folder": null,
"choreoAuto": false
}

32
src/main/deploy/pathplanner/autos/BlueHaut1.auto
View File

@@ -1,32 +0,0 @@
{
"version": "2025.0",
"command": {
"type": "sequential",
"data": {
"commands": [
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueHautStart"
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
}
]
}
}
]
}
},
"resetOdom": true,
"folder": null,
"choreoAuto": false
}

151
src/main/deploy/pathplanner/autos/BlueHaut2.auto
View File

@@ -1,151 +0,0 @@
{
"version": "2025.0",
"command": {
"type": "sequential",
"data": {
"commands": [
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueHautStart"
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "L4"
}
}
]
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralExpire"
}
},
{
"type": "wait",
"data": {
"waitTime": 1.0
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueHautChercher"
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "Station"
}
}
]
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralInspire"
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "path",
"data": {
"pathName": "BlueHautPorter"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "L4"
}
}
]
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralExpire"
}
}
]
}
},
"resetOdom": true,
"folder": null,
"choreoAuto": false
}

245
src/main/deploy/pathplanner/autos/BlueHaut3.auto
View File

@@ -1,245 +0,0 @@
{
"version": "2025.0",
"command": {
"type": "sequential",
"data": {
"commands": [
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueHautStart"
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "L4"
}
}
]
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralExpire"
}
},
{
"type": "wait",
"data": {
"waitTime": 1.0
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueHautChercher"
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "Station"
}
}
]
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralInspire"
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "path",
"data": {
"pathName": "BlueHautPorter"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "L4"
}
}
]
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralExpire"
}
},
{
"type": "wait",
"data": {
"waitTime": 1.0
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueHautChercher2"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "Station"
}
}
]
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralInspire"
}
},
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueHautPorter2"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "L4"
}
}
]
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
}
]
}
},
{
"type": "named",
"data": {
"name": "CoralExpire"
}
}
]
}
},
"resetOdom": true,
"folder": null,
"choreoAuto": false
}

87
src/main/deploy/pathplanner/autos/MilieuAlgue.auto
View File

@@ -1,87 +0,0 @@
{
"version": "2025.0",
"command": {
"type": "sequential",
"data": {
"commands": [
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueMilieuStart"
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "L4"
}
},
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "CoralExpire"
}
},
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "L3"
}
},
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "CoraletAlgue"
}
}
]
}
}
]
}
}
]
}
},
"resetOdom": true,
"folder": null,
"choreoAuto": false
}

57
src/main/deploy/pathplanner/autos/MilieuPasAlgue.auto
View File

@@ -1,57 +0,0 @@
{
"version": "2025.0",
"command": {
"type": "sequential",
"data": {
"commands": [
{
"type": "parallel",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "BlueMilieuStart"
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
},
{
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 0.5
}
},
{
"type": "named",
"data": {
"name": "L4"
}
},
{
"type": "named",
"data": {
"name": "CoralExpire"
}
}
]
}
}
]
}
}
]
}
},
"resetOdom": true,
"folder": null,
"choreoAuto": false
}

19
src/main/deploy/pathplanner/autos/New Auto.auto
View File

@@ -9,6 +9,25 @@
"data": {
"pathName": "New Path"
}
},
{
"type": "deadline",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 1.0
}
},
{
"type": "named",
"data": {
"name": "AprilTag"
}
}
]
}
}
]
}

25
src/main/deploy/pathplanner/autos/Sortir.auto
View File

@@ -1,25 +0,0 @@
{
"version": "2025.0",
"command": {
"type": "sequential",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 3.0
}
},
{
"type": "path",
"data": {
"pathName": "Sortir"
}
}
]
}
},
"resetOdom": true,
"folder": null,
"choreoAuto": false
}

63
src/main/deploy/pathplanner/autos/baleeuse.auto
View File

@@ -1,63 +0,0 @@
{
"version": "2025.0",
"command": {
"type": "sequential",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "New Path"
}
},
{
"type": "wait",
"data": {
"waitTime": 2.0
}
},
{
"type": "deadline",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 2.0
}
},
{
"type": "named",
"data": {
"name": "baleeuse"
}
}
]
}
},
{
"type": "deadline",
"data": {
"commands": [
{
"type": "wait",
"data": {
"waitTime": 2.0
}
},
{
"type": "named",
"data": {
"name": "baleeuse sort"
}
}
]
}
}
]
}
},
"resetOdom": true,
"folder": null,
"choreoAuto": false
}

70
src/main/deploy/pathplanner/paths/BlueBasChercher.path
View File

@@ -1,70 +0,0 @@
{
"version": "2025.0",
"waypoints": [
{
"anchor": {
"x": 5.226639344262295,
"y": 2.748309426229507
},
"prevControl": null,
"nextControl": {
"x": 4.699180327868851,
"y": 2.1728995901639334
},
"isLocked": true,
"linkedName": null
},
{
"anchor": {
"x": 3.296618852459016,
"y": 1.6334528688524586
},
"prevControl": {
"x": 4.5553278688524586,
"y": 1.9091700819672122
},
"nextControl": {
"x": 2.853313965378558,
"y": 1.5363479888253109
},
"isLocked": true,
"linkedName": null
},
{
"anchor": {
"x": 1.2227459016393443,
"y": 1.141956967213115
},
"prevControl": {
"x": 2.2217919676666584,
"y": 1.3902362024139756
},
"nextControl": null,
"isLocked": true,
"linkedName": null
}
],
"rotationTargets": [],
"constraintZones": [],
"pointTowardsZones": [],
"eventMarkers": [],
"globalConstraints": {
"maxVelocity": 3.0,
"maxAcceleration": 3.0,
"maxAngularVelocity": 540.0,
"maxAngularAcceleration": 720.0,
"nominalVoltage": 12.0,
"unlimited": false
},
"goalEndState": {
"velocity": 0,
"rotation": -125.00000000000001
},
"reversed": false,
"folder": null,
"idealStartingState": {
"velocity": 0,
"rotation": 119.99999999999999
},
"useDefaultConstraints": true
}

54
src/main/deploy/pathplanner/paths/BlueBasChercher2.path
View File

@@ -1,54 +0,0 @@
{
"version": "2025.0",
"waypoints": [
{
"anchor": {
"x": 3.7761270491803276,
"y": 2.7602971311475404
},
"prevControl": null,
"nextControl": {
"x": 3.152766393442623,
"y": 1.2138831967213104
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 1.1987704918032787,
"y": 1.153944672131147
},
"prevControl": {
"x": 2.049897540983607,
"y": 1.1899077868852443
},
"nextControl": null,
"isLocked": false,
"linkedName": null
}
],
"rotationTargets": [],
"constraintZones": [],
"pointTowardsZones": [],
"eventMarkers": [],
"globalConstraints": {
"maxVelocity": 3.0,
"maxAcceleration": 3.0,
"maxAngularVelocity": 540.0,
"maxAngularAcceleration": 720.0,
"nominalVoltage": 12.0,
"unlimited": false
},
"goalEndState": {
"velocity": 0,
"rotation": -125.00000000000001
},
"reversed": false,
"folder": null,
"idealStartingState": {
"velocity": 0,
"rotation": 59.99999999999999
},
"useDefaultConstraints": true
}

54
src/main/deploy/pathplanner/paths/BlueBasPorter.path
View File

@@ -1,54 +0,0 @@
{
"version": "2025.0",
"waypoints": [
{
"anchor": {
"x": 1.1987704918032787,
"y": 1.153944672131147
},
"prevControl": null,
"nextControl": {
"x": 2.1697745901639345,
"y": 1.0820184426229504
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 3.788114754098361,
"y": 2.7722848360655736
},
"prevControl": {
"x": 3.5483606557377048,
"y": 1.1899077868852452
},
"nextControl": null,
"isLocked": false,
"linkedName": null
}
],
"rotationTargets": [],
"constraintZones": [],
"pointTowardsZones": [],
"eventMarkers": [],
"globalConstraints": {
"maxVelocity": 3.0,
"maxAcceleration": 3.0,
"maxAngularVelocity": 540.0,
"maxAngularAcceleration": 720.0,
"nominalVoltage": 12.0,
"unlimited": false
},
"goalEndState": {
"velocity": 0,
"rotation": 59.99999999999999
},
"reversed": false,
"folder": null,
"idealStartingState": {
"velocity": 0,
"rotation": -125.00000000000001
},
"useDefaultConstraints": true
}

54
src/main/deploy/pathplanner/paths/BlueBasPorter2.path
View File

@@ -1,54 +0,0 @@
{
"version": "2025.0",
"waypoints": [
{
"anchor": {
"x": 1.2107581967213117,
"y": 1.141956967213115
},
"prevControl": null,
"nextControl": {
"x": 3.392520491803279,
"y": 1.7293545081967205
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 2.9969262295081966,
"y": 4.019006147540983
},
"prevControl": {
"x": 1.738217213114754,
"y": 3.5035348360655734
},
"nextControl": null,
"isLocked": false,
"linkedName": null
}
],
"rotationTargets": [],
"constraintZones": [],
"pointTowardsZones": [],
"eventMarkers": [],
"globalConstraints": {
"maxVelocity": 3.0,
"maxAcceleration": 3.0,
"maxAngularVelocity": 540.0,
"maxAngularAcceleration": 720.0,
"nominalVoltage": 12.0,
"unlimited": false
},
"goalEndState": {
"velocity": 0,
"rotation": 0.0
},
"reversed": false,
"folder": null,
"idealStartingState": {
"velocity": 0,
"rotation": -125.00000000000001
},
"useDefaultConstraints": true
}

54
src/main/deploy/pathplanner/paths/BlueBasStart.path
View File

@@ -1,54 +0,0 @@
{
"version": "2025.0",
"waypoints": [
{
"anchor": {
"x": 7.204610655737704,
"y": 1.058043032786885
},
"prevControl": null,
"nextControl": {
"x": 6.40062663880838,
"y": 1.8077964923366423
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 5.214651639344262,
"y": 2.7722848360655736
},
"prevControl": {
"x": 6.021565749152438,
"y": 2.0272293626478377
},
"nextControl": null,
"isLocked": false,
"linkedName": null
}
],
"rotationTargets": [],
"constraintZones": [],
"pointTowardsZones": [],
"eventMarkers": [],
"globalConstraints": {
"maxVelocity": 1.0,
"maxAcceleration": 1.0,
"maxAngularVelocity": 540.0,
"maxAngularAcceleration": 720.0,
"nominalVoltage": 12.0,
"unlimited": false
},
"goalEndState": {
"velocity": 0,
"rotation": 119.99999999999999
},
"reversed": false,
"folder": null,
"idealStartingState": {
"velocity": 0,
"rotation": 119.99999999999999
},
"useDefaultConstraints": false
}

54
src/main/deploy/pathplanner/paths/BlueHautChercher.path
View File

@@ -1,54 +0,0 @@
{
"version": "2025.0",
"waypoints": [
{
"anchor": {
"x": 5.262602459016393,
"y": 5.33765368852459
},
"prevControl": null,
"nextControl": {
"x": 4.567315573770491,
"y": 6.272694672131147
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 1.3066598360655735,
"y": 6.920030737704917
},
"prevControl": {
"x": 2.074600566094311,
"y": 6.608197684403563
},
"nextControl": null,
"isLocked": false,
"linkedName": null
}
],
"rotationTargets": [],
"constraintZones": [],
"pointTowardsZones": [],
"eventMarkers": [],
"globalConstraints": {
"maxVelocity": 3.0,
"maxAcceleration": 3.0,
"maxAngularVelocity": 540.0,
"maxAngularAcceleration": 720.0,
"nominalVoltage": 12.0,
"unlimited": false
},
"goalEndState": {
"velocity": 0,
"rotation": 125.00000000000001
},
"reversed": false,
"folder": null,
"idealStartingState": {
"velocity": 0,
"rotation": -119.99999999999999
},
"useDefaultConstraints": true
}

54
src/main/deploy/pathplanner/paths/BlueHautChercher2.path
View File

@@ -1,54 +0,0 @@
{
"version": "2025.0",
"waypoints": [
{
"anchor": {
"x": 3.728176229508197,
"y": 5.277715163934426
},
"prevControl": null,
"nextControl": {
"x": 3.6884488572050125,
"y": 5.738000701502482
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 1.2946721311475409,
"y": 6.88406762295082
},
"prevControl": {
"x": 1.5370661625758562,
"y": 6.822870126858832
},
"nextControl": null,
"isLocked": false,
"linkedName": null
}
],
"rotationTargets": [],
"constraintZones": [],
"pointTowardsZones": [],
"eventMarkers": [],
"globalConstraints": {
"maxVelocity": 3.0,
"maxAcceleration": 3.0,
"maxAngularVelocity": 540.0,
"maxAngularAcceleration": 720.0,
"nominalVoltage": 12.0,
"unlimited": false
},
"goalEndState": {
"velocity": 0,
"rotation": 125.00000000000001
},
"reversed": false,
"folder": null,
"idealStartingState": {
"velocity": 0,
"rotation": -59.99999999999999
},
"useDefaultConstraints": true
}

54
src/main/deploy/pathplanner/paths/BlueHautPorter.path
View File

@@ -1,54 +0,0 @@
{
"version": "2025.0",
"waypoints": [
{
"anchor": {
"x": 1.2946721311475409,
"y": 6.88406762295082
},
"prevControl": null,
"nextControl": {
"x": 1.8197466808473133,
"y": 6.152201615570423
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 3.7401639344262296,
"y": 5.313678278688524
},
"prevControl": {
"x": 2.9533875048545335,
"y": 6.158498893994983
},
"nextControl": null,
"isLocked": false,
"linkedName": null
}
],
"rotationTargets": [],
"constraintZones": [],
"pointTowardsZones": [],
"eventMarkers": [],
"globalConstraints": {
"maxVelocity": 3.0,
"maxAcceleration": 3.0,
"maxAngularVelocity": 540.0,
"maxAngularAcceleration": 720.0,
"nominalVoltage": 12.0,
"unlimited": false
},
"goalEndState": {
"velocity": 0,
"rotation": -59.99999999999999
},
"reversed": false,
"folder": null,
"idealStartingState": {
"velocity": 0,
"rotation": 125.00000000000001
},
"useDefaultConstraints": true
}

54
src/main/deploy/pathplanner/paths/BlueHautPorter2.path
View File

@@ -1,54 +0,0 @@
{
"version": "2025.0",
"waypoints": [
{
"anchor": {
"x": 1.2467213114754097,
"y": 6.896055327868852
},
"prevControl": null,
"nextControl": {
"x": 3.728176229508196,
"y": 6.28468237704918
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 2.9969262295081966,
"y": 3.9950307377049183
},
"prevControl": {
"x": 2.6372950819672134,
"y": 4.906096311475409
},
"nextControl": null,
"isLocked": false,
"linkedName": null
}
],
"rotationTargets": [],
"constraintZones": [],
"pointTowardsZones": [],
"eventMarkers": [],
"globalConstraints": {
"maxVelocity": 3.0,
"maxAcceleration": 3.0,
"maxAngularVelocity": 540.0,
"maxAngularAcceleration": 720.0,
"nominalVoltage": 12.0,
"unlimited": false
},
"goalEndState": {
"velocity": 0,
"rotation": 0.0
},
"reversed": false,
"folder": null,
"idealStartingState": {
"velocity": 0,
"rotation": 125.00000000000001
},
"useDefaultConstraints": true
}

54
src/main/deploy/pathplanner/paths/BlueHautStart.path
View File

@@ -1,54 +0,0 @@
{
"version": "2025.0",
"waypoints": [
{
"anchor": {
"x": 7.22858606557377,
"y": 7.075870901639344
},
"prevControl": null,
"nextControl": {
"x": 5.75022271481963,
"y": 5.75328924697144
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 5.226639344262295,
"y": 5.313678278688524
},
"prevControl": {
"x": 6.307613733266616,
"y": 6.263998815998496
},
"nextControl": null,
"isLocked": false,
"linkedName": null
}
],
"rotationTargets": [],
"constraintZones": [],
"pointTowardsZones": [],
"eventMarkers": [],
"globalConstraints": {
"maxVelocity": 3.0,
"maxAcceleration": 3.0,
"maxAngularVelocity": 540.0,
"maxAngularAcceleration": 720.0,
"nominalVoltage": 12.0,
"unlimited": false
},
"goalEndState": {
"velocity": 0,
"rotation": -119.99999999999999
},
"reversed": false,
"folder": null,
"idealStartingState": {
"velocity": 0,
"rotation": -119.99999999999999
},
"useDefaultConstraints": true
}

54
src/main/deploy/pathplanner/paths/BlueMilieuStart.path
View File

@@ -1,54 +0,0 @@
{
"version": "2025.0",
"waypoints": [
{
"anchor": {
"x": 7.300512295081968,
"y": 3.971055327868852
},
"prevControl": null,
"nextControl": {
"x": 6.294286688638351,
"y": 3.9754565484205786
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 5.9818647540983605,
"y": 3.971055327868852
},
"prevControl": {
"x": 6.956229117816136,
"y": 3.9576132249181755
},
"nextControl": null,
"isLocked": false,
"linkedName": null
}
],
"rotationTargets": [],
"constraintZones": [],
"pointTowardsZones": [],
"eventMarkers": [],
"globalConstraints": {
"maxVelocity": 3.0,
"maxAcceleration": 3.0,
"maxAngularVelocity": 540.0,
"maxAngularAcceleration": 720.0,
"nominalVoltage": 12.0,
"unlimited": false
},
"goalEndState": {
"velocity": 0,
"rotation": 180.0
},
"reversed": false,
"folder": null,
"idealStartingState": {
"velocity": 0,
"rotation": 180.0
},
"useDefaultConstraints": true
}

37
src/main/deploy/pathplanner/paths/New Path.path
View File

@@ -3,25 +3,25 @@
"waypoints": [
{
"anchor": {
"x": 16.243,
"y": 6.55025
"x": 14.0,
"y": 3.0
},
"prevControl": null,
"nextControl": {
"x": 15.354412756981612,
"y": 6.548572497113415
"x": 13.971750000000002,
"y": 4.727
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 1.3552499999999998,
"y": 6.55025
"x": 14.0,
"y": 5.0
},
"prevControl": {
"x": 2.306674365666888,
"y": 6.526815183428469
"x": 13.9815,
"y": 3.7562499999999996
},
"nextControl": null,
"isLocked": false,
@@ -30,18 +30,29 @@
],
"rotationTargets": [],
"constraintZones": [],
"pointTowardsZones": [],
"pointTowardsZones": [
{
"fieldPosition": {
"x": 11.9,
"y": 4.0
},
"rotationOffset": 180.0,
"minWaypointRelativePos": 0.0,
"maxWaypointRelativePos": 1.0,
"name": "Point Towards Zone"
}
],
"eventMarkers": [],
"globalConstraints": {
"maxVelocity": 3.0,
"maxVelocity": 1.0,
"maxAcceleration": 1.0,
"maxAngularVelocity": 0.1,
"maxAngularAcceleration": 0.1,
"maxAngularVelocity": 540.0,
"maxAngularAcceleration": 720.0,
"nominalVoltage": 12.0,
"unlimited": false
},
"goalEndState": {
"velocity": 0.0,
"velocity": 0,
"rotation": 0.0
},
"reversed": false,

54
src/main/deploy/pathplanner/paths/Sortir.path
View File

@@ -1,54 +0,0 @@
{
"version": "2025.0",
"waypoints": [
{
"anchor": {
"x": 7.504303278688524,
"y": 6.464497950819672
},
"prevControl": null,
"nextControl": {
"x": 7.119564732833961,
"y": 6.478684258786044
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 5.815652951699465,
"y": 6.464497950819672
},
"prevControl": {
"x": 6.633711863494241,
"y": 6.455611583097
},
"nextControl": null,
"isLocked": false,
"linkedName": null
}
],
"rotationTargets": [],
"constraintZones": [],
"pointTowardsZones": [],
"eventMarkers": [],
"globalConstraints": {
"maxVelocity": 1.0,
"maxAcceleration": 1.0,
"maxAngularVelocity": 50.0,
"maxAngularAcceleration": 100.0,
"nominalVoltage": 12.0,
"unlimited": false
},
"goalEndState": {
"velocity": 0,
"rotation": 180.0
},
"reversed": false,
"folder": null,
"idealStartingState": {
"velocity": 0,
"rotation": 180.0
},
"useDefaultConstraints": false
}

6
src/main/java/frc/robot/RobotContainer.java
View File

@@ -98,7 +98,9 @@ public class RobotContainer {
autoChooser = AutoBuilder.buildAutoChooser();
CameraServer.startAutomaticCapture();
SmartDashboard.putData("Auto Chooser", autoChooser);
//NamedCommands.registerCommand("AprilTag", new AprilTag3(limelight3, drivetrain,, null));
NamedCommands.registerCommand("AprilTag", new AprilTag3(limelight3,drivetrain));
NamedCommands.getCommand("AprilTag");
NamedCommands.registerCommand("L2", new L2(elevateur, pince));
configureBindings();
}
@@ -142,7 +144,7 @@ public class RobotContainer {
//limelight
manette2.a().whileTrue(new Forme3(limelight3,drivetrain,manette1::getLeftX,manette1::getLeftY));
manette2.b().whileTrue(new AprilTag3(limelight3, drivetrain, manette1::getLeftX, manette1::getLeftY));
manette2.b().whileTrue(new AprilTag3(limelight3, drivetrain));
//Pince manuel
pince.setDefaultCommand(new RunCommand(()->{

10
src/main/java/frc/robot/commands/Limelight/AprilTag3.java
View File

@@ -8,9 +8,11 @@ import static edu.wpi.first.units.Units.*;
import java.util.Optional;
import java.util.function.DoubleSupplier;
import com.ctre.phoenix6.mechanisms.swerve.LegacySwerveRequest;
import com.ctre.phoenix6.swerve.SwerveModule.DriveRequestType;
import com.ctre.phoenix6.swerve.SwerveRequest;
import edu.wpi.first.math.filter.SlewRateLimiter;
import edu.wpi.first.math.geometry.Rotation2d;
import edu.wpi.first.math.MathUtil;
import edu.wpi.first.wpilibj.DriverStation;
import edu.wpi.first.wpilibj.DriverStation.Alliance;
@@ -33,7 +35,7 @@ public class AprilTag3 extends Command {
.withDeadband(MaxSpeed * 0.1).withRotationalDeadband(MaxAngularRate * 0.1) // Add a 10% deadband
.withDriveRequestType(DriveRequestType.OpenLoopVoltage); // Use open-loop control for drive motors
/** Creates a new AprilTag3G. */
public AprilTag3(Limelight3 limelight3,CommandSwerveDrivetrain drivetrain, DoubleSupplier x, DoubleSupplier y) {
public AprilTag3(Limelight3 limelight3,CommandSwerveDrivetrain drivetrain) {
this.limelight3 = limelight3;
this.drivetrain = drivetrain;
this.x = x;
@@ -58,7 +60,7 @@ public class AprilTag3 extends Command {
double x2 = 0;
double angle = drivetrain.getPigeon2().getYaw().getValueAsDouble();
if(angle >180){
angle =- angle * 2;
angle =- 360;
}
if(alliance.get() == DriverStation.Alliance.Red){
BotPose = limelight3.getBotPoseRed();
@@ -76,8 +78,8 @@ public class AprilTag3 extends Command {
if(limelight3.getV() == true){
drivetrain.setControl(drive.
withRotationalRate(limelight3.Calcule(botx,x2,boty,y2,angle)).
withVelocityX(x.getAsDouble()).
withVelocityY(y.getAsDouble()));
withVelocityX(0).
withVelocityY(0));
// if(tagId ==10){
// drivetrain.setControl(drive.
// withRotationalRate(tx/20).