 #include <Motor.h>
 #include "QTRSensors_teensy3.h"
 
-#define BLUETOOTH Serial1
+#define BLUETOOTH Serial
 
 #define ON_LINE(sensor)((sensor<COMPARE))
 #define OVERSHOOT_LINE_TIME 50

			LED_LEFT_ON;
			LED_RIGHT_ON;

			BLUETOOTH.println(path);
			BLUETOOTH.println("END OF MAPPING MODE");

				motorLeft.write(512);
				motorRight.write(512);
				//delay(50);
			LED_LEFT_OFF;
			LED_RIGHT_OFF;


	
	// Mode 1 for simplifying path
	//if (MODE == 1)
		//simplifyPath();

	// Mode 2 for running on simplified path
	//if (MODE == 2)
		//runSimplifiedPath();

}

