Merge pull request #2 from Mepherotus/patch-1

Update the angle calculation, the 0x4 register starts with 2 empty bits

src/MT6701.cpp

@@ -181,7 +181,7 @@ int MT6701::readCount()
     int angle_h = Wire.read();
     int angle_l = Wire.read();
 
-    return (angle_h << 6) | angle_l; // returns value from 0 to 16383
+    return (angle_h << 6) | (angle_l >> 2); // returns value from 0 to 16383
 }
 
 void MT6701::updateTask(void *pvParameters)