diff --git a/include/timer_usec.h b/include/timer_usec.h
index ee3aebd..3872cf9 100644
--- a/include/timer_usec.h
+++ b/include/timer_usec.h
@@ -17,7 +17,7 @@ public:
 
     Timer_usec();
 
-    void set_callback(callback_t callback, void *context);
+    void set_callback(void (*callback)(void *), void *user_data);
     void init(uint16_t period_us);
 
 private:
diff --git a/platformio.ini b/platformio.ini
index 4065b4e..ced70ed 100644
--- a/platformio.ini
+++ b/platformio.ini
@@ -13,6 +13,8 @@ platform = ststm32
 board = nucleo_l432kc
 framework = zephyr
 
+monitor_speed = 115200
+
 upload_flags = 
     -c
     reset_config srst_only srst_nogate connect_assert_srst
diff --git a/src/main.c b/src/main.c
index a54dbc0..08da793 100644
--- a/src/main.c
+++ b/src/main.c
@@ -2,11 +2,11 @@
 
 #ifndef PIO_UNIT_TESTING
 
-void gamla_m_ain(void);
+void motor_application_main(void);
 
 void main(void)
 {
-    gamla_m_ain();
+    motor_application_main();
 }
 
 #endif
\ No newline at end of file
diff --git a/src/timer_usec.cpp b/src/timer_usec.cpp
index cd63e59..9d8f53b 100644
--- a/src/timer_usec.cpp
+++ b/src/timer_usec.cpp
@@ -8,6 +8,15 @@ Timer_usec::Timer_usec() //= default;
 
 }
 
+void Timer_usec::set_callback(
+    callback_t callback_function,
+    void *user_data)
+{
+    callback = callback_function;
+    callback_context = user_data;
+}
+
+
 // void Timer_usec::init(uint16_t period_us) { // for custom duty cycle duration in ms in part 1
 //     TCCR1A = 0;
 //     TCCR1B = 0;