Skip to content

Commit

Permalink
Recreate autonomous, add basic vision locking
Browse files Browse the repository at this point in the history
Recreated some of the autonomous paths for better management and implementing full auto routines compared to just paths.

Added vision mapping for AprilTags. AprilTags and notes can now lock rotation while still in holonomic mode.
  • Loading branch information
garrettsummerfi3ld committed Mar 13, 2024
1 parent db386c2 commit 7e635d7
Show file tree
Hide file tree
Showing 16 changed files with 692 additions and 15 deletions.
6 changes: 1 addition & 5 deletions .pathplanner/settings.json
Original file line number Diff line number Diff line change
Expand Up @@ -2,11 +2,7 @@
"robotWidth": 0.69,
"robotLength": 0.68,
"holonomicMode": true,
"pathFolders": [
"Blue Station 1",
"Blue Station 2",
"Blue Station 3"
],
"pathFolders": [],
"autoFolders": [],
"defaultMaxVel": 3.0,
"defaultMaxAccel": 3.0,
Expand Down
67 changes: 67 additions & 0 deletions src/main/deploy/pathplanner/autos/Station 1 Full AMP.auto
Original file line number Diff line number Diff line change
@@ -0,0 +1,67 @@
{
"version": 1.0,
"startingPose": {
"position": {
"x": 1.5119055354389788,
"y": 2.558245860677768
},
"rotation": 0
},
"command": {
"type": "sequential",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "Station 1 Go to AMP"
}
},
{
"type": "named",
"data": {
"name": null
}
},
{
"type": "path",
"data": {
"pathName": "Pickup close Note"
}
},
{
"type": "named",
"data": {
"name": null
}
},
{
"type": "path",
"data": {
"pathName": "Close note to AMP"
}
},
{
"type": "named",
"data": {
"name": null
}
},
{
"type": "path",
"data": {
"pathName": "AMP to middle field"
}
},
{
"type": "named",
"data": {
"name": null
}
}
]
}
},
"folder": null,
"choreoAuto": false
}
43 changes: 43 additions & 0 deletions src/main/deploy/pathplanner/autos/Station 1 Leave.auto
Original file line number Diff line number Diff line change
@@ -0,0 +1,43 @@
{
"version": 1.0,
"startingPose": {
"position": {
"x": 1.5119055354389788,
"y": 2.558245860677768
},
"rotation": 0
},
"command": {
"type": "sequential",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "Leave Station 1"
}
},
{
"type": "named",
"data": {
"name": null
}
},
{
"type": "path",
"data": {
"pathName": "AMP to middle field"
}
},
{
"type": "named",
"data": {
"name": null
}
}
]
}
},
"folder": null,
"choreoAuto": false
}
49 changes: 49 additions & 0 deletions src/main/deploy/pathplanner/autos/Station 1 Not Full AMP.auto
Original file line number Diff line number Diff line change
@@ -0,0 +1,49 @@
{
"version": 1.0,
"startingPose": {
"position": {
"x": 1.5119055354389788,
"y": 2.558245860677768
},
"rotation": 0
},
"command": {
"type": "sequential",
"data": {
"commands": [
{
"type": "path",
"data": {
"pathName": "Station 1 Go to AMP"
}
},
{
"type": "named",
"data": {
"name": null
}
},
{
"type": "path",
"data": {
"pathName": "Pickup close Note"
}
},
{
"type": "named",
"data": {
"name": null
}
},
{
"type": "path",
"data": {
"pathName": "Leave Station 3"
}
}
]
}
},
"folder": null,
"choreoAuto": false
}
2 changes: 1 addition & 1 deletion src/main/deploy/pathplanner/navgrid.json

Large diffs are not rendered by default.

52 changes: 52 additions & 0 deletions src/main/deploy/pathplanner/paths/AMP to middle field.path
Original file line number Diff line number Diff line change
@@ -0,0 +1,52 @@
{
"version": 1.0,
"waypoints": [
{
"anchor": {
"x": 1.86729904765713,
"y": 7.768725948900914
},
"prevControl": null,
"nextControl": {
"x": 3.174654748090113,
"y": 7.768725948900914
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 7.770943341528902,
"y": 7.4309552554704394
},
"prevControl": {
"x": 6.742840686534915,
"y": 7.4309552554704394
},
"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": {
"rotation": -90.0,
"velocity": 0
},
"useDefaultConstraints": true
}
52 changes: 52 additions & 0 deletions src/main/deploy/pathplanner/paths/Close note to AMP.path
Original file line number Diff line number Diff line change
@@ -0,0 +1,52 @@
{
"version": 1.0,
"waypoints": [
{
"anchor": {
"x": 2.44,
"y": 6.99
},
"prevControl": null,
"nextControl": {
"x": 1.8496449190337936,
"y": 6.99
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 1.8411258946523206,
"y": 7.762851675974441
},
"prevControl": {
"x": 1.8411258946523206,
"y": 7.316406933353292
},
"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": -89.18154453831147,
"rotateFast": false
},
"reversed": false,
"folder": null,
"previewStartingState": {
"rotation": 0.8053549110409497,
"velocity": 0
},
"useDefaultConstraints": true
}
52 changes: 52 additions & 0 deletions src/main/deploy/pathplanner/paths/Leave Station 1.path
Original file line number Diff line number Diff line change
@@ -0,0 +1,52 @@
{
"version": 1.0,
"waypoints": [
{
"anchor": {
"x": 1.5119055354389788,
"y": 2.558245860677768
},
"prevControl": null,
"nextControl": {
"x": 2.3769408427322216,
"y": 2.558245860677768
},
"isLocked": false,
"linkedName": null
},
{
"anchor": {
"x": 6.2730037445763625,
"y": 1.5713680085678599
},
"prevControl": {
"x": 4.848492559239144,
"y": 1.7035391494754373
},
"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.0,
"rotateFast": false
},
"reversed": false,
"folder": null,
"previewStartingState": {
"rotation": 0,
"velocity": 0
},
"useDefaultConstraints": true
}
Loading

0 comments on commit 7e635d7

Please sign in to comment.