diff --git a/src/comps/encf.c b/src/comps/encf.c
index f9132891..1adb5a78 100644
--- a/src/comps/encf.c
+++ b/src/comps/encf.c
@@ -236,40 +236,36 @@ static void rt_func(float period, void *ctx_ptr, hal_pin_inst_t *pin_ptr) {
       oldcrc[4]   = crc[4];
     }
     if(crc[0] == 0 && crc[1] == 0 && crc[2] == 0 && crc[3] == 0 && crc[4] == 0) {
-      PIN(crc_ok)
-      ++;
+      PIN(crc_ok)++;
+      int32_t pos = data.fanuc.pos_lo + (data.fanuc.pos_hi << 6);
+      PIN(index) = data.fanuc.no_index;
+
+      PIN(abs_pos) = mod((float)pos * 2.0 * M_PI / (1 << 22));
+
+      if(PIN(index) > 0.0) {
+        pos_offset    = pos;
+        PIN(pos)      = PIN(abs_pos);
+        PIN(state)    = 1;
+        state_counter = 1;
+      } else if(state_counter == 1) {
+        state_counter = 2;
+        pos_offset    = pos;
+        PIN(pos)      = PIN(abs_pos);
+      } else {
+        state_counter = 3;
+        PIN(pos)      = mod((float)(pos + pos_offset) * 2.0 * M_PI / (1 << 22));
+        PIN(state)    = 3;
+      }
+
+      PIN(turns)   = data.fanuc.turns;
+      pos          = data.fanuc.com_pos;
+      PIN(com_pos) = mod(pos * 2.0 * M_PI / 1024);
+      PIN(error)   = 0;
     } else {
-      PIN(crc_er)
-      ++;
+      PIN(crc_er)++;
+      PIN(state) = 1;
+      PIN(error) = 1;
     }
-
-    int32_t pos;
-
-    pos        = data.fanuc.pos_lo + (data.fanuc.pos_hi << 6);
-    PIN(index) = data.fanuc.no_index;
-
-    PIN(abs_pos) = mod((float)pos * 2.0 * M_PI / (1 << 22));
-
-    if(PIN(index) > 0.0) {
-      pos_offset    = pos;
-      PIN(pos)      = PIN(abs_pos);
-      PIN(state)    = 1;
-      state_counter = 1;
-    } else if(state_counter == 1) {
-      state_counter = 2;
-      pos_offset    = pos;
-      PIN(pos)      = PIN(abs_pos);
-    } else {
-      state_counter = 3;
-      PIN(pos)      = mod((float)(pos + pos_offset) * 2.0 * M_PI / (1 << 22));
-      PIN(state)    = 3;
-    }
-
-
-    PIN(turns)   = data.fanuc.turns;
-    pos          = data.fanuc.com_pos;
-    PIN(com_pos) = mod(pos * 2.0 * M_PI / 1024);
-    PIN(error)   = 0;
   } else {
     PIN(error)    = 1;
     PIN(state)    = 1;