diff --git a/Firmware/src/main.cpp b/Firmware/src/main.cpp
index c496cb8..153cb96 100755
--- a/Firmware/src/main.cpp
+++ b/Firmware/src/main.cpp
@@ -33,6 +33,11 @@ void cb_set_outputs(void) // Master outputs gets here, slave inputs, first opera
    Step1.cmdPos(Obj.StepGenIn1.CommandedPosition);
 }
 
+void handleStepper(void)
+{
+   Step1.handleStepper();
+}
+
 void cb_get_inputs(void) // Set Master inputs, slave outputs, last operation
 {
    Obj.IndexStatus = Encoder1.indexHappened();
@@ -49,7 +54,6 @@ void ESC_interrupt_enable(uint32_t mask);
 void ESC_interrupt_disable(uint32_t mask);
 uint16_t dc_checker(void);
 void sync0Handler(void);
-void handleStepper(void);
 
 static esc_cfg_t config =
     {
@@ -101,11 +105,6 @@ void sync0Handler(void)
    serveIRQ = 1;
 }
 
-void handleStepper(void)
-{
-   Step1.handleStepper();
-}
-
 void ESC_interrupt_enable(uint32_t mask)
 {
    // Enable interrupt for SYNC0 or SM2 or SM3