Skip to content

Commit

Permalink
Merge pull request #2 from HighlanderRobotics/pathplanner
Browse files Browse the repository at this point in the history 
Pathplanner Implememtation
  • Loading branch information
@Lewis-Seiden
Lewis-Seiden authored Jan 10, 2024
2 parents a1fa126 + a9e8392 commit 7162108
Show file tree
Hide file tree
Showing 13 changed files with 1,736 additions and 32 deletions.
12 changes: 12 additions & 0 deletions .pathplanner/settings.json
View file
Original file line number Diff line number Diff line change
@@ -0,0 +1,12 @@
{
"robotWidth": 0.9,
"robotLength": 0.9,
"holonomicMode": true,
"pathFolders": [],
"autoFolders": [],
"defaultMaxVel": 3.0,
"defaultMaxAccel": 3.0,
"defaultMaxAngVel": 540.0,
"defaultMaxAngAccel": 720.0,
"maxModuleSpeed": 4.5
}
3 changes: 2 additions & 1 deletion .vscode/settings.json
View file
Original file line number Diff line number Diff line change
Expand Up @@ -25,5 +25,6 @@
}
},
],
"java.test.defaultConfig": "WPIlibUnitTests"
"java.test.defaultConfig": "WPIlibUnitTests",
"java.compile.nullAnalysis.mode": "automatic"
}
578 changes: 578 additions & 0 deletions choreo.chor
View file

Large diffs are not rendered by default.

20 changes: 20 additions & 0 deletions simgui.json
View file
Original file line number Diff line number Diff line change
Expand Up @@ -7,8 +7,28 @@
"NetworkTables": {
"transitory": {
"AdvantageKit": {
"RealOutputs": {
"Odometry": {
"open": true
},
"open": true
},
"open": true
}
}
},
"NetworkTables Info": {
"AdvantageScope@1": {
"Publishers": {
"open": true
},
"Subscribers": {
"open": true
},
"open": true
},
"Clients": {
"open": true
}
}
}
175 changes: 175 additions & 0 deletions src/main/deploy/choreo/amp 4 local sgmt 1.traj
View file
Original file line number Diff line number Diff line change
@@ -0,0 +1,175 @@
{
"samples": [
{
"x": 0.7470832467079163,
"y": 6.625458717346191,
"heading": 1.056495497952334,
"angularVelocity": 1.8216849722605286e-31,
"velocityX": 0,
"velocityY": 0,
"timestamp": 0
},
{
"x": 0.7875510590073889,
"y": 6.647513625582565,
"heading": 0.9955054911508737,
"angularVelocity": -1.1259767405457384,
"velocityX": 0.7471029727592392,
"velocityY": 0.4071702069138493,
"timestamp": 0.05416631143899068
},
{
"x": 0.8691098883744304,
"y": 6.691702168377954,
"heading": 0.8785332104893699,
"angularVelocity": -2.159502420489772,
"velocityX": 1.505711339767041,
"velocityY": 0.8157938323926509,
"timestamp": 0.10833262287798136
},
{
"x": 0.9931586796399057,
"y": 6.758536729383142,
"heading": 0.7242571551382772,
"angularVelocity": -2.848192008142514,
"velocityX": 2.290146549949145,
"velocityY": 1.2338769103830776,
"timestamp": 0.16249893431697204
},
{
"x": 1.1542844409320208,
"y": 6.847841004747936,
"heading": 0.6582721283096681,
"angularVelocity": -1.2181930996525292,
"velocityX": 2.974648947133801,
"velocityY": 1.6487051267166433,
"timestamp": 0.21666524575596272
},
{
"x": 1.3362429767095947,
"y": 6.9407596540671515,
"heading": 0.6582720385538592,
"angularVelocity": -0.0000016570411839532803,
"velocityX": 3.3592565368332274,
"velocityY": 1.7154324680917685,
"timestamp": 0.2708315571949534
},
{
"x": 1.5182021069161247,
"y": 7.033677139333042,
"heading": 0.6582719487984567,
"angularVelocity": -0.0000016570336808247504,
"velocityX": 3.359267510978228,
"velocityY": 1.7154109777356332,
"timestamp": 0.3249978686339441
},
{
"x": 1.7157951910460691,
"y": 7.085636206134739,
"heading": 0.6582717690726799,
"angularVelocity": -0.0000033180361009936695,
"velocityX": 3.647896245482769,
"velocityY": 0.9592506009979895,
"timestamp": 0.3791641800729348
},
{
"x": 1.8967940454930174,
"y": 7.095126843263903,
"heading": 0.5939474144774982,
"angularVelocity": -1.1875343342814295,
"velocityX": 3.3415392268460664,
"velocityY": 0.1752129114394957,
"timestamp": 0.4333304915119255
},
{
"x": 2.0516314923077155,
"y": 7.067103472452243,
"heading": 0.46543090394591263,
"angularVelocity": -2.3726280619336353,
"velocityX": 2.8585562262089095,
"velocityY": -0.5173579309202905,
"timestamp": 0.4874968029509162
},
{
"x": 2.1749652200442315,
"y": 7.00220729212556,
"heading": 0.30618928904490067,
"angularVelocity": -2.9398644779490204,
"velocityX": 2.2769452905322995,
"velocityY": -1.198091186249191,
"timestamp": 0.5416631143899069
},
{
"x": 2.2610747814178467,
"y": 6.9050798416137695,
"heading": 0.15617120010566338,
"angularVelocity": -2.7695828819396024,
"velocityX": 1.5897254047029348,
"velocityY": -1.7931339227554435,
"timestamp": 0.5958294258288975
},
{
"x": 2.3021420961741277,
"y": 6.690129168178249,
"heading": -0.009663328888242836,
"angularVelocity": -2.0165575251161725,
"velocityX": 0.4993809377969598,
"velocityY": -2.6138127003762723,
"timestamp": 0.6780658742953757
},
{
"x": 2.248466001407306,
"y": 6.41546750147008,
"heading": -0.10873685342712126,
"angularVelocity": -1.204739825057738,
"velocityX": -0.6527044366306908,
"velocityY": -3.3399018541045957,
"timestamp": 0.7603023227618538
},
{
"x": 2.085165640858422,
"y": 6.151744237063873,
"heading": -0.10873683701731249,
"angularVelocity": 1.9954422992985155e-7,
"velocityX": -1.9857418893211336,
"velocityY": -3.2068902454330503,
"timestamp": 0.842538771228332
},
{
"x": 1.8574534262453974,
"y": 5.941116320042222,
"heading": -0.10873681487910887,
"angularVelocity": 2.692018447413834e-7,
"velocityX": -2.7689937838918954,
"velocityY": -2.5612477307736583,
"timestamp": 0.9247752196948101
},
{
"x": 1.629741023592729,
"y": 5.730488606312599,
"heading": -0.10873679274080142,
"angularVelocity": 2.6920310704244503e-7,
"velocityX": -2.76899607046491,
"velocityY": -2.5612452587307564,
"timestamp": 1.0070116681612884
},
{
"x": 1.4644902813281564,
"y": 5.577695792451846,
"heading": 0.0012781207724603802,
"angularVelocity": 1.337787751839788,
"velocityX": -2.009458644507651,
"velocityY": -1.8579695099921079,
"timestamp": 1.0892481166277665
},
{
"x": 1.3818649053573608,
"y": 5.5012993812561035,
"heading": 0.05628563945524819,
"angularVelocity": 0.6688946289455666,
"velocityX": -1.0047293810903806,
"velocityY": -0.9289848068631428,
"timestamp": 1.1714845650942447
}
]
}
103 changes: 103 additions & 0 deletions src/main/deploy/choreo/amp 4 local sgmt 2.traj
View file
Original file line number Diff line number Diff line change
@@ -0,0 +1,103 @@
{
"samples": [
{
"x": 1.3818649053573608,
"y": 5.5012993812561035,
"heading": 0.05628563945524819,
"angularVelocity": 8.108539434054397e-29,
"velocityX": -3.383351472481295e-31,
"velocityY": 2.5568610146599268e-30,
"timestamp": 1.2537210135607229
},
{
"x": 1.4659695573316451,
"y": 5.505361506655373,
"heading": 0.050154371824367786,
"angularVelocity": -0.0866134750258778,
"velocityX": 1.188106051128092,
"velocityY": 0.05738369583633677,
"timestamp": 1.3245098559325195
},
{
"x": 1.6341788550204006,
"y": 5.5134857557639885,
"heading": 0.03789188378734141,
"angularVelocity": -0.17322628293059847,
"velocityX": 2.3762120138268115,
"velocityY": 0.11476736779992304,
"timestamp": 1.395298698304316
},
{
"x": 1.8864927796012139,
"y": 5.525672125057411,
"heading": 0.019498324963128963,
"angularVelocity": -0.25983697724008453,
"velocityX": 3.5643177106303305,
"velocityY": 0.1721509899740557,
"timestamp": 1.4660875406761127
},
{
"x": 2.1102347064408926,
"y": 5.533923842143074,
"heading": 0.00011174721946555298,
"angularVelocity": -0.2738648789005671,
"velocityX": 3.160694812108141,
"velocityY": 0.11656804673148825,
"timestamp": 1.5368763830479093
},
{
"x": 2.249872007587195,
"y": 5.538113436672261,
"heading": -0.013143603106743272,
"angularVelocity": -0.18725197195045482,
"velocityX": 1.9725891322378306,
"velocityY": 0.0591843910539215,
"timestamp": 1.607665225419706
},
{
"x": 2.3054046630859375,
"y": 5.538240909576416,
"heading": -0.020267736871838693,
"angularVelocity": -0.10063921836266371,
"velocityX": 0.784483170484331,
"velocityY": 0.0018007485344283746,
"timestamp": 1.6784540677915025
},
{
"x": 2.206836259942782,
"y": 5.529745448091516,
"heading": -0.017578724891835627,
"angularVelocity": 0.025983583153922206,
"velocityX": -0.9524540308729255,
"velocityY": -0.08209057139403513,
"timestamp": 1.7819429501397848
},
{
"x": 1.9285141868544358,
"y": 5.512568166846942,
"heading": -0.0017855827044546864,
"angularVelocity": 0.15260713836130316,
"velocityX": -2.689391041558251,
"velocityY": -0.1659818992610695,
"timestamp": 1.885431832488067
},
{
"x": 1.5690068282385219,
"y": 5.495204505355553,
"heading": 0.024422680398419737,
"angularVelocity": 0.25324713638971313,
"velocityX": -3.4738742023131053,
"velocityY": -0.16778286804715686,
"timestamp": 1.9889207148363492
},
{
"x": 1.3892531394958496,
"y": 5.486522674560547,
"heading": 0.03752685285960867,
"angularVelocity": 0.12662396350062077,
"velocityX": -1.7369371923230166,
"velocityY": -0.08389143450007014,
"timestamp": 2.0924095971846315
}
]
}
Loading

0 comments on commit 7162108

Please sign in to comment.