From 3c3deb1f52ebb5092f13fd5a9efcf1eb742df619 Mon Sep 17 00:00:00 2001 From: Jonathan Smith Date: Tue, 2 Apr 2024 13:42:09 -0500 Subject: [PATCH] Example amp side paths. --- .../deploy/pathplanner/paths/GKC Amp 1-2.path | 417 +++++++++++++++++ .../deploy/pathplanner/paths/GKC Amp 2-1.path | 417 +++++++++++++++++ .../pathplanner/paths/GKC Amp Skip 1-2.path | 417 +++++++++++++++++ .../pathplanner/paths/GKC Amp Skip 2-1.path | 438 ++++++++++++++++++ .../paths/GKC Amp Skip Poop 1-2.path | 324 +++++++++++++ 5 files changed, 2013 insertions(+) create mode 100644 src/main/deploy/pathplanner/paths/GKC Amp 1-2.path create mode 100644 src/main/deploy/pathplanner/paths/GKC Amp 2-1.path create mode 100644 src/main/deploy/pathplanner/paths/GKC Amp Skip 1-2.path create mode 100644 src/main/deploy/pathplanner/paths/GKC Amp Skip 2-1.path create mode 100644 src/main/deploy/pathplanner/paths/GKC Amp Skip Poop 1-2.path diff --git a/src/main/deploy/pathplanner/paths/GKC Amp 1-2.path b/src/main/deploy/pathplanner/paths/GKC Amp 1-2.path new file mode 100644 index 0000000..bf0d10c --- /dev/null +++ b/src/main/deploy/pathplanner/paths/GKC Amp 1-2.path @@ -0,0 +1,417 @@ +{ + "version": 1.0, + "waypoints": [ + { + "anchor": { + "x": 1.372426958844331, + "y": 5.52863543907909 + }, + "prevControl": null, + "nextControl": { + "x": 1.8850833916795005, + "y": 4.918640837873158 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 2.6, + "y": 4.2 + }, + "prevControl": { + "x": 2.3721694055866522, + "y": 3.881877332582569 + }, + "nextControl": { + "x": 2.8510652546936015, + "y": 4.550565509977382 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 2.637448541360017, + "y": 5.52863543907909 + }, + "prevControl": { + "x": 1.275646128345781, + "y": 5.5126234744208285 + }, + "nextControl": { + "x": 3.4438605292825732, + "y": 5.53811716721176 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 2.637448541360017, + "y": 6.818553917692418 + }, + "prevControl": { + "x": 1.1816916963062711, + "y": 6.529263049900243 + }, + "nextControl": { + "x": 3.2793581771299487, + "y": 6.946115464943247 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 8.049412688927902, + "y": 7.450320732136683 + }, + "prevControl": { + "x": 7.961623807291687, + "y": 7.6844000184075165 + }, + "nextControl": { + "x": 8.137201570564116, + "y": 7.21624144586585 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 4.652007746757904, + "y": 6.338468673182802 + }, + "prevControl": { + "x": 4.614378529489263, + "y": 6.768572594675335 + }, + "nextControl": { + "x": 4.669438895307436, + "y": 6.139229733564453 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 8.049412688927902, + "y": 5.837295227581277 + }, + "prevControl": { + "x": 8.31818153536093, + "y": 6.258915088578193 + }, + "nextControl": { + "x": 7.8881513810680834, + "y": 5.584323310983128 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 4.652007746757904, + "y": 6.0905610967350094 + }, + "prevControl": { + "x": 5.915758710522252, + "y": 6.634071772339375 + }, + "nextControl": null, + "isLocked": false, + "linkedName": null + } + ], + "rotationTargets": [ + { + "waypointRelativePos": 1, + "rotationDegrees": -24.0, + "rotateFast": false + }, + { + "waypointRelativePos": 2, + "rotationDegrees": 0, + "rotateFast": false + }, + { + "waypointRelativePos": 3, + "rotationDegrees": 25.0, + "rotateFast": false + }, + { + "waypointRelativePos": 4, + "rotationDegrees": 0, + "rotateFast": false + }, + { + "waypointRelativePos": 5, + "rotationDegrees": 7.528050390604918, + "rotateFast": false + }, + { + "waypointRelativePos": 6, + "rotationDegrees": -29.853897263921745, + "rotateFast": false + } + ], + "constraintZones": [ + { + "name": "Slow First Shot", + "minWaypointRelativePos": 0.85, + "maxWaypointRelativePos": 1.05, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Second Shot", + "minWaypointRelativePos": 2.1, + "maxWaypointRelativePos": 2.25, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Third Shot", + "minWaypointRelativePos": 3.05, + "maxWaypointRelativePos": 3.15, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Fourth Shot", + "minWaypointRelativePos": 4.8999999999999995, + "maxWaypointRelativePos": 5.15, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Fourth Intake", + "minWaypointRelativePos": 3.9000000000000004, + "maxWaypointRelativePos": 4.1000000000000005, + "constraints": { + "maxVelocity": 2.5, + "maxAcceleration": 2.5, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Fifth Intake", + "minWaypointRelativePos": 5.8500000000000005, + "maxWaypointRelativePos": 6.1, + "constraints": { + "maxVelocity": 2.5, + "maxAcceleration": 2.5, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + } + ], + "eventMarkers": [ + { + "name": "Intake Fourth Note", + "waypointRelativePos": 3.7, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Fourth Note", + "waypointRelativePos": 4.95, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake Fifth Note", + "waypointRelativePos": 5.6000000000000005, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Fifth Note", + "waypointRelativePos": 6.95, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake First Note", + "waypointRelativePos": 0.44999999999999996, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot First Note", + "waypointRelativePos": 1.0, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake Second Note", + "waypointRelativePos": 1.7999999999999998, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Second Note", + "waypointRelativePos": 2.1, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake Third Note", + "waypointRelativePos": 2.75, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Third Note", + "waypointRelativePos": 3.0999999999999996, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + } + ], + "globalConstraints": { + "maxVelocity": 4.75, + "maxAcceleration": 3.5, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + }, + "goalEndState": { + "velocity": 0, + "rotation": 5.516450362853158, + "rotateFast": false + }, + "reversed": false, + "folder": "GKC", + "previewStartingState": { + "rotation": 0, + "velocity": 0 + }, + "useDefaultConstraints": false +} \ No newline at end of file diff --git a/src/main/deploy/pathplanner/paths/GKC Amp 2-1.path b/src/main/deploy/pathplanner/paths/GKC Amp 2-1.path new file mode 100644 index 0000000..9f876f0 --- /dev/null +++ b/src/main/deploy/pathplanner/paths/GKC Amp 2-1.path @@ -0,0 +1,417 @@ +{ + "version": 1.0, + "waypoints": [ + { + "anchor": { + "x": 1.372426958844331, + "y": 5.52863543907909 + }, + "prevControl": null, + "nextControl": { + "x": 1.8850833916795005, + "y": 4.918640837873158 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 2.6, + "y": 4.2 + }, + "prevControl": { + "x": 2.3721694055866522, + "y": 3.881877332582569 + }, + "nextControl": { + "x": 2.8510652546936015, + "y": 4.550565509977382 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 2.637448541360017, + "y": 5.52863543907909 + }, + "prevControl": { + "x": 1.275646128345781, + "y": 5.5126234744208285 + }, + "nextControl": { + "x": 3.4438605292825732, + "y": 5.53811716721176 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 2.637448541360017, + "y": 6.818553917692418 + }, + "prevControl": { + "x": 1.1816916963062711, + "y": 6.529263049900243 + }, + "nextControl": { + "x": 3.2793581771299487, + "y": 6.946115464943247 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 7.973771682280054, + "y": 5.816498013746896 + }, + "prevControl": { + "x": 8.069976230447253, + "y": 6.007387241156137 + }, + "nextControl": { + "x": 7.86125783733723, + "y": 5.593247852053381 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 4.652007746757904, + "y": 6.338468673182802 + }, + "prevControl": { + "x": 4.614378529489263, + "y": 6.768572594675335 + }, + "nextControl": { + "x": 4.669438895307436, + "y": 6.139229733564453 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 7.973771682280054, + "y": 7.350730071396486 + }, + "prevControl": { + "x": 7.869801698804786, + "y": 7.579987638237719 + }, + "nextControl": { + "x": 8.097677450418217, + "y": 7.077513379699054 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 4.652007746757904, + "y": 6.0905610967350094 + }, + "prevControl": { + "x": 5.915758710522252, + "y": 6.634071772339375 + }, + "nextControl": null, + "isLocked": false, + "linkedName": null + } + ], + "rotationTargets": [ + { + "waypointRelativePos": 1, + "rotationDegrees": -24.0, + "rotateFast": false + }, + { + "waypointRelativePos": 2, + "rotationDegrees": 0, + "rotateFast": false + }, + { + "waypointRelativePos": 3, + "rotationDegrees": 25.0, + "rotateFast": false + }, + { + "waypointRelativePos": 4, + "rotationDegrees": -12.06444414982213, + "rotateFast": false + }, + { + "waypointRelativePos": 5, + "rotationDegrees": 7.528050390604918, + "rotateFast": false + }, + { + "waypointRelativePos": 6, + "rotationDegrees": 19.604346985049617, + "rotateFast": false + } + ], + "constraintZones": [ + { + "name": "Slow First Shot", + "minWaypointRelativePos": 0.85, + "maxWaypointRelativePos": 1.05, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Second Shot", + "minWaypointRelativePos": 2.1, + "maxWaypointRelativePos": 2.25, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Third Shot", + "minWaypointRelativePos": 3.05, + "maxWaypointRelativePos": 3.15, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Fourth Shot", + "minWaypointRelativePos": 4.8999999999999995, + "maxWaypointRelativePos": 5.15, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Fourth Intake", + "minWaypointRelativePos": 3.9000000000000004, + "maxWaypointRelativePos": 4.1000000000000005, + "constraints": { + "maxVelocity": 2.5, + "maxAcceleration": 2.5, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Fifth Intake", + "minWaypointRelativePos": 5.8500000000000005, + "maxWaypointRelativePos": 6.1, + "constraints": { + "maxVelocity": 2.5, + "maxAcceleration": 2.5, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + } + ], + "eventMarkers": [ + { + "name": "Intake Fourth Note", + "waypointRelativePos": 3.7, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Fourth Note", + "waypointRelativePos": 4.95, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake Fifth Note", + "waypointRelativePos": 5.6000000000000005, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Fifth Note", + "waypointRelativePos": 6.95, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake First Note", + "waypointRelativePos": 0.44999999999999996, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot First Note", + "waypointRelativePos": 1.0, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake Second Note", + "waypointRelativePos": 1.7999999999999998, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Second Note", + "waypointRelativePos": 2.1, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake Third Note", + "waypointRelativePos": 2.75, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Third Note", + "waypointRelativePos": 3.0999999999999996, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + } + ], + "globalConstraints": { + "maxVelocity": 4.75, + "maxAcceleration": 3.5, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + }, + "goalEndState": { + "velocity": 0, + "rotation": 5.516450362853158, + "rotateFast": false + }, + "reversed": false, + "folder": "GKC", + "previewStartingState": { + "rotation": 0, + "velocity": 0 + }, + "useDefaultConstraints": false +} \ No newline at end of file diff --git a/src/main/deploy/pathplanner/paths/GKC Amp Skip 1-2.path b/src/main/deploy/pathplanner/paths/GKC Amp Skip 1-2.path new file mode 100644 index 0000000..8e29ad4 --- /dev/null +++ b/src/main/deploy/pathplanner/paths/GKC Amp Skip 1-2.path @@ -0,0 +1,417 @@ +{ + "version": 1.0, + "waypoints": [ + { + "anchor": { + "x": 1.372426958844331, + "y": 5.52863543907909 + }, + "prevControl": null, + "nextControl": { + "x": 1.8850833916795005, + "y": 4.918640837873158 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 2.6, + "y": 4.2 + }, + "prevControl": { + "x": 2.3721694055866522, + "y": 3.881877332582569 + }, + "nextControl": { + "x": 2.8510652546936015, + "y": 4.550565509977382 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 2.637448541360017, + "y": 5.52863543907909 + }, + "prevControl": { + "x": 1.275646128345781, + "y": 5.5126234744208285 + }, + "nextControl": { + "x": 3.1374139827689698, + "y": 5.534513993046749 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 7.987489473604525, + "y": 7.395710954109988 + }, + "prevControl": { + "x": 8.056742897471912, + "y": 7.155494461581593 + }, + "nextControl": { + "x": 7.885838264515071, + "y": 7.748304306829969 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 4.534897509031129, + "y": 6.374771015528721 + }, + "prevControl": { + "x": 4.468068949695736, + "y": 6.550740841008809 + }, + "nextControl": { + "x": 4.6260005679733585, + "y": 6.134882717139567 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 7.987489473604525, + "y": 5.82710276462943 + }, + "prevControl": { + "x": 8.162852469802163, + "y": 6.387495510342583 + }, + "nextControl": { + "x": 7.906735171735859, + "y": 5.569043048876576 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 3.513173511083712, + "y": 6.233385162372176 + }, + "prevControl": { + "x": 5.169099768554707, + "y": 6.7994312999070115 + }, + "nextControl": { + "x": 2.8034908293104275, + "y": 5.990793960571533 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 2.637448541360017, + "y": 6.85471416692978 + }, + "prevControl": { + "x": 1.7312127572304625, + "y": 5.94932926888423 + }, + "nextControl": null, + "isLocked": false, + "linkedName": null + } + ], + "rotationTargets": [ + { + "waypointRelativePos": 1, + "rotationDegrees": -24.0, + "rotateFast": false + }, + { + "waypointRelativePos": 2, + "rotationDegrees": 0, + "rotateFast": false + }, + { + "waypointRelativePos": 3, + "rotationDegrees": 25.0, + "rotateFast": false + }, + { + "waypointRelativePos": 4, + "rotationDegrees": 10.266159276373791, + "rotateFast": false + }, + { + "waypointRelativePos": 5, + "rotationDegrees": -19.837836793864042, + "rotateFast": false + }, + { + "waypointRelativePos": 6, + "rotationDegrees": 11.803504246968744, + "rotateFast": false + } + ], + "constraintZones": [ + { + "name": "Slow First Shot", + "minWaypointRelativePos": 0.85, + "maxWaypointRelativePos": 1.05, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Second Shot", + "minWaypointRelativePos": 2.0, + "maxWaypointRelativePos": 2.1500000000000004, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Third Shot", + "minWaypointRelativePos": 3.8500000000000005, + "maxWaypointRelativePos": 4.15, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Fourth Shot", + "minWaypointRelativePos": 5.95, + "maxWaypointRelativePos": 6.15, + "constraints": { + "maxVelocity": 1.0, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Third Intake", + "minWaypointRelativePos": 2.85, + "maxWaypointRelativePos": 3.0999999999999996, + "constraints": { + "maxVelocity": 2.5, + "maxAcceleration": 2.5, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Fourth Intake", + "minWaypointRelativePos": 4.85, + "maxWaypointRelativePos": 5.1, + "constraints": { + "maxVelocity": 2.5, + "maxAcceleration": 2.5, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + } + ], + "eventMarkers": [ + { + "name": "Intake Fourth Note", + "waypointRelativePos": 4.6499999999999995, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Fourth Note", + "waypointRelativePos": 6.0, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake Fifth Note", + "waypointRelativePos": 6.7, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Fifth Note", + "waypointRelativePos": 6.95, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake First Note", + "waypointRelativePos": 0.44999999999999996, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot First Note", + "waypointRelativePos": 1.0, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake Second Note", + "waypointRelativePos": 1.7999999999999998, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Second Note", + "waypointRelativePos": 2.1, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake Third Note", + "waypointRelativePos": 2.7, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Third Note", + "waypointRelativePos": 4.0, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + } + ], + "globalConstraints": { + "maxVelocity": 4.75, + "maxAcceleration": 3.5, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + }, + "goalEndState": { + "velocity": 0, + "rotation": 30.27196191617931, + "rotateFast": false + }, + "reversed": false, + "folder": "GKC", + "previewStartingState": { + "rotation": 0, + "velocity": 0 + }, + "useDefaultConstraints": false +} \ No newline at end of file diff --git a/src/main/deploy/pathplanner/paths/GKC Amp Skip 2-1.path b/src/main/deploy/pathplanner/paths/GKC Amp Skip 2-1.path new file mode 100644 index 0000000..0560a6d --- /dev/null +++ b/src/main/deploy/pathplanner/paths/GKC Amp Skip 2-1.path @@ -0,0 +1,438 @@ +{ + "version": 1.0, + "waypoints": [ + { + "anchor": { + "x": 1.372426958844331, + "y": 5.52863543907909 + }, + "prevControl": null, + "nextControl": { + "x": 1.8850833916795005, + "y": 4.918640837873158 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 2.6, + "y": 4.2 + }, + "prevControl": { + "x": 2.3721694055866522, + "y": 3.881877332582569 + }, + "nextControl": { + "x": 2.8510652546936015, + "y": 4.550565509977382 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 2.637448541360017, + "y": 5.52863543907909 + }, + "prevControl": { + "x": 1.275646128345781, + "y": 5.5126234744208285 + }, + "nextControl": { + "x": 3.1374139827689698, + "y": 5.534513993046749 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 5.620620236755519, + "y": 6.612637925362657 + }, + "prevControl": { + "x": 4.92514839454744, + "y": 6.527753572788238 + }, + "nextControl": { + "x": 6.188089002263074, + "y": 6.681899131701909 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 8.081272252605268, + "y": 5.929319517131511 + }, + "prevControl": { + "x": 8.185410182524647, + "y": 6.23102834486919 + }, + "nextControl": { + "x": 7.963715860904219, + "y": 5.588734668165784 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 4.534897509031129, + "y": 6.374771015528721 + }, + "prevControl": { + "x": 4.419409497560889, + "y": 6.7577364437420915 + }, + "nextControl": { + "x": 4.6417751797449665, + "y": 6.020358012739081 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 8.081272252605268, + "y": 7.3517516682747495 + }, + "prevControl": { + "x": 7.94652759407026, + "y": 7.728373331215536 + }, + "nextControl": { + "x": 8.215518990065757, + "y": 6.976521732955213 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 3.513173511083712, + "y": 6.233385162372176 + }, + "prevControl": { + "x": 5.169099768554707, + "y": 6.7994312999070115 + }, + "nextControl": { + "x": 2.8034908293104275, + "y": 5.990793960571533 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 2.637448541360017, + "y": 6.85471416692978 + }, + "prevControl": { + "x": 1.7312127572304625, + "y": 5.94932926888423 + }, + "nextControl": null, + "isLocked": false, + "linkedName": null + } + ], + "rotationTargets": [ + { + "waypointRelativePos": 1, + "rotationDegrees": -24.0, + "rotateFast": false + }, + { + "waypointRelativePos": 2, + "rotationDegrees": 0, + "rotateFast": false + }, + { + "waypointRelativePos": 4.0, + "rotationDegrees": -35.40353936387164, + "rotateFast": false + }, + { + "waypointRelativePos": 5.0, + "rotationDegrees": 10.266159276373791, + "rotateFast": false + }, + { + "waypointRelativePos": 6.0, + "rotationDegrees": 18.668512655935807, + "rotateFast": false + }, + { + "waypointRelativePos": 7.0, + "rotationDegrees": 11.803504246968744, + "rotateFast": false + }, + { + "waypointRelativePos": 3, + "rotationDegrees": 0, + "rotateFast": false + } + ], + "constraintZones": [ + { + "name": "Slow First Shot", + "minWaypointRelativePos": 0.85, + "maxWaypointRelativePos": 1.05, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Second Shot", + "minWaypointRelativePos": 2.0, + "maxWaypointRelativePos": 2.3, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Third Shot", + "minWaypointRelativePos": 4.8500000000000005, + "maxWaypointRelativePos": 5.15, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Fourth Shot", + "minWaypointRelativePos": 6.95, + "maxWaypointRelativePos": 7.15, + "constraints": { + "maxVelocity": 1.0, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Third Intake", + "minWaypointRelativePos": 3.7, + "maxWaypointRelativePos": 4.1, + "constraints": { + "maxVelocity": 2.5, + "maxAcceleration": 2.5, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Fourth Intake", + "minWaypointRelativePos": 5.85, + "maxWaypointRelativePos": 6.1, + "constraints": { + "maxVelocity": 2.5, + "maxAcceleration": 2.5, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + } + ], + "eventMarkers": [ + { + "name": "Intake Fourth Note", + "waypointRelativePos": 5.6499999999999995, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Fourth Note", + "waypointRelativePos": 7.0, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake Fifth Note", + "waypointRelativePos": 7.7, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Fifth Note", + "waypointRelativePos": 7.95, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake First Note", + "waypointRelativePos": 0.44999999999999996, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot First Note", + "waypointRelativePos": 1.0, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake Second Note", + "waypointRelativePos": 1.7999999999999998, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Second Note", + "waypointRelativePos": 2.2, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake Third Note", + "waypointRelativePos": 3.4, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Third Note", + "waypointRelativePos": 5.0, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + } + ], + "globalConstraints": { + "maxVelocity": 4.75, + "maxAcceleration": 3.5, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + }, + "goalEndState": { + "velocity": 0, + "rotation": 30.27196191617931, + "rotateFast": false + }, + "reversed": false, + "folder": "GKC", + "previewStartingState": { + "rotation": 0, + "velocity": 0 + }, + "useDefaultConstraints": false +} \ No newline at end of file diff --git a/src/main/deploy/pathplanner/paths/GKC Amp Skip Poop 1-2.path b/src/main/deploy/pathplanner/paths/GKC Amp Skip Poop 1-2.path new file mode 100644 index 0000000..02307f2 --- /dev/null +++ b/src/main/deploy/pathplanner/paths/GKC Amp Skip Poop 1-2.path @@ -0,0 +1,324 @@ +{ + "version": 1.0, + "waypoints": [ + { + "anchor": { + "x": 1.372426958844331, + "y": 5.52863543907909 + }, + "prevControl": null, + "nextControl": { + "x": 1.8850833916795005, + "y": 4.918640837873158 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 2.6, + "y": 4.2 + }, + "prevControl": { + "x": 2.3721694055866522, + "y": 3.881877332582569 + }, + "nextControl": { + "x": 2.8510652546936015, + "y": 4.550565509977382 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 2.637448541360017, + "y": 5.52863543907909 + }, + "prevControl": { + "x": 1.275646128345781, + "y": 5.5126234744208285 + }, + "nextControl": { + "x": 3.1374139827689698, + "y": 5.534513993046749 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 7.987489473604525, + "y": 7.395710954109988 + }, + "prevControl": { + "x": 7.765438935243238, + "y": 7.728417368856476 + }, + "nextControl": { + "x": 8.15402737737549, + "y": 7.1461811430501205 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 7.987489473604525, + "y": 6.49213264018976 + }, + "prevControl": { + "x": 7.883485402381465, + "y": 6.981196187358252 + }, + "nextControl": { + "x": 8.102505879273911, + "y": 5.95128524183553 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 7.7061615499822445, + "y": 5.7 + }, + "prevControl": { + "x": 8.206161549982244, + "y": 5.7 + }, + "nextControl": { + "x": 7.2061615499822445, + "y": 5.7 + }, + "isLocked": false, + "linkedName": null + }, + { + "anchor": { + "x": 4.72923566977053, + "y": 6.2377378517054485 + }, + "prevControl": { + "x": 6.235418351551402, + "y": 6.658552256268285 + }, + "nextControl": null, + "isLocked": false, + "linkedName": null + } + ], + "rotationTargets": [ + { + "waypointRelativePos": 1, + "rotationDegrees": -24.0, + "rotateFast": false + }, + { + "waypointRelativePos": 2, + "rotationDegrees": 0, + "rotateFast": false + }, + { + "waypointRelativePos": 3, + "rotationDegrees": 14.651933320342092, + "rotateFast": false + }, + { + "waypointRelativePos": 4, + "rotationDegrees": -46.07473795905691, + "rotateFast": false + } + ], + "constraintZones": [ + { + "name": "Slow First Shot", + "minWaypointRelativePos": 0.85, + "maxWaypointRelativePos": 1.05, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Second Shot", + "minWaypointRelativePos": 2.0, + "maxWaypointRelativePos": 2.1500000000000004, + "constraints": { + "maxVelocity": 1.25, + "maxAcceleration": 1.25, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + }, + { + "name": "Slow Poop", + "minWaypointRelativePos": 2.9000000000000004, + "maxWaypointRelativePos": 4.0, + "constraints": { + "maxVelocity": 1.5, + "maxAcceleration": 2.75, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + } + } + ], + "eventMarkers": [ + { + "name": "Intake First Note", + "waypointRelativePos": 0.44999999999999996, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot First Note", + "waypointRelativePos": 1.0, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Intake Second Note", + "waypointRelativePos": 1.7999999999999998, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + }, + { + "name": "Shoot Second Note", + "waypointRelativePos": 2.1, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Poop Prep", + "waypointRelativePos": 2.7, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "PoopPrep" + } + } + ] + } + } + }, + { + "name": "Poop Start", + "waypointRelativePos": 2.85, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "InstantShoot" + } + } + ] + } + } + }, + { + "name": "Poop Stop", + "waypointRelativePos": 3.55, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "PoopStop" + } + } + ] + } + } + }, + { + "name": "Intake Third Note", + "waypointRelativePos": 3.75, + "command": { + "type": "parallel", + "data": { + "commands": [ + { + "type": "named", + "data": { + "name": "IntakeNoteAuto" + } + } + ] + } + } + } + ], + "globalConstraints": { + "maxVelocity": 4.75, + "maxAcceleration": 3.5, + "maxAngularVelocity": 540.0, + "maxAngularAcceleration": 360.0 + }, + "goalEndState": { + "velocity": 0, + "rotation": 4.842050314018797, + "rotateFast": false + }, + "reversed": false, + "folder": "GKC", + "previewStartingState": { + "rotation": 0, + "velocity": 0 + }, + "useDefaultConstraints": false +} \ No newline at end of file