src/auto.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41

#include <main.h>

/*#define TARGET_SPEED 65

static unsigned int time;

void autoDelay(unsigned int ms){
	delay(ms);
	time-=ms;
}*/

void autonomous(){
	/*static char speed = 0;

	time = 15000;

	do{

		speed+=10;

		motorSet(CANNON1,speed);
		motorSet(CANNON2,speed);
		motorSet(CANNON3,speed);
		motorSet(CANNON4,speed);

		autoDelay(200);

	}while(speed<TARGET_SPEED);

	autoDelay(800);

	motorSet(LIFT1 ,127);
	motorSet(LIFT2 ,127);
	motorSet(INTAKE,127);

	//while(1);
	delay(time);

	motorStopAll();*/

}