diff --git a/demos/ARMCM4-STM32F407-LWIP-FATFS-USB/main.c b/demos/ARMCM4-STM32F407-LWIP-FATFS-USB/main.c
index 98d9335eb..98f6a3b0f 100644
--- a/demos/ARMCM4-STM32F407-LWIP-FATFS-USB/main.c
+++ b/demos/ARMCM4-STM32F407-LWIP-FATFS-USB/main.c
@@ -133,10 +133,8 @@ static msg_t Thread1(void *arg) {
   (void)arg;
   chRegSetThreadName("blinker");
   while (TRUE) {
-    palClearPad(GPIOC, GPIOC_LED);
-    chThdSleepMilliseconds(500);
-    palSetPad(GPIOC, GPIOC_LED);
-    chThdSleepMilliseconds(500);
+    palTogglePad(GPIOC, GPIOC_LED);
+    chThdSleepMilliseconds(cnt ? 500 : 125);
   }
 }