Merge pull request #526 from austin-bowen/dev

MagneticSensorAnalog: Fix angle calculation

Author: runger1101001

src/sensors/MagneticSensorAnalog.cpp

@@ -9,7 +9,7 @@ MagneticSensorAnalog::MagneticSensorAnalog(uint8_t _pinAnalog, int _min_raw_coun
 
   pinAnalog = _pinAnalog;
 
-  cpr = _max_raw_count - _min_raw_count;
+  cpr = _max_raw_count - _min_raw_count + 1;
   min_raw_count = _min_raw_count;
   max_raw_count = _max_raw_count;
 
@@ -33,7 +33,7 @@ void MagneticSensorAnalog::init(){
 float MagneticSensorAnalog::getSensorAngle(){
   // raw data from the sensor
   raw_count = getRawCount();   
-  return ( (float) (raw_count) / (float)cpr) * _2PI;
+  return ( (float) (raw_count - min_raw_count) / (float)cpr) * _2PI;
 }
 
 // function reading the raw counter of the magnetic sensor