File tree Expand file tree Collapse file tree 10 files changed +61
-79
lines changed
Expand file tree Collapse file tree 10 files changed +61
-79
lines changed Original file line number Diff line number Diff line change 7070 "name": "HPPickup"
7171 }
7272 },
73- {
74- "type": "named",
75- "data": {
76- "name": "LineUpHPStationRight"
77- }
78- },
7973 {
8074 "type": "wait",
8175 "data": {
82- "waitTime": 0.75
76+ "waitTime": 0.8
8377 }
8478 }
8579 ]
164158 "name": "HPPickup"
165159 }
166160 },
167- {
168- "type": "named",
169- "data": {
170- "name": "LineUpHPStationRight"
171- }
172- },
173161 {
174162 "type": "wait",
175163 "data": {
176- "waitTime": 0.75
164+ "waitTime": 0.8
177165 }
178166 }
179167 ]
258246 "name": "HPPickup"
259247 }
260248 },
261- {
262- "type": "named",
263- "data": {
264- "name": "LineUpHPStationRight"
265- }
266- },
267249 {
268250 "type": "wait",
269251 "data": {
270- "waitTime": 0.75
252+ "waitTime": 0.8
271253 }
272254 }
273255 ]
Original file line number Diff line number Diff line change 33 "waypoints": [
44 {
55 "anchor": {
6- "x": 3.5483606557377048 ,
7- "y": 2.4725922131147535
6+ "x": 3.1785 ,
7+ "y": 2.61125
88 },
99 "prevControl": null,
1010 "nextControl": {
11- "x": 2.0043549058803896 ,
12- "y": 2.2856309046410273
11+ "x": 1.4994485959043433 ,
12+ "y": 2.4900073898447963
1313 },
1414 "isLocked": false,
1515 "linkedName": "C"
1616 },
1717 {
1818 "anchor": {
19- "x": 1.41375 ,
20- "y": 1.0707499999999994
19+ "x": 1.7160000000000002 ,
20+ "y": 0.8367499999999995
2121 },
2222 "prevControl": {
23- "x": 2.0678511728920146 ,
24- "y": 1.9413712747438887
23+ "x": 2.489738987988048 ,
24+ "y": 1.614557420548854
2525 },
2626 "nextControl": null,
2727 "isLocked": false,
28- "linkedName": "RightLoad"
28+ "linkedName": null
2929 }
3030 ],
3131 "rotationTargets": [],
Original file line number Diff line number Diff line change 33 "waypoints": [
44 {
55 "anchor": {
6- "x": 3.6202868852459016 ,
7- "y": 2.388678278688524
6+ "x": 3.471 ,
7+ "y": 2.5429999999999997
88 },
99 "prevControl": null,
1010 "nextControl": {
11- "x": 1.8509583269127923 ,
12- "y": 2.046185727606702
11+ "x": 1.7016714416668908 ,
12+ "y": 2.2005074489181777
1313 },
1414 "isLocked": false,
1515 "linkedName": "D"
1616 },
1717 {
1818 "anchor": {
19- "x": 1.41375 ,
20- "y": 1.0707499999999994
19+ "x": 1.6769999999999998 ,
20+ "y": 0.8367499999999995
2121 },
2222 "prevControl": {
23- "x": 2.277592483249231 ,
24- "y": 1.7782897067969352
23+ "x": 2.5408424832492305 ,
24+ "y": 1.5442897067969352
2525 },
2626 "nextControl": null,
2727 "isLocked": false,
Original file line number Diff line number Diff line change 88 },
99 "prevControl": null,
1010 "nextControl": {
11- "x": 4.781005953468027 ,
12- "y": 2.3453856263165553
11+ "x": 5.03061125192863 ,
12+ "y": 2.4259981266462574
1313 },
1414 "isLocked": false,
1515 "linkedName": "F"
1616 },
1717 {
1818 "anchor": {
19- "x": 1.41375 ,
20- "y": 1.0707499999999994
19+ "x": 1.7355 ,
20+ "y": 0.8075
2121 },
2222 "prevControl": {
23- "x": 2.8896639125659895 ,
24- "y": 1.6652050077739282
23+ "x": 2.9366891626323035 ,
24+ "y": 1.471976733921906
2525 },
2626 "nextControl": null,
2727 "isLocked": false,
28- "linkedName": "RightLoad"
28+ "linkedName": null
2929 }
3030 ],
3131 "rotationTargets": [],
Original file line number Diff line number Diff line change 33 "waypoints": [
44 {
55 "anchor": {
6- "x": 5.5672500000000005 ,
7- "y": 5.604500000000001
6+ "x": 5.5575 ,
7+ "y": 5.38025
88 },
99 "prevControl": null,
1010 "nextControl": {
11- "x": 4.656518608927145 ,
12- "y": 5.9812761975423046
11+ "x": 4.700934999670552 ,
12+ "y": 5.832404986292486
1313 },
1414 "isLocked": false,
1515 "linkedName": "I"
1616 },
1717 {
1818 "anchor": {
19- "x": 1.6867500000000002 ,
19+ "x": 1.7745 ,
2020 "y": 7.27175
2121 },
2222 "prevControl": {
23- "x": 3.2541074563055243 ,
24- "y": 6.578409511381681
23+ "x": 3.2662498409826606 ,
24+ "y": 6.500815623557918
2525 },
2626 "nextControl": null,
2727 "isLocked": false,
4242 },
4343 "goalEndState": {
4444 "velocity": 0,
45- "rotation": -54.293308599397086
45+ "rotation": -53.97262661489624
4646 },
4747 "reversed": false,
4848 "folder": "Left",
Original file line number Diff line number Diff line change 1616 },
1717 {
1818 "anchor": {
19- "x": 1.7647500000000003 ,
20- "y": 6.99875
19+ "x": 1.8232499999999998 ,
20+ "y": 7.07675
2121 },
2222 "prevControl": {
23- "x": 2.1830634369758912 ,
24- "y": 6.553028097353261
23+ "x": 2.2415634369758908 ,
24+ "y": 6.63102809735326
2525 },
2626 "nextControl": null,
2727 "isLocked": false,
Original file line number Diff line number Diff line change 33 "waypoints": [
44 {
55 "anchor": {
6- "x": 1.41375 ,
7- "y": 1.0707499999999994
6+ "x": 1.6769999999999998 ,
7+ "y": 0.8367499999999995
88 },
99 "prevControl": null,
1010 "nextControl": {
11- "x": 1.8983041185724925 ,
12- "y": 1.7702061892263394
11+ "x": 2.2999380543998793 ,
12+ "y": 1.8439969667333564
1313 },
1414 "isLocked": false,
1515 "linkedName": "RightLoad"
1616 },
1717 {
1818 "anchor": {
19- "x": 3.5483606557377048 ,
20- "y": 2.4725922131147535
19+ "x": 3.1785 ,
20+ "y": 2.61125
2121 },
2222 "prevControl": {
23- "x": 2.1155935941598862 ,
24- "y": 2.2624007664137196
23+ "x": 1.7938294045143734 ,
24+ "y": 2.24923454838888
2525 },
2626 "nextControl": null,
2727 "isLocked": false,
Original file line number Diff line number Diff line change 33 "waypoints": [
44 {
55 "anchor": {
6- "x": 1.41375 ,
7- "y": 1.0707499999999994
6+ "x": 1.6769999999999998 ,
7+ "y": 0.8367499999999995
88 },
99 "prevControl": null,
1010 "nextControl": {
11- "x": 1.88702349243721 ,
12- "y": 1.1841297027883004
11+ "x": 2.285578590876466 ,
12+ "y": 1.7988709699787229
1313 },
1414 "isLocked": false,
1515 "linkedName": "RightLoad"
1616 },
1717 {
1818 "anchor": {
19- "x": 3.6202868852459016 ,
20- "y": 2.388678278688524
19+ "x": 3.471 ,
20+ "y": 2.5429999999999997
2121 },
2222 "prevControl": {
23- "x": 1.9926534127600743 ,
24- "y": 2.1438672723736283
23+ "x": 2.0115509097009845 ,
24+ "y": 2.0792668699484196
2525 },
2626 "nextControl": null,
2727 "isLocked": false,
Original file line number Diff line number Diff line change 1616 },
1717 {
1818 "anchor": {
19- "x": 5.5672500000000005 ,
20- "y": 5.604500000000001
19+ "x": 5.5575 ,
20+ "y": 5.38025
2121 },
2222 "prevControl": {
23- "x": 6.2633439197057355 ,
24- "y": 5.827870866046262
23+ "x": 6.253593919705735 ,
24+ "y": 5.603620866046262
2525 },
2626 "nextControl": null,
2727 "isLocked": false,
Original file line number Diff line number Diff line change @@ -283,8 +283,8 @@ public void setupTeleopButtons() {
283283 RushinatorWrist .kLastState == RushinatorWrist .State .kHPMid )
284284 );
285285
286- // controller.povUp().whileTrue (new AutoAlignHP(() -> HPStation.BLU_RIGHT_STATION.AprilTag));
287- // controller.povDown().whileTrue (new AutoAlignHP(() -> HPStation.BLU_LEFT_STATION.AprilTag));
286+ controller .povUp ().onTrue (new AutoAlignHP (() -> HPStation .BLU_RIGHT_STATION .AprilTag ));
287+ controller .povDown ().onTrue (new AutoAlignHP (() -> HPStation .BLU_LEFT_STATION .AprilTag ));
288288
289289 //Align to Reef
290290 // controller.povLeft().whileTrue(new DriveToPoseCommand(
You can’t perform that action at this time.
0 commit comments