Test the set param mode
Diff: PositionSensor/PositionSensor.cpp
- Revision:
- 23:2adf23ee0305
- Parent:
- 22:60276ba87ac6
- Child:
- 25:f5741040c4bb
--- a/PositionSensor/PositionSensor.cpp Fri Mar 31 18:24:46 2017 +0000 +++ b/PositionSensor/PositionSensor.cpp Wed Apr 05 20:54:16 2017 +0000 @@ -43,6 +43,7 @@ MechPosition = position - MechOffset; float elec = ((6.28318530718f/(float)_CPR) * (float) ((_ppairs*angle)%_CPR)) - ElecOffset; if(elec < 0) elec += 6.28318530718f; + else if(elec > 6.28318530718f) elec -= 6.28318530718f ; ElecPosition = elec; float vel;