diff --git a/STM32/CM7/Core/Inc/macros.h b/STM32/CM7/Core/Inc/macros.h
index d76b5da..f09fa86 100644
--- a/STM32/CM7/Core/Inc/macros.h
+++ b/STM32/CM7/Core/Inc/macros.h
@@ -5,6 +5,7 @@
 #include "global_state.h"
 #ifdef DEBUG
 #include "SEGGER_RTT.h"
+#define INJECTION_PHASE 0
 #define DEBUG_LOG(fmt, ...) SEGGER_RTT_printf(0, fmt "\n", ##__VA_ARGS__)
 #else
 #define DEBUG_LOG(fmt, ...)                                                    \
diff --git a/STM32/CM7/Core/Src/tasks/crank.c b/STM32/CM7/Core/Src/tasks/crank.c
index c18613c..8eb3b14 100644
--- a/STM32/CM7/Core/Src/tasks/crank.c
+++ b/STM32/CM7/Core/Src/tasks/crank.c
@@ -81,6 +81,9 @@ void crankHandler(void *argument) {
       // TODO: schedule spark
       // __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_3, t_spark);
       // TIM2_CH3_SetOCMode(t_spark);
+    } else if (state_g.crank_state == CYCLE_EXHAUST) {
+        uint32_t t_injection = CRANK(0) + (45+INJECTION_PHASE) * (CRANK(4) - CRANK(0)) / 720;
+        //TODO Schedule injection
     }
   }
 }