Skip to content

Commit 7ee4ead

Browse files
author
Richard Unger
committed
Merge branch 'dev' of github.com:runger1101001/Arduino-FOC into dev
2 parents ecc7f1a + 56d9c13 commit 7ee4ead

File tree

2 files changed

+7
-9
lines changed

2 files changed

+7
-9
lines changed

src/common/base_classes/CurrentSense.cpp

Lines changed: 4 additions & 4 deletions
Original file line numberDiff line numberDiff line change
@@ -16,12 +16,12 @@ float CurrentSense::getDCCurrent(float motor_electrical_angle){
1616
// if only two measured currents
1717
i_alpha = current.a;
1818
i_beta = _1_SQRT3 * current.a + _2_SQRT3 * current.b;
19-
}if(!current.a){
19+
}else if(!current.a){
2020
// if only two measured currents
2121
float a = -current.c - current.b;
2222
i_alpha = a;
2323
i_beta = _1_SQRT3 * a + _2_SQRT3 * current.b;
24-
}if(!current.b){
24+
}else if(!current.b){
2525
// if only two measured currents
2626
float b = -current.a - current.c;
2727
i_alpha = current.a;
@@ -62,12 +62,12 @@ DQCurrent_s CurrentSense::getFOCCurrents(float angle_el){
6262
// if only two measured currents
6363
i_alpha = current.a;
6464
i_beta = _1_SQRT3 * current.a + _2_SQRT3 * current.b;
65-
}if(!current.a){
65+
}else if(!current.a){
6666
// if only two measured currents
6767
float a = -current.c - current.b;
6868
i_alpha = a;
6969
i_beta = _1_SQRT3 * a + _2_SQRT3 * current.b;
70-
}if(!current.b){
70+
}else if(!current.b){
7171
// if only two measured currents
7272
float b = -current.a - current.c;
7373
i_alpha = current.a;

src/current_sense/hardware_specific/esp32/esp32_adc_driver.cpp

Lines changed: 3 additions & 5 deletions
Original file line numberDiff line numberDiff line change
@@ -154,9 +154,8 @@ bool IRAM_ATTR __adcStart(uint8_t pin){
154154
}
155155

156156
if(channel > 9){
157-
channel -= 10;
158157
CLEAR_PERI_REG_MASK(SENS_SAR_MEAS_START2_REG, SENS_MEAS2_START_SAR_M);
159-
SET_PERI_REG_BITS(SENS_SAR_MEAS_START2_REG, SENS_SAR2_EN_PAD, (1 << channel), SENS_SAR2_EN_PAD_S);
158+
SET_PERI_REG_BITS(SENS_SAR_MEAS_START2_REG, SENS_SAR2_EN_PAD, (1 << (channel - 10)), SENS_SAR2_EN_PAD_S);
160159
SET_PERI_REG_MASK(SENS_SAR_MEAS_START2_REG, SENS_MEAS2_START_SAR_M);
161160
} else {
162161
CLEAR_PERI_REG_MASK(SENS_SAR_MEAS_START1_REG, SENS_MEAS1_START_SAR_M);
@@ -225,9 +224,8 @@ uint16_t IRAM_ATTR adcRead(uint8_t pin)
225224
__analogInit();
226225

227226
if(channel > 9){
228-
channel -= 10;
229227
CLEAR_PERI_REG_MASK(SENS_SAR_MEAS_START2_REG, SENS_MEAS2_START_SAR_M);
230-
SET_PERI_REG_BITS(SENS_SAR_MEAS_START2_REG, SENS_SAR2_EN_PAD, (1 << channel), SENS_SAR2_EN_PAD_S);
228+
SET_PERI_REG_BITS(SENS_SAR_MEAS_START2_REG, SENS_SAR2_EN_PAD, (1 << (channel - 10)), SENS_SAR2_EN_PAD_S);
231229
SET_PERI_REG_MASK(SENS_SAR_MEAS_START2_REG, SENS_MEAS2_START_SAR_M);
232230
} else {
233231
CLEAR_PERI_REG_MASK(SENS_SAR_MEAS_START1_REG, SENS_MEAS1_START_SAR_M);
@@ -257,4 +255,4 @@ uint16_t IRAM_ATTR adcRead(uint8_t pin)
257255
}
258256

259257

260-
#endif
258+
#endif

0 commit comments

Comments
 (0)