mirror of
https://github.com/Team4388/2026KPopRobotHunters.git
synced 2026-06-09 08:48:05 -06:00
Intake roller model
This commit is contained in:
+156
@@ -0,0 +1,156 @@
|
||||
{
|
||||
"version": "2025.0",
|
||||
"command": {
|
||||
"type": "sequential",
|
||||
"data": {
|
||||
"commands": [
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Intake Extended"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Intake Reference"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "parallel",
|
||||
"data": {
|
||||
"commands": [
|
||||
{
|
||||
"type": "sequential",
|
||||
"data": {
|
||||
"commands": [
|
||||
{
|
||||
"type": "path",
|
||||
"data": {
|
||||
"pathName": "RightTrench-Neutral-Shoot"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "path",
|
||||
"data": {
|
||||
"pathName": "RightRamp-Shoot"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "BumpOffsetBackward"
|
||||
}
|
||||
}
|
||||
]
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "sequential",
|
||||
"data": {
|
||||
"commands": [
|
||||
{
|
||||
"type": "wait",
|
||||
"data": {
|
||||
"waitTime": 4.35
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Robot Rev Up"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "wait",
|
||||
"data": {
|
||||
"waitTime": 1.5
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "parallel",
|
||||
"data": {
|
||||
"commands": [
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Robot Shoot Driving"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Robot Shoot"
|
||||
}
|
||||
}
|
||||
]
|
||||
}
|
||||
}
|
||||
]
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "sequential",
|
||||
"data": {
|
||||
"commands": [
|
||||
{
|
||||
"type": "wait",
|
||||
"data": {
|
||||
"waitTime": 1.5
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Labubu Growl"
|
||||
}
|
||||
}
|
||||
]
|
||||
}
|
||||
}
|
||||
]
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Intake Extended"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "path",
|
||||
"data": {
|
||||
"pathName": "ShotRightR-PlayerStation"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "wait",
|
||||
"data": {
|
||||
"waitTime": 2.0
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Robot Rev Up"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "path",
|
||||
"data": {
|
||||
"pathName": "PlayerStation-Shoot"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Robot Shoot"
|
||||
}
|
||||
}
|
||||
]
|
||||
}
|
||||
},
|
||||
"resetOdom": true,
|
||||
"folder": null,
|
||||
"choreoAuto": false
|
||||
}
|
||||
-79
@@ -1,79 +0,0 @@
|
||||
{
|
||||
"version": "2025.0",
|
||||
"command": {
|
||||
"type": "sequential",
|
||||
"data": {
|
||||
"commands": [
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Intake Extended"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Intake Reference"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "path",
|
||||
"data": {
|
||||
"pathName": "RightTrench-Neutral-Trench-Shoot"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Robot Rev Up"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Robot Shoot"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Intake Extended"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "path",
|
||||
"data": {
|
||||
"pathName": "ShotRight-PlayerStation"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "wait",
|
||||
"data": {
|
||||
"waitTime": 2.0
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Robot Rev Up"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "path",
|
||||
"data": {
|
||||
"pathName": "PlayerStation-Shoot"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Robot Shoot"
|
||||
}
|
||||
}
|
||||
]
|
||||
}
|
||||
},
|
||||
"resetOdom": true,
|
||||
"folder": null,
|
||||
"choreoAuto": false
|
||||
}
|
||||
+137
@@ -0,0 +1,137 @@
|
||||
{
|
||||
"version": "2025.0",
|
||||
"command": {
|
||||
"type": "sequential",
|
||||
"data": {
|
||||
"commands": [
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Intake Extended"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Intake Reference"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "parallel",
|
||||
"data": {
|
||||
"commands": [
|
||||
{
|
||||
"type": "path",
|
||||
"data": {
|
||||
"pathName": "RightTrench-Neutral-Trench-Shoot"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "sequential",
|
||||
"data": {
|
||||
"commands": [
|
||||
{
|
||||
"type": "wait",
|
||||
"data": {
|
||||
"waitTime": 13.1
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Robot Rev Up"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "wait",
|
||||
"data": {
|
||||
"waitTime": 1.5
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "parallel",
|
||||
"data": {
|
||||
"commands": [
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Robot Shoot Driving"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Robot Shoot"
|
||||
}
|
||||
}
|
||||
]
|
||||
}
|
||||
}
|
||||
]
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "sequential",
|
||||
"data": {
|
||||
"commands": [
|
||||
{
|
||||
"type": "wait",
|
||||
"data": {
|
||||
"waitTime": 1.5
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Labubu Growl"
|
||||
}
|
||||
}
|
||||
]
|
||||
}
|
||||
}
|
||||
]
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Intake Extended"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "path",
|
||||
"data": {
|
||||
"pathName": "ShotRightT-PlayerStation"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "wait",
|
||||
"data": {
|
||||
"waitTime": 2.0
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Robot Rev Up"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "path",
|
||||
"data": {
|
||||
"pathName": "PlayerStation-Shoot"
|
||||
}
|
||||
},
|
||||
{
|
||||
"type": "named",
|
||||
"data": {
|
||||
"name": "Robot Shoot"
|
||||
}
|
||||
}
|
||||
]
|
||||
}
|
||||
},
|
||||
"resetOdom": true,
|
||||
"folder": null,
|
||||
"choreoAuto": false
|
||||
}
|
||||
@@ -115,13 +115,13 @@
|
||||
"unlimited": false
|
||||
},
|
||||
"goalEndState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": 23.07
|
||||
},
|
||||
"reversed": false,
|
||||
"folder": null,
|
||||
"idealStartingState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": -90.0
|
||||
},
|
||||
"useDefaultConstraints": true
|
||||
|
||||
@@ -46,7 +46,7 @@
|
||||
"unlimited": false
|
||||
},
|
||||
"goalEndState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": -91.24536426676825
|
||||
},
|
||||
"reversed": false,
|
||||
|
||||
@@ -135,13 +135,13 @@
|
||||
"unlimited": false
|
||||
},
|
||||
"goalEndState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": 23.069999999999993
|
||||
},
|
||||
"reversed": false,
|
||||
"folder": null,
|
||||
"idealStartingState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": 90.0
|
||||
},
|
||||
"useDefaultConstraints": true
|
||||
|
||||
@@ -46,13 +46,13 @@
|
||||
"unlimited": false
|
||||
},
|
||||
"goalEndState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": 91.245
|
||||
},
|
||||
"reversed": false,
|
||||
"folder": null,
|
||||
"idealStartingState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": 117.25532837494306
|
||||
},
|
||||
"useDefaultConstraints": true
|
||||
|
||||
@@ -58,7 +58,7 @@
|
||||
"reversed": false,
|
||||
"folder": null,
|
||||
"idealStartingState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": 113.07
|
||||
},
|
||||
"useDefaultConstraints": true
|
||||
|
||||
@@ -139,13 +139,13 @@
|
||||
"unlimited": true
|
||||
},
|
||||
"goalEndState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": 11.706999999999994
|
||||
},
|
||||
"reversed": false,
|
||||
"folder": null,
|
||||
"idealStartingState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": 0.0
|
||||
},
|
||||
"useDefaultConstraints": false
|
||||
|
||||
@@ -1,155 +0,0 @@
|
||||
{
|
||||
"version": "2025.0",
|
||||
"waypoints": [
|
||||
{
|
||||
"anchor": {
|
||||
"x": 2.61204761904762,
|
||||
"y": 1.918666666666668
|
||||
},
|
||||
"prevControl": null,
|
||||
"nextControl": {
|
||||
"x": 2.5040714285714296,
|
||||
"y": 1.4003809523809525
|
||||
},
|
||||
"isLocked": false,
|
||||
"linkedName": "end of RIght trench first swipe"
|
||||
},
|
||||
{
|
||||
"anchor": {
|
||||
"x": 3.648619047619049,
|
||||
"y": 0.6121547619047625
|
||||
},
|
||||
"prevControl": {
|
||||
"x": 3.4190610119047635,
|
||||
"y": 0.7741190476190478
|
||||
},
|
||||
"nextControl": {
|
||||
"x": 3.878177083333335,
|
||||
"y": 0.45019047619047714
|
||||
},
|
||||
"isLocked": false,
|
||||
"linkedName": null
|
||||
},
|
||||
{
|
||||
"anchor": {
|
||||
"x": 5.333047619047619,
|
||||
"y": 0.6121547619047625
|
||||
},
|
||||
"prevControl": {
|
||||
"x": 4.4368452380952395,
|
||||
"y": 0.6229523809523821
|
||||
},
|
||||
"nextControl": {
|
||||
"x": 6.519422842432679,
|
||||
"y": 0.5978610845145801
|
||||
},
|
||||
"isLocked": false,
|
||||
"linkedName": null
|
||||
},
|
||||
{
|
||||
"anchor": {
|
||||
"x": 6.391214285714287,
|
||||
"y": 3.7434642857142855
|
||||
},
|
||||
"prevControl": {
|
||||
"x": 5.376238095238096,
|
||||
"y": 2.7932738095238094
|
||||
},
|
||||
"nextControl": {
|
||||
"x": 6.987633102739957,
|
||||
"y": 4.301813816546828
|
||||
},
|
||||
"isLocked": false,
|
||||
"linkedName": null
|
||||
},
|
||||
{
|
||||
"anchor": {
|
||||
"x": 7.589750000000002,
|
||||
"y": 1.2492142857142858
|
||||
},
|
||||
"prevControl": {
|
||||
"x": 7.488215383486641,
|
||||
"y": 1.4776671728693485
|
||||
},
|
||||
"nextControl": {
|
||||
"x": 7.8057023809523844,
|
||||
"y": 0.7633214285714278
|
||||
},
|
||||
"isLocked": false,
|
||||
"linkedName": null
|
||||
},
|
||||
{
|
||||
"anchor": {
|
||||
"x": 3.648619047619049,
|
||||
"y": 0.4717857142857145
|
||||
},
|
||||
"prevControl": {
|
||||
"x": 4.501280949513,
|
||||
"y": 0.5293980049542248
|
||||
},
|
||||
"nextControl": {
|
||||
"x": 2.8495952380952403,
|
||||
"y": 0.41779761904761914
|
||||
},
|
||||
"isLocked": false,
|
||||
"linkedName": null
|
||||
},
|
||||
{
|
||||
"anchor": {
|
||||
"x": 1.7374404761904771,
|
||||
"y": 0.9792738095238098
|
||||
},
|
||||
"prevControl": {
|
||||
"x": 2.4068928571428576,
|
||||
"y": 1.3032023809523823
|
||||
},
|
||||
"nextControl": null,
|
||||
"isLocked": false,
|
||||
"linkedName": null
|
||||
}
|
||||
],
|
||||
"rotationTargets": [
|
||||
{
|
||||
"waypointRelativePos": 0.5,
|
||||
"rotationDegrees": 0.0
|
||||
},
|
||||
{
|
||||
"waypointRelativePos": 0.7377593360995809,
|
||||
"rotationDegrees": -1.8097734110142742
|
||||
},
|
||||
{
|
||||
"waypointRelativePos": 1.8273858921161648,
|
||||
"rotationDegrees": 0.0
|
||||
},
|
||||
{
|
||||
"waypointRelativePos": 2.364315352697095,
|
||||
"rotationDegrees": 87.9267492938311
|
||||
},
|
||||
{
|
||||
"waypointRelativePos": 3.5701244813277846,
|
||||
"rotationDegrees": -59.49633403888164
|
||||
}
|
||||
],
|
||||
"constraintZones": [],
|
||||
"pointTowardsZones": [],
|
||||
"eventMarkers": [],
|
||||
"globalConstraints": {
|
||||
"maxVelocity": 3.0,
|
||||
"maxAcceleration": 3.0,
|
||||
"maxAngularVelocity": 600.0,
|
||||
"maxAngularAcceleration": 750.0,
|
||||
"nominalVoltage": 10.0,
|
||||
"unlimited": false
|
||||
},
|
||||
"goalEndState": {
|
||||
"velocity": 0,
|
||||
"rotation": -132.7688253919687
|
||||
},
|
||||
"reversed": false,
|
||||
"folder": null,
|
||||
"idealStartingState": {
|
||||
"velocity": 0,
|
||||
"rotation": -133.33166255170664
|
||||
},
|
||||
"useDefaultConstraints": true
|
||||
}
|
||||
@@ -62,7 +62,7 @@
|
||||
"unlimited": false
|
||||
},
|
||||
"goalEndState": {
|
||||
"velocity": 0,
|
||||
"velocity": 0.0,
|
||||
"rotation": -142.9
|
||||
},
|
||||
"reversed": false,
|
||||
|
||||
@@ -115,13 +115,13 @@
|
||||
"unlimited": false
|
||||
},
|
||||
"goalEndState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": -23.069999999999993
|
||||
},
|
||||
"reversed": false,
|
||||
"folder": null,
|
||||
"idealStartingState": {
|
||||
"velocity": 0.3,
|
||||
"velocity": 0.0,
|
||||
"rotation": 88.32335186314447
|
||||
},
|
||||
"useDefaultConstraints": true
|
||||
|
||||
@@ -46,7 +46,7 @@
|
||||
"unlimited": false
|
||||
},
|
||||
"goalEndState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": 91.245
|
||||
},
|
||||
"reversed": false,
|
||||
|
||||
@@ -129,13 +129,13 @@
|
||||
"unlimited": false
|
||||
},
|
||||
"goalEndState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": -23.069999999999993
|
||||
},
|
||||
"reversed": false,
|
||||
"folder": null,
|
||||
"idealStartingState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": -90.0
|
||||
},
|
||||
"useDefaultConstraints": true
|
||||
|
||||
@@ -46,13 +46,13 @@
|
||||
"unlimited": false
|
||||
},
|
||||
"goalEndState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": -91.245
|
||||
},
|
||||
"reversed": false,
|
||||
"folder": null,
|
||||
"idealStartingState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": -108.98741511036879
|
||||
},
|
||||
"useDefaultConstraints": true
|
||||
|
||||
@@ -44,11 +44,11 @@
|
||||
],
|
||||
"eventMarkers": [],
|
||||
"globalConstraints": {
|
||||
"maxVelocity": 3.0,
|
||||
"maxAcceleration": 3.0,
|
||||
"maxAngularVelocity": 600.0,
|
||||
"maxAngularAcceleration": 750.0,
|
||||
"nominalVoltage": 10.0,
|
||||
"maxVelocity": 1.0,
|
||||
"maxAcceleration": 1.0,
|
||||
"maxAngularVelocity": 0.1,
|
||||
"maxAngularAcceleration": 0.1,
|
||||
"nominalVoltage": 6.0,
|
||||
"unlimited": false
|
||||
},
|
||||
"goalEndState": {
|
||||
@@ -58,8 +58,8 @@
|
||||
"reversed": false,
|
||||
"folder": null,
|
||||
"idealStartingState": {
|
||||
"velocity": 3.0,
|
||||
"rotation": -113.07
|
||||
"velocity": 0.0,
|
||||
"rotation": -23.07
|
||||
},
|
||||
"useDefaultConstraints": true
|
||||
"useDefaultConstraints": false
|
||||
}
|
||||
@@ -102,7 +102,7 @@
|
||||
"rotationDegrees": 0.0
|
||||
},
|
||||
{
|
||||
"waypointRelativePos": 3.9339019189765208,
|
||||
"waypointRelativePos": 3.991228070175485,
|
||||
"rotationDegrees": 0.0
|
||||
}
|
||||
],
|
||||
@@ -110,7 +110,7 @@
|
||||
"pointTowardsZones": [],
|
||||
"eventMarkers": [],
|
||||
"globalConstraints": {
|
||||
"maxVelocity": 3.5,
|
||||
"maxVelocity": 4.0,
|
||||
"maxAcceleration": 3.0,
|
||||
"maxAngularVelocity": 600.0,
|
||||
"maxAngularAcceleration": 750.0,
|
||||
|
||||
@@ -68,8 +68,8 @@
|
||||
"y": 2.512
|
||||
},
|
||||
"prevControl": {
|
||||
"x": 3.841498071206661,
|
||||
"y": 2.6514755211571583
|
||||
"x": 3.7815128205128214,
|
||||
"y": 2.5582179487179486
|
||||
},
|
||||
"nextControl": null,
|
||||
"isLocked": false,
|
||||
@@ -95,19 +95,6 @@
|
||||
"nominalVoltage": 10.0,
|
||||
"unlimited": false
|
||||
}
|
||||
},
|
||||
{
|
||||
"name": "Constraints Zone",
|
||||
"minWaypointRelativePos": 1.771871539313429,
|
||||
"maxWaypointRelativePos": 2.542635658914713,
|
||||
"constraints": {
|
||||
"maxVelocity": 1.0,
|
||||
"maxAcceleration": 3.0,
|
||||
"maxAngularVelocity": 600.0,
|
||||
"maxAngularAcceleration": 750.0,
|
||||
"nominalVoltage": 6.0,
|
||||
"unlimited": false
|
||||
}
|
||||
}
|
||||
],
|
||||
"pointTowardsZones": [
|
||||
@@ -152,13 +139,13 @@
|
||||
"unlimited": true
|
||||
},
|
||||
"goalEndState": {
|
||||
"velocity": 3.0,
|
||||
"velocity": 0.0,
|
||||
"rotation": -23.07
|
||||
},
|
||||
"reversed": false,
|
||||
"folder": null,
|
||||
"idealStartingState": {
|
||||
"velocity": 0.3,
|
||||
"velocity": 0.0,
|
||||
"rotation": 0.0
|
||||
},
|
||||
"useDefaultConstraints": false
|
||||
|
||||
@@ -64,16 +64,16 @@
|
||||
},
|
||||
{
|
||||
"anchor": {
|
||||
"x": 3.3990740740740737,
|
||||
"y": 0.7403418803418822
|
||||
"x": 3.711743589743591,
|
||||
"y": 0.6046794871794885
|
||||
},
|
||||
"prevControl": {
|
||||
"x": 3.7877883597883595,
|
||||
"y": 0.6506385836385846
|
||||
"x": 3.9948825305696225,
|
||||
"y": 0.5642310670614844
|
||||
},
|
||||
"nextControl": {
|
||||
"x": 2.947066329127951,
|
||||
"y": 0.8446513599448344
|
||||
"x": 3.3861538461538476,
|
||||
"y": 0.6511923076923085
|
||||
},
|
||||
"isLocked": false,
|
||||
"linkedName": null
|
||||
@@ -84,12 +84,12 @@
|
||||
"y": 1.302
|
||||
},
|
||||
"prevControl": {
|
||||
"x": 2.7301802034615954,
|
||||
"y": 1.1693945129031929
|
||||
"x": 3.3396410256410265,
|
||||
"y": 1.1395769230769235
|
||||
},
|
||||
"nextControl": null,
|
||||
"isLocked": false,
|
||||
"linkedName": "end of RightTrench-Neutral-Trench-Shoot"
|
||||
"linkedName": "END-RightTrnech-Neutral-Trench-Shoot"
|
||||
}
|
||||
],
|
||||
"rotationTargets": [],
|
||||
@@ -99,7 +99,7 @@
|
||||
"minWaypointRelativePos": 0,
|
||||
"maxWaypointRelativePos": 5.0,
|
||||
"constraints": {
|
||||
"maxVelocity": 1.5,
|
||||
"maxVelocity": 1.0,
|
||||
"maxAcceleration": 3.0,
|
||||
"maxAngularVelocity": 600.0,
|
||||
"maxAngularAcceleration": 750.0,
|
||||
@@ -121,22 +121,22 @@
|
||||
},
|
||||
{
|
||||
"fieldPosition": {
|
||||
"x": 180.0,
|
||||
"x": 0.0,
|
||||
"y": 0.6
|
||||
},
|
||||
"rotationOffset": 0.0,
|
||||
"minWaypointRelativePos": 0.15384615384614939,
|
||||
"rotationOffset": 180.0,
|
||||
"minWaypointRelativePos": 0.0,
|
||||
"maxWaypointRelativePos": 0.6910299003322272,
|
||||
"name": "Point Towards Zone"
|
||||
},
|
||||
{
|
||||
"fieldPosition": {
|
||||
"x": 180.0,
|
||||
"x": 0.0,
|
||||
"y": 0.7
|
||||
},
|
||||
"rotationOffset": 180.0,
|
||||
"minWaypointRelativePos": 2.952853598014871,
|
||||
"maxWaypointRelativePos": 4.105334233625949,
|
||||
"minWaypointRelativePos": 2.5913621262458837,
|
||||
"maxWaypointRelativePos": 4.28,
|
||||
"name": "Point Towards Zone"
|
||||
},
|
||||
{
|
||||
@@ -145,7 +145,7 @@
|
||||
"y": 4.021
|
||||
},
|
||||
"rotationOffset": 180.0,
|
||||
"minWaypointRelativePos": 4.280891289669132,
|
||||
"minWaypointRelativePos": 4.529346622369888,
|
||||
"maxWaypointRelativePos": 5.0,
|
||||
"name": "Point Towards Zone"
|
||||
}
|
||||
@@ -157,16 +157,16 @@
|
||||
"maxAngularVelocity": 600.0,
|
||||
"maxAngularAcceleration": 750.0,
|
||||
"nominalVoltage": 12.0,
|
||||
"unlimited": false
|
||||
"unlimited": true
|
||||
},
|
||||
"goalEndState": {
|
||||
"velocity": 0.0,
|
||||
"rotation": -136.00851404351897
|
||||
"rotation": -130.0
|
||||
},
|
||||
"reversed": false,
|
||||
"folder": null,
|
||||
"idealStartingState": {
|
||||
"velocity": 0.6,
|
||||
"velocity": 0.0,
|
||||
"rotation": 0.0
|
||||
},
|
||||
"useDefaultConstraints": false
|
||||
|
||||
@@ -0,0 +1,95 @@
|
||||
{
|
||||
"version": "2025.0",
|
||||
"waypoints": [
|
||||
{
|
||||
"anchor": {
|
||||
"x": 3.398,
|
||||
"y": 2.512
|
||||
},
|
||||
"prevControl": null,
|
||||
"nextControl": {
|
||||
"x": 3.2508028935074877,
|
||||
"y": 2.309928201274319
|
||||
},
|
||||
"isLocked": false,
|
||||
"linkedName": null
|
||||
},
|
||||
{
|
||||
"anchor": {
|
||||
"x": 1.5754761904761914,
|
||||
"y": 1.0
|
||||
},
|
||||
"prevControl": {
|
||||
"x": 2.2272563574654534,
|
||||
"y": 0.9727386663284083
|
||||
},
|
||||
"nextControl": {
|
||||
"x": 0.9236960234869294,
|
||||
"y": 1.0272613336715914
|
||||
},
|
||||
"isLocked": false,
|
||||
"linkedName": null
|
||||
},
|
||||
{
|
||||
"anchor": {
|
||||
"x": 0.325,
|
||||
"y": 0.95
|
||||
},
|
||||
"prevControl": {
|
||||
"x": 0.5747421350529089,
|
||||
"y": 0.9386480847776856
|
||||
},
|
||||
"nextControl": null,
|
||||
"isLocked": false,
|
||||
"linkedName": null
|
||||
}
|
||||
],
|
||||
"rotationTargets": [],
|
||||
"constraintZones": [
|
||||
{
|
||||
"name": "Constraints Zone",
|
||||
"minWaypointRelativePos": 0,
|
||||
"maxWaypointRelativePos": 2.0,
|
||||
"constraints": {
|
||||
"maxVelocity": 1.0,
|
||||
"maxAcceleration": 3.0,
|
||||
"maxAngularVelocity": 600.0,
|
||||
"maxAngularAcceleration": 750.0,
|
||||
"nominalVoltage": 10.0,
|
||||
"unlimited": false
|
||||
}
|
||||
}
|
||||
],
|
||||
"pointTowardsZones": [
|
||||
{
|
||||
"fieldPosition": {
|
||||
"x": 0.0,
|
||||
"y": 0.7
|
||||
},
|
||||
"rotationOffset": 180.0,
|
||||
"minWaypointRelativePos": 0.6,
|
||||
"maxWaypointRelativePos": 1.0956834532374118,
|
||||
"name": "Point Towards Zone"
|
||||
}
|
||||
],
|
||||
"eventMarkers": [],
|
||||
"globalConstraints": {
|
||||
"maxVelocity": 3.0,
|
||||
"maxAcceleration": 3.0,
|
||||
"maxAngularVelocity": 600.0,
|
||||
"maxAngularAcceleration": 750.0,
|
||||
"nominalVoltage": 10.0,
|
||||
"unlimited": false
|
||||
},
|
||||
"goalEndState": {
|
||||
"velocity": 0,
|
||||
"rotation": -95.0
|
||||
},
|
||||
"reversed": false,
|
||||
"folder": null,
|
||||
"idealStartingState": {
|
||||
"velocity": 0,
|
||||
"rotation": -106.71386741074436
|
||||
},
|
||||
"useDefaultConstraints": true
|
||||
}
|
||||
+37
-10
@@ -8,11 +8,27 @@
|
||||
},
|
||||
"prevControl": null,
|
||||
"nextControl": {
|
||||
"x": 1.7698333333333336,
|
||||
"y": 1.1628333333333343
|
||||
"x": 2.29707212427672,
|
||||
"y": 1.0999282012743195
|
||||
},
|
||||
"isLocked": false,
|
||||
"linkedName": "end of RightTrench-Neutral-Trench-Shoot"
|
||||
"linkedName": "END-RightTrnech-Neutral-Trench-Shoot"
|
||||
},
|
||||
{
|
||||
"anchor": {
|
||||
"x": 1.5754761904761914,
|
||||
"y": 1.0
|
||||
},
|
||||
"prevControl": {
|
||||
"x": 2.2272563574654534,
|
||||
"y": 0.9727386663284083
|
||||
},
|
||||
"nextControl": {
|
||||
"x": 0.9236960234869294,
|
||||
"y": 1.0272613336715914
|
||||
},
|
||||
"isLocked": false,
|
||||
"linkedName": null
|
||||
},
|
||||
{
|
||||
"anchor": {
|
||||
@@ -25,7 +41,7 @@
|
||||
},
|
||||
"nextControl": null,
|
||||
"isLocked": false,
|
||||
"linkedName": null
|
||||
"linkedName": "Playerstation"
|
||||
}
|
||||
],
|
||||
"rotationTargets": [],
|
||||
@@ -33,9 +49,9 @@
|
||||
{
|
||||
"name": "Constraints Zone",
|
||||
"minWaypointRelativePos": 0,
|
||||
"maxWaypointRelativePos": 1.0,
|
||||
"maxWaypointRelativePos": 2.0,
|
||||
"constraints": {
|
||||
"maxVelocity": 1.5,
|
||||
"maxVelocity": 1.0,
|
||||
"maxAcceleration": 3.0,
|
||||
"maxAngularVelocity": 600.0,
|
||||
"maxAngularAcceleration": 750.0,
|
||||
@@ -44,7 +60,18 @@
|
||||
}
|
||||
}
|
||||
],
|
||||
"pointTowardsZones": [],
|
||||
"pointTowardsZones": [
|
||||
{
|
||||
"fieldPosition": {
|
||||
"x": 0.0,
|
||||
"y": 0.7
|
||||
},
|
||||
"rotationOffset": 180.0,
|
||||
"minWaypointRelativePos": 0.6,
|
||||
"maxWaypointRelativePos": 1.0956834532374118,
|
||||
"name": "Point Towards Zone"
|
||||
}
|
||||
],
|
||||
"eventMarkers": [],
|
||||
"globalConstraints": {
|
||||
"maxVelocity": 3.0,
|
||||
@@ -56,13 +83,13 @@
|
||||
},
|
||||
"goalEndState": {
|
||||
"velocity": 0,
|
||||
"rotation": -90.16147282505071
|
||||
"rotation": -95.0
|
||||
},
|
||||
"reversed": false,
|
||||
"folder": null,
|
||||
"idealStartingState": {
|
||||
"velocity": 0.0,
|
||||
"rotation": -136.00851404351897
|
||||
"velocity": 0,
|
||||
"rotation": -130.0
|
||||
},
|
||||
"useDefaultConstraints": true
|
||||
}
|
||||
@@ -112,6 +112,10 @@ public class RobotContainer {
|
||||
private Command IntakeExtended = new SequentialCommandGroup(
|
||||
new InstantCommand(() -> m_robotIntake.setMode(IntakeMode.ExtendingRolling), m_robotIntake)
|
||||
);
|
||||
|
||||
private Command LabubuGrowl = new SequentialCommandGroup(
|
||||
new InstantCommand(() -> m_robotIntake.setMode(IntakeMode.LabubuGrowl), m_robotIntake)
|
||||
);
|
||||
|
||||
// private Command LidarIntake = new SequentialCommandGroup(
|
||||
// // Right now this will just go to the closest ball constantly updating - need to make it so it locks on one ball
|
||||
@@ -189,6 +193,7 @@ public class RobotContainer {
|
||||
NamedCommands.registerCommand("Robot Shoot", RobotShoot);
|
||||
// NamedCommands.registerCommand("Lidar Intake", LidarIntake);
|
||||
NamedCommands.registerCommand("Intake Extended", IntakeExtended);
|
||||
NamedCommands.registerCommand("Labubu Growl", LabubuGrowl);
|
||||
NamedCommands.registerCommand("Robot Shoot Driving", RobotShootDriving);
|
||||
NamedCommands.registerCommand("Intake Reference", WaitIntakeReference);
|
||||
NamedCommands.registerCommand("WaitShooter", new WaitUntilCommand(m_robotShooter::isShooterUpToSpeed));
|
||||
@@ -615,7 +620,7 @@ public class RobotContainer {
|
||||
|
||||
for (String auto : autos) {
|
||||
if (auto.endsWith(".auto"))
|
||||
if (auto.startsWith("X. "))
|
||||
if (auto.startsWith("X. ")) // Mira!
|
||||
autoChooser.addOption(auto.replaceAll(".auto", ""), auto.replaceAll(".auto", ""));
|
||||
// System.out.println(auto);
|
||||
}
|
||||
|
||||
@@ -7,12 +7,12 @@ public final class BuildConstants {
|
||||
public static final String MAVEN_GROUP = "";
|
||||
public static final String MAVEN_NAME = "2026KPopRobotHunters";
|
||||
public static final String VERSION = "unspecified";
|
||||
public static final int GIT_REVISION = 218;
|
||||
public static final String GIT_SHA = "74009b86bbde67d814d16020ce4cec00b8267411";
|
||||
public static final String GIT_DATE = "2026-04-04 16:17:27 MDT";
|
||||
public static final int GIT_REVISION = 219;
|
||||
public static final String GIT_SHA = "f9b9a7dd30b53213e360f67c5b7bcd4567fa30f3";
|
||||
public static final String GIT_DATE = "2026-04-04 20:41:00 MDT";
|
||||
public static final String GIT_BRANCH = "New-Intake";
|
||||
public static final String BUILD_DATE = "2026-04-04 19:50:19 MDT";
|
||||
public static final long BUILD_UNIX_TIME = 1775353819651L;
|
||||
public static final String BUILD_DATE = "2026-04-06 19:43:24 MDT";
|
||||
public static final long BUILD_UNIX_TIME = 1775526204113L;
|
||||
public static final int DIRTY = 1;
|
||||
|
||||
private BuildConstants(){}
|
||||
|
||||
@@ -31,9 +31,6 @@ public class Intake extends SubsystemBase {
|
||||
}
|
||||
|
||||
public enum IntakeMode {
|
||||
ExtendedREMOVEME,
|
||||
RetractedREMOVEME,
|
||||
|
||||
ExtendingIdle,
|
||||
ExtendingRolling,
|
||||
|
||||
@@ -120,15 +117,6 @@ public class Intake extends SubsystemBase {
|
||||
// getCurrentTime
|
||||
|
||||
switch (mode) {
|
||||
case ExtendedREMOVEME:
|
||||
// io.setArmAngle(state, Rotations.of(IntakeConstants.ARM_LIMIT_EXTENDED.get()));
|
||||
// io.setRollerOutput(state, IntakeConstants.ROLLER_PERCENT_OUTPUT.get());
|
||||
break;
|
||||
case RetractedREMOVEME:
|
||||
// io.setArmAngle(state, Rotations.of(IntakeConstants.ARM_LIMIT_RETRACTED.get()));
|
||||
// io.setRollerOutput(state, 0);
|
||||
break;
|
||||
|
||||
case ExtendingIdle:
|
||||
io.armOutput(IntakeConstants.ARM_EXTEND_PERCENT_OUTPUT.get());
|
||||
io.setRollerOutput(state, 0);
|
||||
@@ -198,7 +186,7 @@ public class Intake extends SubsystemBase {
|
||||
io.setRollerOutput(state, IntakeConstants.ROLLER_EJECT_PERCENT_OUTPUT.get());
|
||||
break;
|
||||
case LabubuGrowl:
|
||||
io.armOutput(0);
|
||||
io.armOutput(IntakeConstants.ARM_EXTEND_PERCENT_OUTPUT.get());
|
||||
io.setRollerOutput(state, IntakeConstants.ROLLER_LABUBU_GROWL_PERCENT_OUTPUT.get());
|
||||
break;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user