Index: firmware/App/Controllers/BloodFlow.c =================================================================== diff -u -r29e57b5232f605a871c62580e16a7db297aae992 -r0d8381c50f7189c4cfbc2794a4aedf297eea7d15 --- firmware/App/Controllers/BloodFlow.c (.../BloodFlow.c) (revision 29e57b5232f605a871c62580e16a7db297aae992) +++ firmware/App/Controllers/BloodFlow.c (.../BloodFlow.c) (revision 0d8381c50f7189c4cfbc2794a4aedf297eea7d15) @@ -907,9 +907,9 @@ { U16 bpMotorHallSensorCount = getFPGABloodPumpHallSensorCount(); U32 nextIdx = INC_WRAP( bpMotorSpeedCalcIdx, 0, BP_SPEED_CALC_BUFFER__LEN - 1 ); - U16 incDelta = ( bpMotorHallSensorCount >= bpLastMotorHallSensorCounts[ bpMotorSpeedCalcIdx ] ? \ - bpMotorHallSensorCount - bpLastMotorHallSensorCounts[ bpMotorSpeedCalcIdx ] : \ - ( HEX_64_K - bpLastMotorHallSensorCounts[ bpMotorSpeedCalcIdx ] ) + bpMotorHallSensorCount ); + U16 incDelta = ( bpMotorHallSensorCount >= bpLastMotorHallSensorCounts[ nextIdx ] ? \ + bpMotorHallSensorCount - bpLastMotorHallSensorCounts[ nextIdx ] : \ + ( HEX_64_K - bpLastMotorHallSensorCounts[ nextIdx ] ) + bpMotorHallSensorCount ); U16 decDelta = HEX_64_K - incDelta; U16 delta;