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
|
#include <main.h>
Sensor intakeFrontLeft,
intakeFrontRight,
intakeLiftBase,
intakeLiftTop,
robotGyro;
Gyro gyro;
bool initializeDone = false;
void initializeIO(void){
intakeFrontLeft = initSensor(7,ANALOG);
intakeFrontRight = initSensor(6,ANALOG);
intakeLiftBase = initUltrasonic(1,2);
intakeLiftTop = initSensor(8,ANALOG);
//robotGyro = initSensor(2,GYRO);
pinMode(12,OUTPUT);
digitalWrite(12,1);
}
void initialize(void){
lcdInit(uart2);
lcdClear(uart2);
lcdSetBacklight(uart2,true);
gyro = gyroInit(2,0);
imeInitializeAll();
lcdPrint(uart2,1," 5106 ZEPHYR ");
initializeDone = true;
delay(2000);
}
|
