src/init.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

#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);
}

void initialize(void){
	lcdInit(uart2);
	lcdClear(uart2);
	lcdSetBacklight(uart2,true);

	gyro = gyroInit(2,0);

	imeInitializeAll();

	lcdPrint(uart2,1,"  5106  ZEPHYR  ");

	initializeDone = true;
	delay(2000);
}