Skip to content
Open
Show file tree
Hide file tree
Changes from all commits
Commits
Show all changes
27 commits
Select commit Hold shift + click to select a range
03c35b2
created choreolib and autofactory implementation into auto builder
michaelwillson415 Feb 14, 2026
ede10a7
fixed bugs
michaelwillson415 Feb 14, 2026
dcc32aa
Merge pull request #50 from Team5924/path-planner-to-choreo
michaelwillson415 Feb 14, 2026
395137a
created the two basic autos with autoFactory
michaelwillson415 Feb 14, 2026
db2addc
new auto routines using autoFactory in autoBuilder
michaelwillson415 Feb 14, 2026
4d42785
fixed command bugs
michaelwillson415 Feb 14, 2026
2bcfa1d
removed autoclimb/score command files
michaelwillson415 Feb 14, 2026
1c3bbc1
made choreo paths and implemented starting position choice
michaelwillson415 Feb 14, 2026
2bfd75a
updated mass and inertia, allow loggedtunablenumbers to update in dri…
michaelwillson415 Feb 14, 2026
b729a36
Merge branch 'main' of https://github.com/Team5924/GoldenGateRobotics…
michaelwillson415 Feb 14, 2026
26fc7fa
merge conflicts
michaelwillson415 Feb 15, 2026
d3621b4
fix merge conflicts
michaelwillson415 Feb 15, 2026
afc92aa
more merge conflicts
michaelwillson415 Feb 15, 2026
c7ca810
removed autocommands and implemented commands directly into autoBuild…
michaelwillson415 Feb 15, 2026
6ba2510
merge conflict
michaelwillson415 Feb 15, 2026
a96e31f
fixed bugs
michaelwillson415 Feb 18, 2026
c2ca690
fixed MORE auobuilder bugs
michaelwillson415 Feb 18, 2026
937d09d
nitpick autobuilder fixes
michaelwillson415 Feb 18, 2026
398fe28
added NPE to startingPositionSupplier
michaelwillson415 Feb 18, 2026
ce3e8e5
Merge branch 'main' of https://github.com/Team5924/GoldenGateRobotics…
michaelwillson415 Feb 21, 2026
47fb15f
merge conflicts
michaelwillson415 Feb 21, 2026
c1efd0f
Merge branch 'main' of https://github.com/Team5924/GoldenGateRobotics…
michaelwillson415 Feb 28, 2026
533518d
changed autos to have two shooters
michaelwillson415 Feb 28, 2026
9315785
added command abstarction for shooting and intaking, added defer to a…
michaelwillson415 Mar 1, 2026
69a9af3
moved autofactory to robot container and removed drive from constructer
michaelwillson415 Mar 1, 2026
677654a
commented out outdated commands
michaelwillson415 Mar 1, 2026
ede469e
added drive back into autobuilder, added ability to change timeout
michaelwillson415 Mar 1, 2026
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
84 changes: 84 additions & 0 deletions src/main/deploy/choreo/AlphaAutos.chor
Original file line number Diff line number Diff line change
@@ -0,0 +1,84 @@
{
"name":"AlphaAutos",
"version":2,
"type":"Swerve",
"variables":{
"expressions":{},
"poses":{}
},
"config":{
"frontLeft":{
"x":{
"exp":"11 in",
"val":0.2794
},
"y":{
"exp":"11 in",
"val":0.2794
}
},
"backLeft":{
"x":{
"exp":"-11 in",
"val":-0.2794
},
"y":{
"exp":"11 in",
"val":0.2794
}
},
"mass":{
"exp":"52.16 kg",
"val":52.16
},
"inertia":{
"exp":"4.39 kg m ^ 2",
"val":4.39
},
"gearing":{
"exp":"6.5",
"val":6.5
},
"radius":{
"exp":"2 in",
"val":0.0508
},
"vmax":{
"exp":"6000 RPM",
"val":628.3185307179587
},
"tmax":{
"exp":"1.2 N * m",
"val":1.2
},
"cof":{
"exp":"1.5",
"val":1.5
},
"bumper":{
"front":{
"exp":"16 in",
"val":0.4064
},
"side":{
"exp":"16 in",
"val":0.4064
},
"back":{
"exp":"16 in",
"val":0.4064
}
},
"differentialTrackWidth":{
"exp":"22 in",
"val":0.5588
}
},
"generationFeatures":[],
"codegen":{
"root":null,
"genVars":true,
"genTrajData":true,
"useChoreoLib":true
}
Comment thread
michaelwillson415 marked this conversation as resolved.
}
68 changes: 68 additions & 0 deletions src/main/deploy/choreo/ClimbToHub.traj
Original file line number Diff line number Diff line change
@@ -0,0 +1,68 @@
{
"name":"ClimbToHub",
"version":3,
"snapshot":{
"waypoints":[
{"x":1.6633899211883545, "y":3.7032699584960938, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false},
{"x":3.456470012664795, "y":3.995620012283325, "heading":0.0, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}],
"constraints":[],
"targetDt":0.05
},
"params":{
"waypoints":[
{"x":{"exp":"1.6633899211883545 m", "val":1.6633899211883545}, "y":{"exp":"3.7032699584960938 m", "val":3.7032699584960938}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false},
{"x":{"exp":"3.456470012664795 m", "val":3.456470012664795}, "y":{"exp":"3.995620012283325 m", "val":3.995620012283325}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}],
"constraints":[],
"targetDt":{
"exp":"0.05 s",
"val":0.05
}
},
"trajectory":{
"config":{
"frontLeft":{
"x":0.2794,
"y":0.2794
},
"backLeft":{
"x":-0.2794,
"y":0.2794
},
"mass":52.16,
"inertia":4.39,
"gearing":6.5,
"radius":0.0508,
"vmax":628.3185307179587,
"tmax":1.2,
"cof":1.5,
"bumper":{
"front":0.4064,
"side":0.4064,
"back":0.4064
},
"differentialTrackWidth":0.5588
},
"sampleType":"Swerve",
"waypoints":[0.0,0.37065],
"samples":[
{"t":0.0, "x":1.66339, "y":3.70327, "heading":0.0, "vx":4.82993, "vy":0.78749, "omega":0.0, "ax":0.3564, "ay":0.05811, "alpha":0.0, "fx":[4.6474,4.6474,4.6474,4.6474], "fy":[0.75773,0.75773,0.75773,0.75773]},
{"t":0.02317, "x":1.77537, "y":3.72153, "heading":0.0, "vx":4.83819, "vy":0.78884, "omega":0.0, "ax":0.00068, "ay":0.00011, "alpha":0.0, "fx":[0.00893,0.00893,0.00893,0.00893], "fy":[0.00146,0.00146,0.00146,0.00146]},
{"t":0.04633, "x":1.88745, "y":3.7398, "heading":0.0, "vx":4.83821, "vy":0.78884, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00002,0.00002,0.00002,0.00002], "fy":[0.0,0.0,0.0,0.0]},
{"t":0.0695, "x":1.99953, "y":3.75808, "heading":0.0, "vx":4.83821, "vy":0.78884, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]},
{"t":0.09266, "x":2.11161, "y":3.77635, "heading":0.0, "vx":4.83821, "vy":0.78884, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]},
{"t":0.11583, "x":2.22369, "y":3.79462, "heading":0.0, "vx":4.83821, "vy":0.78884, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]},
{"t":0.13899, "x":2.33577, "y":3.8129, "heading":0.0, "vx":4.83821, "vy":0.78884, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]},
{"t":0.16216, "x":2.44785, "y":3.83117, "heading":0.0, "vx":4.83821, "vy":0.78884, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]},
{"t":0.18532, "x":2.55993, "y":3.84944, "heading":0.0, "vx":4.83821, "vy":0.78884, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]},
{"t":0.20849, "x":2.67201, "y":3.86772, "heading":0.0, "vx":4.83821, "vy":0.78884, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]},
{"t":0.23166, "x":2.78409, "y":3.88599, "heading":0.0, "vx":4.83821, "vy":0.78884, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]},
{"t":0.25482, "x":2.89617, "y":3.90427, "heading":0.0, "vx":4.83821, "vy":0.78884, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]},
{"t":0.27799, "x":3.00825, "y":3.92254, "heading":0.0, "vx":4.83821, "vy":0.78884, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]},
{"t":0.30115, "x":3.12033, "y":3.94081, "heading":0.0, "vx":4.83821, "vy":0.78884, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00002,-0.00002,-0.00002,-0.00002], "fy":[0.0,0.0,0.0,0.0]},
{"t":0.32432, "x":3.23241, "y":3.95909, "heading":0.0, "vx":4.83821, "vy":0.78884, "omega":0.0, "ax":-0.00068, "ay":-0.00011, "alpha":0.0, "fx":[-0.00893,-0.00893,-0.00893,-0.00893], "fy":[-0.00146,-0.00146,-0.00146,-0.00146]},
{"t":0.34748, "x":3.34449, "y":3.97736, "heading":0.0, "vx":4.83819, "vy":0.78884, "omega":0.0, "ax":-0.3564, "ay":-0.05811, "alpha":0.0, "fx":[-4.6474,-4.6474,-4.6474,-4.6474], "fy":[-0.75773,-0.75773,-0.75773,-0.75773]},
{"t":0.37065, "x":3.45647, "y":3.99562, "heading":0.0, "vx":4.82993, "vy":0.78749, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}],
"splits":[0]
},
"events":[]
}
82 changes: 82 additions & 0 deletions src/main/deploy/choreo/DepotIntake.traj
Original file line number Diff line number Diff line change
@@ -0,0 +1,82 @@
{
"name":"DepotIntake",
"version":3,
"snapshot":{
"waypoints":[
{"x":1.174944281578064, "y":5.828909397125244, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false},
{"x":0.4241056740283966, "y":5.942218780517578, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false},
{"x":1.174944281578064, "y":5.828909397125244, "heading":0.0, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}],
"constraints":[
{"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true},
{"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true},
{"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":16.541, "h":8.0692}}, "enabled":false}],
"targetDt":0.05
},
"params":{
"waypoints":[
{"x":{"exp":"1.174944281578064 m", "val":1.174944281578064}, "y":{"exp":"5.828909397125244 m", "val":5.828909397125244}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false},
{"x":{"exp":"0.4241056740283966 m", "val":0.4241056740283966}, "y":{"exp":"5.942218780517578 m", "val":5.942218780517578}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false},
{"x":{"exp":"1.174944281578064 m", "val":1.174944281578064}, "y":{"exp":"5.828909397125244 m", "val":5.828909397125244}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}],
"constraints":[
{"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true},
{"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true},
{"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":{"exp":"0 m", "val":0.0}, "y":{"exp":"0 m", "val":0.0}, "w":{"exp":"16.541 m", "val":16.541}, "h":{"exp":"8.0692 m", "val":8.0692}}}, "enabled":false}],
"targetDt":{
"exp":"0.05 s",
"val":0.05
}
},
"trajectory":{
"config":{
"frontLeft":{
"x":0.2794,
"y":0.2794
},
"backLeft":{
"x":-0.2794,
"y":0.2794
},
"mass":52.16,
"inertia":4.39,
"gearing":6.5,
"radius":0.0508,
"vmax":628.3185307179587,
"tmax":1.2,
"cof":1.5,
"bumper":{
"front":0.4064,
"side":0.4064,
"back":0.4064
},
"differentialTrackWidth":0.5588
},
"sampleType":"Swerve",
"waypoints":[0.0,0.5104,1.02081],
"samples":[
{"t":0.0, "x":1.17494, "y":5.82891, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-11.63203, "ay":1.75539, "alpha":0.0, "fx":[-151.68167,-151.68167,-151.68167,-151.68167], "fy":[22.89035,22.89035,22.89035,22.89035]},
{"t":0.0464, "x":1.16242, "y":5.8308, "heading":0.0, "vx":-0.53972, "vy":0.08145, "omega":0.0, "ax":-11.6293, "ay":1.75498, "alpha":0.0, "fx":[-151.64605,-151.64605,-151.64605,-151.64605], "fy":[22.88497,22.88497,22.88497,22.88497]},
{"t":0.0928, "x":1.12486, "y":5.83647, "heading":0.0, "vx":-1.07932, "vy":0.16288, "omega":0.0, "ax":-11.62475, "ay":1.7543, "alpha":0.0, "fx":[-151.58668,-151.58668,-151.58668,-151.58668], "fy":[22.87601,22.87601,22.87601,22.87601]},
{"t":0.1392, "x":1.06227, "y":5.84591, "heading":0.0, "vx":-1.61871, "vy":0.24428, "omega":0.0, "ax":-11.61564, "ay":1.75292, "alpha":0.0, "fx":[-151.46801,-151.46801,-151.46801,-151.46801], "fy":[22.8581,22.8581,22.8581,22.8581]},
{"t":0.1856, "x":0.97465, "y":5.85914, "heading":0.0, "vx":-2.15767, "vy":0.32562, "omega":0.0, "ax":-11.58839, "ay":1.74881, "alpha":0.0, "fx":[-151.11255,-151.11255,-151.11255,-151.11255], "fy":[22.80446,22.80446,22.80446,22.80446]},
{"t":0.232, "x":0.86206, "y":5.87613, "heading":0.0, "vx":-2.69537, "vy":0.40676, "omega":0.0, "ax":-0.0012, "ay":0.00018, "alpha":0.0, "fx":[-0.01565,-0.01565,-0.01565,-0.01565], "fy":[0.00236,0.00236,0.00236,0.00236]},
{"t":0.2784, "x":0.737, "y":5.895, "heading":0.0, "vx":-2.69543, "vy":0.40677, "omega":0.0, "ax":11.58839, "ay":-1.74881, "alpha":0.0, "fx":[151.11254,151.11254,151.11254,151.11254], "fy":[-22.80446,-22.80446,-22.80446,-22.80446]},
{"t":0.3248, "x":0.62441, "y":5.91199, "heading":0.0, "vx":-2.15773, "vy":0.32562, "omega":0.0, "ax":11.61564, "ay":-1.75292, "alpha":0.0, "fx":[151.46801,151.46801,151.46801,151.46801], "fy":[-22.8581,-22.8581,-22.8581,-22.8581]},
{"t":0.3712, "x":0.53679, "y":5.92521, "heading":0.0, "vx":-1.61876, "vy":0.24429, "omega":0.0, "ax":11.62475, "ay":-1.7543, "alpha":0.0, "fx":[151.58668,151.58668,151.58668,151.58668], "fy":[-22.87601,-22.87601,-22.87601,-22.87601]},
{"t":0.4176, "x":0.47419, "y":5.93466, "heading":0.0, "vx":-1.07938, "vy":0.16289, "omega":0.0, "ax":11.6293, "ay":-1.75498, "alpha":0.0, "fx":[151.64604,151.64604,151.64604,151.64604], "fy":[-22.88497,-22.88497,-22.88497,-22.88497]},
{"t":0.464, "x":0.43663, "y":5.94033, "heading":0.0, "vx":-0.53978, "vy":0.08146, "omega":0.0, "ax":11.63203, "ay":-1.75539, "alpha":0.0, "fx":[151.68167,151.68167,151.68167,151.68167], "fy":[-22.89035,-22.89035,-22.89035,-22.89035]},
{"t":0.5104, "x":0.42411, "y":5.94222, "heading":0.0, "vx":-0.00006, "vy":0.00001, "omega":0.0, "ax":11.63203, "ay":-1.75539, "alpha":0.0, "fx":[151.68168,151.68168,151.68168,151.68168], "fy":[-22.89035,-22.89035,-22.89035,-22.89035]},
{"t":0.5568, "x":0.43663, "y":5.94033, "heading":0.0, "vx":0.53968, "vy":-0.08144, "omega":0.0, "ax":11.6293, "ay":-1.75498, "alpha":0.0, "fx":[151.64605,151.64605,151.64605,151.64605], "fy":[-22.88497,-22.88497,-22.88497,-22.88497]},
{"t":0.6032, "x":0.47419, "y":5.93466, "heading":0.0, "vx":1.07929, "vy":-0.16288, "omega":0.0, "ax":11.62475, "ay":-1.7543, "alpha":0.0, "fx":[151.58668,151.58668,151.58668,151.58668], "fy":[-22.87601,-22.87601,-22.87601,-22.87601]},
{"t":0.6496, "x":0.53678, "y":5.92522, "heading":0.0, "vx":1.61868, "vy":-0.24428, "omega":0.0, "ax":11.61565, "ay":-1.75292, "alpha":0.0, "fx":[151.46802,151.46802,151.46802,151.46802], "fy":[-22.8581,-22.8581,-22.8581,-22.8581]},
{"t":0.696, "x":0.62439, "y":5.91199, "heading":0.0, "vx":2.15766, "vy":-0.32561, "omega":0.0, "ax":11.58839, "ay":-1.74881, "alpha":0.0, "fx":[151.11256,151.11256,151.11256,151.11256], "fy":[-22.80446,-22.80446,-22.80446,-22.80446]},
{"t":0.7424, "x":0.73698, "y":5.895, "heading":0.0, "vx":2.69537, "vy":-0.40676, "omega":0.0, "ax":0.0012, "ay":-0.00018, "alpha":0.0, "fx":[0.01565,0.01565,0.01565,0.01565], "fy":[-0.00236,-0.00236,-0.00236,-0.00236]},
{"t":0.7888, "x":0.86205, "y":5.87613, "heading":0.0, "vx":2.69542, "vy":-0.40677, "omega":0.0, "ax":-11.58839, "ay":1.74881, "alpha":0.0, "fx":[-151.11256,-151.11256,-151.11256,-151.11256], "fy":[22.80446,22.80446,22.80446,22.80446]},
{"t":0.8352, "x":0.97465, "y":5.85914, "heading":0.0, "vx":2.15771, "vy":-0.32562, "omega":0.0, "ax":-11.61565, "ay":1.75292, "alpha":0.0, "fx":[-151.46802,-151.46802,-151.46802,-151.46802], "fy":[22.8581,22.8581,22.8581,22.8581]},
{"t":0.8816, "x":1.06226, "y":5.84591, "heading":0.0, "vx":1.61874, "vy":-0.24428, "omega":0.0, "ax":-11.62475, "ay":1.7543, "alpha":0.0, "fx":[-151.58668,-151.58668,-151.58668,-151.58668], "fy":[22.87601,22.87601,22.87601,22.87601]},
{"t":0.92801, "x":1.12486, "y":5.83647, "heading":0.0, "vx":1.07934, "vy":-0.16288, "omega":0.0, "ax":-11.6293, "ay":1.75498, "alpha":0.0, "fx":[-151.64605,-151.64605,-151.64605,-151.64605], "fy":[22.88497,22.88497,22.88497,22.88497]},
{"t":0.97441, "x":1.16242, "y":5.8308, "heading":0.0, "vx":0.53973, "vy":-0.08145, "omega":0.0, "ax":-11.63203, "ay":1.75539, "alpha":0.0, "fx":[-151.68168,-151.68168,-151.68168,-151.68168], "fy":[22.89035,22.89035,22.89035,22.89035]},
{"t":1.02081, "x":1.17494, "y":5.82891, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}],
"splits":[0]
},
"events":[]
}
Loading