also add a check to prevent negative angles

Richard Unger · Richard Unger · commit 1ad63d1e6fd2 · 2023-03-17T23:23:00.000+01:00
diff --git a/src/sensors/MagneticSensorPWM.cpp b/src/sensors/MagneticSensorPWM.cpp
@@ -63,6 +63,7 @@ float MagneticSensorPWM::getSensorAngle(){
     // raw data from sensor
     raw_count = getRawCount();
     if (raw_count > max_raw_count) raw_count = max_raw_count;
+    if (raw_count < min_raw_count) raw_count = min_raw_count;
     return( (float) (raw_count - min_raw_count) / (float)cpr) * _2PI;
 }
 

Original file line number	Diff line number	Diff line change
`@@ -63,6 +63,7 @@ float MagneticSensorPWM::getSensorAngle(){`
`63`	`63`	`// raw data from sensor`
`64`	`64`	`raw_count = getRawCount();`
`65`	`65`	`if (raw_count > max_raw_count) raw_count = max_raw_count;`
	`66`	`+ if (raw_count < min_raw_count) raw_count = min_raw_count;`
`66`	`67`	`return( (float) (raw_count - min_raw_count) / (float)cpr) * _2PI;`
`67`	`68`	`}`
`68`	`69`