From c13d115a76ef859a291c6aba0d3249b2b50baf0a Mon Sep 17 00:00:00 2001
From: Stepan Usatiuk <stepanusatiuk@gmail.com>
Date: Thu, 19 Mar 2020 12:48:05 +0300
Subject: [PATCH] [AVR] initialize pen before everything else

---
 Firmware/MotorControl/src/main.cpp | 4 ++--
 1 file changed, 2 insertions(+), 2 deletions(-)

diff --git a/Firmware/MotorControl/src/main.cpp b/Firmware/MotorControl/src/main.cpp
index b0e7606..5798084 100644
--- a/Firmware/MotorControl/src/main.cpp
+++ b/Firmware/MotorControl/src/main.cpp
@@ -113,6 +113,8 @@ void execCommand(Command cmd) {
 
 void setup() {
     Serial.begin(9600);
+    servoStepper.setPos(xLimit);
+    pen.init();
     Wire.begin(8);
     Wire.onReceive(receiveEvent);
     Wire.onRequest(requestEvent);
@@ -124,8 +126,6 @@ void setup() {
     OCR2A = 250;
     TCCR2A |= (1 << WGM20) | (1 << CS22);
     TIMSK2 |= (1 << OCIE2A);
-    servoStepper.setPos(xLimit);
-    pen.init();
 }
 
 volatile unsigned int tick = 0;