@@ -392,12 +392,11 @@ int CurrentSense::alignBLDCDriver(float voltage, BLDCDriver* bldc_driver, bool m
392
392
// 3 - success but gains inverted
393
393
// 4 - success but pins reconfigured and gains inverted
394
394
int CurrentSense::alignStepperDriver (float voltage, StepperDriver* stepper_driver, bool modulation_centered){
395
-
395
+
396
+ _UNUSED (modulation_centered);
397
+
396
398
bool phases_switched = 0 ;
397
399
bool phases_inverted = 0 ;
398
-
399
- float zero = 0 ;
400
- if (modulation_centered) zero = driver->voltage_limit /2.0 ;
401
400
402
401
if (!_isset (pinA) || !_isset (pinB)){
403
402
SIMPLEFOC_DEBUG (" CS: Pins A & B not specified!" );
@@ -407,13 +406,13 @@ int CurrentSense::alignStepperDriver(float voltage, StepperDriver* stepper_drive
407
406
// set phase A active and phases B down
408
407
// ramp 300ms
409
408
for (int i=0 ; i < 100 ; i++){
410
- stepper_driver->setPwm (voltage/100.0 *((float )i), zero );
409
+ stepper_driver->setPwm (voltage/100.0 *((float )i), 0 );
411
410
_delay (3 );
412
411
}
413
412
_delay (500 );
414
413
PhaseCurrent_s c = readAverageCurrents ();
415
414
// disable the phases
416
- stepper_driver->setPwm (zero, zero );
415
+ stepper_driver->setPwm (0 , 0 );
417
416
if (fabs (c.a ) < 0 .1f && fabs (c.b ) < 0 .1f ){
418
417
SIMPLEFOC_DEBUG (" CS: Err too low current!" );
419
418
return 0 ; // measurement current too low
@@ -442,12 +441,12 @@ int CurrentSense::alignStepperDriver(float voltage, StepperDriver* stepper_drive
442
441
// set phase B active and phases A down
443
442
// ramp 300ms
444
443
for (int i=0 ; i < 100 ; i++){
445
- stepper_driver->setPwm (zero , voltage/100.0 *((float )i)+zero );
444
+ stepper_driver->setPwm (0 , voltage/100.0 *((float )i));
446
445
_delay (3 );
447
446
}
448
447
_delay (500 );
449
448
c = readAverageCurrents ();
450
- stepper_driver->setPwm (zero, zero );
449
+ stepper_driver->setPwm (0 , 0 );
451
450
452
451
// phase B should be aligned
453
452
// 1) we just need to verify that it has been measured
0 commit comments