2 files changed, 5 insertions, 1 deletions
diff --git a/testhal/STM32L1xx/GPT/Makefile b/testhal/STM32L1xx/GPT/Makefile
index 9209b441d..10a6ed0e8 100644
--- a/testhal/STM32L1xx/GPT/Makefile
+++ b/testhal/STM32L1xx/GPT/Makefile
@@ -5,7 +5,7 @@
 
 # Compiler options here.
 ifeq ($(USE_OPT),)
-  USE_OPT = -O2 -ggdb -fomit-frame-pointer -falign-functions=16
+  USE_OPT = -O0 -ggdb -fomit-frame-pointer -falign-functions=16
 endif
 
 # C++ specific options here (added to USE_OPT).
diff --git a/testhal/STM32L1xx/GPT/main.c b/testhal/STM32L1xx/GPT/main.c
index 90e06879a..49247bac6 100644
--- a/testhal/STM32L1xx/GPT/main.c
+++ b/testhal/STM32L1xx/GPT/main.c
@@ -86,8 +86,12 @@ int main(void) {
    * five seconds.
    */
   while (TRUE) {
+    palSetPad(GPIOB, GPIOB_LED3);
+    gptStopTimer(&GPTD2);
     gptStartContinuous(&GPTD2, 5000);
     chThdSleepMilliseconds(5000);
+    palClearPad(GPIOB, GPIOB_LED3);
+    gptStopTimer(&GPTD2);
     gptStartContinuous(&GPTD2, 2500);
     chThdSleepMilliseconds(5000);
   }