LED blinken statt leuchten

Zur Bestätigung, dass Mainthread noch läuft
EmbeddedFiedel · Feb 20, 2013 · 822ea50 · 822ea50
1 parent bb1a4a5
commit 822ea50
Showing 1 changed file with 15 additions and 1 deletion.
diff --git a/Project/ARMCM4-STM32F407-DISCOVERY/main.c b/Project/ARMCM4-STM32F407-DISCOVERY/main.c
@@ -60,10 +60,24 @@ int main(void)
 	setup_Motoren();
 	setup_Regelung();
 	setup_Datalogger(); 
-	palSetPad(GPIOD, GPIOD_LED3);       /* Orange.  */
+
 	//send_statustext(MAV_SEVERITY_ALERT, "Initialization finished");
 	while (TRUE) 
 	{
 		//update_IMU();
+
+		palSetPad(GPIOD, GPIOD_LED3);
+		palClearPad(GPIOD, GPIOD_LED5);
+		chThdSleepMilliseconds(200);
+		palSetPad(GPIOD, GPIOD_LED4);
+		palClearPad(GPIOD, GPIOD_LED3);       /* Orange.  */
+		chThdSleepMilliseconds(200);
+		palSetPad(GPIOD, GPIOD_LED6);
+		palClearPad(GPIOD, GPIOD_LED4);
+		chThdSleepMilliseconds(200);
+		palSetPad(GPIOD, GPIOD_LED5);
+		palClearPad(GPIOD, GPIOD_LED6);
+		chThdSleepMilliseconds(200);
+
   }
 }