robot/mode_scal.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19

#include "mode_scal.h"

void w2_mode_scal() {
	// TODO ???
	/* pololu_3pi_init(2000);
	for (int counter = 0; counter < 80; counter++) {
		if (counter < 20 || counter >= 60) {
			g_w2_io.motor_left.speed  = 40;
			g_w2_io.motor_right.speed = -40;
		} else {
			g_w2_io.motor_left.speed  = -40;
			g_w2_io.motor_right.speed = 40;
		}

		calibrate_line_sensors(IR_EMITTERS_ON);

		delay_ms(20); // TODO foei
	} */
}