diff --git a/Firmware/MotorControl/encoder.cpp b/Firmware/MotorControl/encoder.cpp
index c1223d07..544a0d39 100644
--- a/Firmware/MotorControl/encoder.cpp
+++ b/Firmware/MotorControl/encoder.cpp
@@ -368,6 +368,7 @@ uint8_t parity(uint16_t v){
     v ^= v >> 1;
     return v & 1;
 }
+
 void Encoder::abs_spi_cb(){
     HAL_GPIO_WritePin(abs_spi_cs_port_, abs_spi_cs_pin_, GPIO_PIN_SET);
     switch (config_.mode) {
diff --git a/Firmware/Tests/test_runner.cpp b/Firmware/Tests/test_runner.cpp
index cae2441c..aa2476f9 100644
--- a/Firmware/Tests/test_runner.cpp
+++ b/Firmware/Tests/test_runner.cpp
@@ -321,7 +321,8 @@ TEST_SUITE("vel_ramp") {
     }
 
     TEST_CASE("Parity") {
-        CHECK(parity(0x0DDF) == 0);
-        CHECK(parity(0x8DDF) == 1);
+        CHECK(parity(0x0DDF & 0x7FFF) == 0);
+        CHECK(parity(0x8DDF & 0x7FFF) == 0);
+        CHECK(parity(0x5BFF & 0x7FFF) == 1);
     }
 }
\ No newline at end of file
diff --git a/Firmware/Tupfile.lua b/Firmware/Tupfile.lua
index 16e3aa2a..d329e4e7 100644
--- a/Firmware/Tupfile.lua
+++ b/Firmware/Tupfile.lua
@@ -191,6 +191,6 @@ build{
 
 if tup.getconfig('DOCTEST') == 'true' then
     TEST_INCLUDES = '-IC:/Tools/doctest/doctest'
-    tup.frule{inputs='Tests/test_runner.cpp', command='g++ -std=gnu++17 '..TEST_INCLUDES..' %f -o %o', outputs='Tests/test_runner.exe'}
+    tup.frule{inputs='Tests/test_runner.cpp', command='g++ -O3 -std=gnu++17 '..TEST_INCLUDES..' %f -o %o', outputs='Tests/test_runner.exe'}
     tup.frule{inputs='Tests/test_runner.exe', command='%f'}
 end
\ No newline at end of file