forgotten offest exchange when exchanging pins in current align)

Author: askuric

src/current_sense/InlineCurrentSense.cpp

@@ -104,13 +104,19 @@ int InlineCurrentSense::driverAlign(float voltage){
             int tmp_pinA = pinA;
             pinA = pinB;
             pinB = tmp_pinA;
+            float tmp_offsetA = offset_ia;
+            offset_ia = offset_ib;
+            offset_ib = tmp_offsetA;
             gain_a *= _sign(c.b);
             exit_flag = 2; // signal that pins have been switched
         }else if(_isset(pinC) &&  ac_ratio < 0.7f ){ // should be ~0.5
             // switch phase A and C
             int tmp_pinA = pinA;
             pinA = pinC;
             pinC= tmp_pinA;
+            float tmp_offsetA = offset_ia;
+            offset_ia = offset_ic;
+            offset_ic = tmp_offsetA;
             gain_a *= _sign(c.c);
             exit_flag = 2;// signal that pins have been switched
         }else{
@@ -144,13 +150,19 @@ int InlineCurrentSense::driverAlign(float voltage){
             int tmp_pinB = pinB;
             pinB = pinA;
             pinA = tmp_pinB;
+            float tmp_offsetB = offset_ib;
+            offset_ib = offset_ia;
+            offset_ia = tmp_offsetB;
             gain_b *= _sign(c.a);
             exit_flag = 2; // signal that pins have been switched
         }else if(_isset(pinC) && bc_ratio < 0.7f ){ // should be ~0.5
             // switch phase A and C
             int tmp_pinB = pinB;
             pinB = pinC;
             pinC = tmp_pinB;
+            float tmp_offsetB = offset_ib;
+            offset_ib = offset_ic;
+            offset_ic = tmp_offsetB;
             gain_b *= _sign(c.c);
             exit_flag = 2; // signal that pins have been switched
         }else{
@@ -185,13 +197,19 @@ int InlineCurrentSense::driverAlign(float voltage){
             int tmp_pinC = pinC;
             pinC = pinA;
             pinA = tmp_pinC;
+            float tmp_offsetC = offset_ic;
+            offset_ic = offset_ia;
+            offset_ia = tmp_offsetC;
             gain_c *= _sign(c.a);
             exit_flag = 2; // signal that pins have been switched
         }else if(_isset(pinB) && cb_ratio < 0.7f ){ // should be ~0.5
             // switch phase B and C
             int tmp_pinC = pinC;
             pinC = pinB;
             pinB = tmp_pinC;
+            float tmp_offsetC = offset_ic;
+            offset_ic = offset_ib;
+            offset_ib = tmp_offsetC;
             gain_c *= _sign(c.b);
             exit_flag = 2; // signal that pins have been switched
         }else{

src/current_sense/LowsideCurrentSense.cpp

@@ -36,7 +36,7 @@ int LowsideCurrentSense::init(){
 }
 // Function finding zero offsets of the ADC
 void LowsideCurrentSense::calibrateOffsets(){    
-    const int calibration_rounds = 1000;
+    const int calibration_rounds = 2000;
 
     // find adc offset = zero current voltage
     offset_ia = 0;
@@ -105,13 +105,19 @@ int LowsideCurrentSense::driverAlign(float voltage){
             int tmp_pinA = pinA;
             pinA = pinB;
             pinB = tmp_pinA;
+            float tmp_offsetA = offset_ia;
+            offset_ia = offset_ib;
+            offset_ib = tmp_offsetA;
             gain_a *= _sign(c.b);
             exit_flag = 2; // signal that pins have been switched
         }else if(_isset(pinC) &&  ac_ratio < 0.7f ){ // should be ~0.5
             // switch phase A and C
             int tmp_pinA = pinA;
             pinA = pinC;
             pinC= tmp_pinA;
+            float tmp_offsetA = offset_ia;
+            offset_ia = offset_ic;
+            offset_ic = tmp_offsetA;
             gain_a *= _sign(c.c);
             exit_flag = 2;// signal that pins have been switched
         }else{
@@ -145,13 +151,19 @@ int LowsideCurrentSense::driverAlign(float voltage){
             int tmp_pinB = pinB;
             pinB = pinA;
             pinA = tmp_pinB;
+            float tmp_offsetB = offset_ib;
+            offset_ib = offset_ia;
+            offset_ia = tmp_offsetB;
             gain_b *= _sign(c.a);
             exit_flag = 2; // signal that pins have been switched
         }else if(_isset(pinC) && bc_ratio < 0.7f ){ // should be ~0.5
             // switch phase A and C
             int tmp_pinB = pinB;
             pinB = pinC;
             pinC = tmp_pinB;
+            float tmp_offsetB = offset_ib;
+            offset_ib = offset_ic;
+            offset_ic = tmp_offsetB;
             gain_b *= _sign(c.c);
             exit_flag = 2; // signal that pins have been switched
         }else{
@@ -186,13 +198,19 @@ int LowsideCurrentSense::driverAlign(float voltage){
             int tmp_pinC = pinC;
             pinC = pinA;
             pinA = tmp_pinC;
+            float tmp_offsetC = offset_ic;
+            offset_ic = offset_ia;
+            offset_ia = tmp_offsetC;
             gain_c *= _sign(c.a);
             exit_flag = 2; // signal that pins have been switched
         }else if(_isset(pinB) && cb_ratio < 0.7f ){ // should be ~0.5
             // switch phase B and C
             int tmp_pinC = pinC;
             pinC = pinB;
             pinB = tmp_pinC;
+            float tmp_offsetC = offset_ic;
+            offset_ic = offset_ib;
+            offset_ib = tmp_offsetC;
             gain_c *= _sign(c.b);
             exit_flag = 2; // signal that pins have been switched
         }else{