bump side 3 and taxi 1 auto work, good path, trouble scoring cones an…

…d intaking cubes
team581 · Nov 10, 2023 · 3caeb8f · 3caeb8f
1 parent 85728e3
commit 3caeb8f
Show file tree

Hide file tree

Showing 10 changed files with 230 additions and 71 deletions.
diff --git a/.pathplanner/settings.json b/.pathplanner/settings.json
@@ -1,7 +1,7 @@
 {
-  "generateJSON": false,
-  "holonomicMode": true,
   "robotWidth": 0.82,
   "robotLength": 0.82,
+  "holonomicMode": true,
+  "generateJSON": false,
   "generateCSV": false
-}
+}
diff --git a/src/main/deploy/pathplanner/BlueTaxi1.path b/src/main/deploy/pathplanner/BlueTaxi1.path
@@ -0,0 +1,53 @@
+{
+  "waypoints": [
+    {
+      "anchorPoint": {
+        "x": 1.79,
+        "y": 0.53
+      },
+      "prevControl": null,
+      "nextControl": {
+        "x": 2.789999999999999,
+        "y": 0.53
+      },
+      "holonomicAngle": 0,
+      "isReversal": false,
+      "velOverride": null,
+      "isLocked": false,
+      "isStopPoint": false,
+      "stopEvent": {
+        "names": [
+          "preloadCone",
+          "scoreMid",
+          "stowFast"
+        ],
+        "executionBehavior": "sequential",
+        "waitBehavior": "none",
+        "waitTime": 0
+      }
+    },
+    {
+      "anchorPoint": {
+        "x": 5.5,
+        "y": 0.53
+      },
+      "prevControl": {
+        "x": 4.5,
+        "y": 0.53
+      },
+      "nextControl": null,
+      "holonomicAngle": 0,
+      "isReversal": false,
+      "velOverride": null,
+      "isLocked": false,
+      "isStopPoint": false,
+      "stopEvent": {
+        "names": [],
+        "executionBehavior": "parallel",
+        "waitBehavior": "none",
+        "waitTime": 0
+      }
+    }
+  ],
+  "markers": []
+}
diff --git a/src/main/deploy/pathplanner/RedLongSide3.path b/src/main/deploy/pathplanner/RedLongSide3.path
@@ -7,18 +7,18 @@
       },
       "prevControl": null,
       "nextControl": {
-        "x": 13.660888611007989,
-        "y": 0.5202858482640057
+        "x": 14.579966789485516,
+        "y": 0.5299207713800053
       },
       "holonomicAngle": 180.0,
       "isReversal": false,
-      "velOverride": null,
+      "velOverride": 0.15,
       "isLocked": false,
       "isStopPoint": false,
       "stopEvent": {
         "names": [
           "preloadCone",
-          "scoreMid",
+          "scoreLow",
           "stowFast"
         ],
         "executionBehavior": "sequential",
@@ -28,20 +28,45 @@
     },
     {
       "anchorPoint": {
-        "x": 10.187606240597097,
-        "y": 0.7707938492800054
+        "x": 14.2,
+        "y": 0.53
       },
       "prevControl": {
-        "x": 11.023917567065903,
-        "y": 0.7630859107872043
+        "x": 14.345802843766274,
+        "y": 0.53
       },
       "nextControl": {
-        "x": 9.830999053180866,
-        "y": 0.7740805514681738
+        "x": 14.036206307027998,
+        "y": 0.53
       },
       "holonomicAngle": 180.0,
       "isReversal": false,
-      "velOverride": 1.0,
+      "velOverride": null,
+      "isLocked": false,
+      "isStopPoint": false,
+      "stopEvent": {
+        "names": [],
+        "executionBehavior": "parallel",
+        "waitBehavior": "none",
+        "waitTime": 0
+      }
+    },
+    {
+      "anchorPoint": {
+        "x": 9.971783962802943,
+        "y": 0.6397588949013403
+      },
+      "prevControl": {
+        "x": 11.462136828124061,
+        "y": 0.6204890486693411
+      },
+      "nextControl": {
+        "x": 9.853114586772778,
+        "y": 0.6412932567841927
+      },
+      "holonomicAngle": 180.0,
+      "isReversal": false,
+      "velOverride": 0.25,
       "isLocked": false,
       "isStopPoint": false,
       "stopEvent": {
@@ -54,15 +79,15 @@
     {
       "anchorPoint": {
         "x": 9.62,
-        "y": 0.78
+        "y": 0.64
       },
       "prevControl": {
-        "x": 9.740545808014696,
-        "y": 0.7746478185264071
+        "x": 9.773304546609094,
+        "y": 0.6320509564096065
       },
       "nextControl": {
-        "x": 9.740545808014696,
-        "y": 0.7746478185264071
+        "x": 9.773304546609094,
+        "y": 0.6320509564096065
       },
       "holonomicAngle": 180.0,
       "isReversal": true,
@@ -79,15 +104,15 @@
     {
       "anchorPoint": {
         "x": 12.624728707918951,
-        "y": 0.7418890799320065
+        "y": 0.6
       },
       "prevControl": {
-        "x": 10.071987163205096,
-        "y": 0.7611589261640069
+        "x": 10.979596920732302,
+        "y": 0.6127811101776061
       },
       "nextControl": {
-        "x": 13.53135959906452,
-        "y": 0.7350452073520602
+        "x": 13.531358069008485,
+        "y": 0.5929563516767528
       },
       "holonomicAngle": 180.0,
       "isReversal": false,
@@ -103,16 +128,16 @@
     },
     {
       "anchorPoint": {
-        "x": 14.59,
-        "y": 1.0694764658760103
+        "x": 14.65,
+        "y": 1.05
       },
       "prevControl": {
-        "x": 14.015951329594964,
-        "y": 1.0598415427600094
+        "x": 14.075951329594965,
+        "y": 1.0403650768839992
       },
       "nextControl": {
-        "x": 14.015951329594964,
-        "y": 1.0598415427600094
+        "x": 14.075951329594965,
+        "y": 1.0403650768839992
       },
       "holonomicAngle": 180.0,
       "isReversal": true,
@@ -121,8 +146,7 @@
       "isStopPoint": true,
       "stopEvent": {
         "names": [
-          "scoreHigh",
-          "stowFast"
+          "scoreMid"
         ],
         "executionBehavior": "sequential",
         "waitBehavior": "none",
@@ -132,15 +156,15 @@
     {
       "anchorPoint": {
         "x": 11.979188859146946,
-        "y": 0.7804287723960073
+        "y": 0.7
       },
       "prevControl": {
         "x": 13.667528728490074,
-        "y": 0.7804287723960073
+        "y": 0.7
       },
       "nextControl": {
         "x": 11.603939938649107,
-        "y": 0.7804287723960073
+        "y": 0.7
       },
       "holonomicAngle": 180.0,
       "isReversal": false,
@@ -156,16 +180,16 @@
     },
     {
       "anchorPoint": {
-        "x": 9.854237900783493,
-        "y": 1.2371241280944092
+        "x": 9.44571716066509,
+        "y": 1.4645083136320125
       },
       "prevControl": {
-        "x": 10.873893555782077,
-        "y": 0.708413788465514
+        "x": 10.465372815663674,
+        "y": 0.9357979740031173
       },
       "nextControl": {
-        "x": 9.646123561477893,
-        "y": 1.3450352669936094
+        "x": 9.23760282135949,
+        "y": 1.5724194525312127
       },
       "holonomicAngle": 137.42,
       "isReversal": false,
@@ -194,7 +218,7 @@
       },
       "holonomicAngle": 137.41863116700682,
       "isReversal": false,
-      "velOverride": 0.1,
+      "velOverride": 0.4,
       "isLocked": false,
       "isStopPoint": false,
       "stopEvent": {
@@ -207,15 +231,15 @@
     {
       "anchorPoint": {
         "x": 12.64399855415095,
-        "y": 0.6299999999999999
+        "y": 0.6
       },
       "prevControl": {
         "x": 10.621177780817101,
-        "y": 0.6455398487720067
+        "y": 0.6155398487720067
       },
       "nextControl": {
         "x": 13.52173978262296,
-        "y": 0.6232569577437499
+        "y": 0.59325695774375
       },
       "holonomicAngle": 180.0,
       "isReversal": false,
@@ -231,12 +255,12 @@
     },
     {
       "anchorPoint": {
-        "x": 14.74,
-        "y": 1.07
+        "x": 14.59,
+        "y": 1.05
       },
       "prevControl": {
-        "x": 14.281570406986965,
-        "y": 1.070183086425008
+        "x": 14.131570406986965,
+        "y": 1.050183086425008
       },
       "nextControl": null,
       "holonomicAngle": 180.0,
@@ -246,7 +270,7 @@
       "isStopPoint": false,
       "stopEvent": {
         "names": [
-          "scoreMid",
+          "scoreHigh",
           "stowFast"
         ],
         "executionBehavior": "sequential",
@@ -260,31 +284,31 @@
   "isReversed": null,
   "markers": [
     {
-      "position": 0.15,
+      "position": 0.1,
       "names": [
         "intakeCube"
       ]
     },
     {
-      "position": 2.5781818181817564,
+      "position": 3.5781818181817564,
       "names": [
         "stowFast"
       ]
     },
     {
-      "position": 5.0,
+      "position": 5.2,
       "names": [
         "intakeCube"
       ]
     },
     {
-      "position": 7.498181818181809,
+      "position": 8.49818181818181,
       "names": [
         "stowFast"
       ]
     },
     {
-      "position": 7.854545454545171,
+      "position": 3.9454545454548144,
       "names": [
         "superstructureMid"
       ]