Pārlūkot izejas kodu

MC105 V4 电流采集正确

Signed-off-by: huhui <huhui@sharkgulf.com>
huhui 3 gadi atpakaļ
vecāks
revīzija
f8cf5d0e01
1 mainītis faili ar 8 papildinājumiem un 6 dzēšanām
  1. 8 6
      Applications/foc/motor/current_ics.c

+ 8 - 6
Applications/foc/motor/current_ics.c

@@ -143,22 +143,24 @@ void phase_current_get(float *iABC){
 	cs->adc_ic = (phase_current2 - cs->adc_offset_c);
 #if (CONFIG_HW_VERSION==3)
 #ifdef CONFIG_PWM_UV_SWAP
-	iABC[1] = -cs->adc_ib * ADC_TO_CURR_ceof1;
 	if (gpio_board_id() == BOARD_105_VERSION_3) {
+		iABC[1] = -cs->adc_ib * ADC_TO_CURR_ceof1;
 		iABC[0] = -cs->adc_ic * ADC_TO_CURR_ceof2;
 		iABC[2] = -(iABC[1] + iABC[0]);
 	}else {
-		iABC[2] = -cs->adc_ic * ADC_TO_CURR_ceof2;
-		iABC[0] = -(iABC[1] + iABC[2]);
+		iABC[2] = -cs->adc_ib * ADC_TO_CURR_ceof1;
+		iABC[0] = -cs->adc_ic * ADC_TO_CURR_ceof2;
+		iABC[1] = -(iABC[0] + iABC[2]);
 	}
 #else
-	iABC[1] = -cs->adc_ib * ADC_TO_CURR_ceof1;
 	if (gpio_board_id() == BOARD_105_VERSION_3) {
+		iABC[1] = -cs->adc_ib * ADC_TO_CURR_ceof1;
 		iABC[2] = -cs->adc_ic * ADC_TO_CURR_ceof2;
 		iABC[0] = -(iABC[1] + iABC[2]);
 	}else {
-		iABC[0] = -cs->adc_ic * ADC_TO_CURR_ceof2;
-		iABC[2] = -(iABC[1] + iABC[0]);
+		iABC[0] = -cs->adc_ib * ADC_TO_CURR_ceof1;
+		iABC[2] = -cs->adc_ic * ADC_TO_CURR_ceof2;
+		iABC[1] = -(iABC[0] + iABC[2]);
 	}
 #endif
 #else