整理phase_current_sample

Signed-off-by: huhui <huhui@sharkgulf.com>

Applications/foc/phase_current.c

@@ -57,35 +57,28 @@ void phase_current_offset(current_samp_t *cs) {
 }
 
 void phase_current_sample(current_samp_t *cs){
-		u32 phase_current1, phase_current2;
-
-		adc_phase_current_read(cs->sector, &phase_current1, &phase_current2);
-		if (cs->sector == SECTOR_1 || cs->sector == SECTOR_2) {
-			/* Current on Phase C is not accessible */
-			/* Ia = PhaseAOffset - ADC converted value) */
-			cs->Ib = current_i(MOSds_VOL((int)phase_current1 - (int)cs->adc_offset_b), cs->Rds_b);
-			cs->Ia = current_i(MOSds_VOL((int)phase_current2 - (int)cs->adc_offset_a), cs->Rds_a);
-			cs->Ic = -(cs->Ia + cs->Ib);
-		}else if (cs->sector == SECTOR_3 || cs->sector == SECTOR_4) {
-			/* Current on Phase A is not accessible 	*/
-			/* Ib = PhaseBOffset - ADC converted value) */
-			cs->Ic = current_i(MOSds_VOL((int)phase_current1 - (int)cs->adc_offset_c), cs->Rds_c);
-			cs->Ib = current_i(MOSds_VOL((int)phase_current2 - (int)cs->adc_offset_b), cs->Rds_b);
-			cs->Ia = -(cs->Ib + cs->Ic);		
-		}else if (cs->sector == SECTOR_5 || cs->sector == SECTOR_6) {
-			/* Current on Phase B is not accessible 	*/
-			/* Ia = PhaseAOffset - ADC converted value) */
-			cs->Ia = current_i(MOSds_VOL((int)phase_current1 - (int)cs->adc_offset_a), cs->Rds_a);
-			cs->Ic = current_i(MOSds_VOL((int)phase_current2 - (int)cs->adc_offset_c), cs->Rds_c);
-			cs->Ib = -(cs->Ia + cs->Ic);
-		}
-#if 0
-		static int tet_p = 0;
-		if (tet_p++ % 5 == 0) {
-			printf("$%d %d %d;", (int)(cs->Ia * 1000), (int)(cs->Ib*1000), (int)(cs->Ic*1000));
-		}
-#endif	
+	u32 phase_current1, phase_current2;
 
+	adc_phase_current_read(cs->sector, &phase_current1, &phase_current2);
+	if (cs->sector == SECTOR_1 || cs->sector == SECTOR_2) {
+		/* Current on Phase C is not accessible */
+		/* Ia = PhaseAOffset - ADC converted value) */
+		cs->Ib = current_i(MOSds_VOL((int)phase_current1 - (int)cs->adc_offset_b), cs->Rds_b);
+		cs->Ia = current_i(MOSds_VOL((int)phase_current2 - (int)cs->adc_offset_a), cs->Rds_a);
+		cs->Ic = -(cs->Ia + cs->Ib);
+	}else if (cs->sector == SECTOR_3 || cs->sector == SECTOR_4) {
+		/* Current on Phase A is not accessible 	*/
+		/* Ib = PhaseBOffset - ADC converted value) */
+		cs->Ic = current_i(MOSds_VOL((int)phase_current1 - (int)cs->adc_offset_c), cs->Rds_c);
+		cs->Ib = current_i(MOSds_VOL((int)phase_current2 - (int)cs->adc_offset_b), cs->Rds_b);
+		cs->Ia = -(cs->Ib + cs->Ic);
+	}else if (cs->sector == SECTOR_5 || cs->sector == SECTOR_6) {
+		/* Current on Phase B is not accessible 	*/
+		/* Ia = PhaseAOffset - ADC converted value) */
+		cs->Ia = current_i(MOSds_VOL((int)phase_current1 - (int)cs->adc_offset_a), cs->Rds_a);
+		cs->Ic = current_i(MOSds_VOL((int)phase_current2 - (int)cs->adc_offset_c), cs->Rds_c);
+		cs->Ib = -(cs->Ia + cs->Ic);
+	}
 }
 
 /* 校准mos的 drain-source 内阻 */