diff --git a/src/FreeRTOSConfig.h b/src/FreeRTOSConfig.h
index 41e54133..b4aea161 100644
--- a/src/FreeRTOSConfig.h
+++ b/src/FreeRTOSConfig.h
@@ -62,7 +62,7 @@
 #define configCPU_CLOCK_HZ                                                        ( SystemCoreClock )
 #define configTICK_RATE_HZ                                                        1024
 #define configMAX_PRIORITIES                                                      ( 3 )
-#define configMINIMAL_STACK_SIZE                                                  ( 60 )
+#define configMINIMAL_STACK_SIZE                                                  ( 120 )
 #define configTOTAL_HEAP_SIZE                                                     ( 24000 )
 #define configMAX_TASK_NAME_LEN                                                   ( 4 )
 #define configUSE_16_BIT_TICKS                                                    0
diff --git a/src/main.cpp b/src/main.cpp
index 420bb948..7f8bef8c 100644
--- a/src/main.cpp
+++ b/src/main.cpp
@@ -44,7 +44,7 @@ void nrfx_gpiote_evt_handler(nrfx_gpiote_pin_t pin, nrf_gpiote_polarity_t action
 
   BaseType_t xHigherPriorityTaskWoken = pdFALSE;
   xTimerStartFromISR(debounceTimer, &xHigherPriorityTaskWoken);
-  // TODO should I do something if xHigherPriorityTaskWoken == pdTRUE?
+  portYIELD_FROM_ISR(xHigherPriorityTaskWoken);
 }
 
 void DebounceTimerCallback(TimerHandle_t xTimer) {