-
Notifications
You must be signed in to change notification settings - Fork 0
/
Driver_Autos.c
20 lines (18 loc) · 1.13 KB
/
Driver_Autos.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
const int AutoDescore[][]={
{0, 0, 0, 0, 0, 0, 0, 0, RESETAUTO},
{GLPos, 0, 0, 0, Rev, Rev, 0, -300, ENCODSTRA}, //Back up
{GLPos, 0, 0, Down, 0, 0, 0, 500, TIMELIMIT}, //Lower descorer
{GLPos, 0, 0, -50, Rev, Rev, 0, -400, ENCODSTRA}, //Pull out bags
{GLPos, 0, 0, -50, -75, -75, 0, -300, ENCODSTRA}, //Pull out bags
{GLPos, 0, 0, Up, Fwd, Fwd, 0, 550, ENCODSTRA}, //Drive back into the trough
{0, 0, 0, 0, 0, 0, 0, 0, RESETAUTO}};
const int AutoPyramid[][]={
{0, 0, 0, 0, 0, 0, 0, 0, RESETAUTO},
{GLPos, 0, Up, 0, 0, 0, 0, 500, TIMELIMIT}, //scoop up bags in pyramid part 1
{GLPos, Rev, LSPos, 0, Rev, Rev, 0, -200, ENCODSTRA}, //back up
{GLPos, 0, LSPos, 0, Fwd, Fwd, 0, 300, ENCODSTRA}, //drive forward
{GLPos, 0, Up, 0, 0, 0, 0, 500, TIMELIMIT}, //scoop up bags in pyramid part 2
{GLPos, Rev, LSPos, 0, Rev, Rev, 0, -100, ENCODSTRA}, //back up
{GLPos, 0, LSPos, 0, Fwd, Fwd, 0, 300, ENCODSTRA}, //drive forward
{GLPos, 0, Up, 0, 0, 0, 0, 500, TIMELIMIT}, //scoop up bags in pyramid part 3
{0, 0, 0, 0, 0, 0, 0, 0, RESETAUTO}};