diff --git a/motor-control/firmware/README.md b/motor-control/firmware/README.md
index ca58830..857a0ec 100644
--- a/motor-control/firmware/README.md
+++ b/motor-control/firmware/README.md
@@ -1,3 +1,3 @@
 version https://git-lfs.github.com/spec/v1
-oid sha256:a75aa7cdc67b33fbd12b04084b4033a54b71855cfb363558f106092e32f3691a
-size 246
+oid sha256:1c98aeae827928cfcc92d2a0c8fa2c4611e3ff7009dd131502195e9ce924e5ab
+size 491
diff --git a/motor-control/firmware/src/main.cpp b/motor-control/firmware/src/main.cpp
index 78b8675..09be6ee 100755
--- a/motor-control/firmware/src/main.cpp
+++ b/motor-control/firmware/src/main.cpp
@@ -18,11 +18,23 @@
 
 #define LED_PIN 25
 
+#define RGB1_R_PIN 21
+#define RGB1_G_PIN 22
+
+#define RGB2_R_PIN 26
+#define RGB2_G_PIN 27
+#define RGB2_B_PIN 28
+
+#define BOARD_LED1_PIN 14
+#define BOARD_LED2_PIN 15
+
 #define ENABLE0_PIN 2
 #define ENABLE1_PIN 3
 
 #define LIMIT0_PIN 10
 #define LIMIT1_PIN 11
+#define LIMIT2_PIN 12
+#define LIMIT3_PIN 13
 
 #define STEP0_PIN 6
 #define STEP1_PIN 7
@@ -61,10 +73,8 @@ int main() {
 
     sleep_ms(5);
 
-    
     step_driver.set_conf1(10000, 0);
 
-
     gpio_init(LIMIT0_PIN);
     gpio_set_dir(LIMIT0_PIN, GPIO_IN);
     gpio_pull_up(LIMIT0_PIN);
@@ -100,6 +110,9 @@ int main() {
     gpio_init(LED_PIN);
     gpio_set_dir(LED_PIN, GPIO_OUT);
 
+    step_driver.set_conf0(10000, 0);
+    step_driver.pulse0(1000000);
+
     while (true) {
         sleep_ms(50);
         gpio_put(LED_PIN, 0);