1 files changed, 17 insertions, 1 deletions
diff --git a/robot/mode_scal.c b/robot/mode_scal.c
index e3a9c97..f3178d7 100644
--- a/robot/mode_scal.c
+++ b/robot/mode_scal.c
@@ -1,3 +1,19 @@
 #include "mode_scal.h"
 
-void w2_mode_scal() {}
+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
+	} */
+}