@@ -392,12 +392,11 @@ int CurrentSense::alignBLDCDriver(float voltage, BLDCDriver* bldc_driver, bool m
392392// 3 - success but gains inverted
393393// 4 - success but pins reconfigured and gains inverted
394394int CurrentSense::alignStepperDriver (float voltage, StepperDriver* stepper_driver, bool modulation_centered){
395-
395+
396+ _UNUSED (modulation_centered);
397+
396398 bool phases_switched = 0 ;
397399 bool phases_inverted = 0 ;
398-
399- float zero = 0 ;
400- if (modulation_centered) zero = driver->voltage_limit /2.0 ;
401400
402401 if (!_isset (pinA) || !_isset (pinB)){
403402 SIMPLEFOC_DEBUG (" CS: Pins A & B not specified!" );
@@ -407,13 +406,13 @@ int CurrentSense::alignStepperDriver(float voltage, StepperDriver* stepper_drive
407406 // set phase A active and phases B down
408407 // ramp 300ms
409408 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 );
411410 _delay (3 );
412411 }
413412 _delay (500 );
414413 PhaseCurrent_s c = readAverageCurrents ();
415414 // disable the phases
416- stepper_driver->setPwm (zero, zero );
415+ stepper_driver->setPwm (0 , 0 );
417416 if (fabs (c.a ) < 0 .1f && fabs (c.b ) < 0 .1f ){
418417 SIMPLEFOC_DEBUG (" CS: Err too low current!" );
419418 return 0 ; // measurement current too low
@@ -442,12 +441,12 @@ int CurrentSense::alignStepperDriver(float voltage, StepperDriver* stepper_drive
442441 // set phase B active and phases A down
443442 // ramp 300ms
444443 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));
446445 _delay (3 );
447446 }
448447 _delay (500 );
449448 c = readAverageCurrents ();
450- stepper_driver->setPwm (zero, zero );
449+ stepper_driver->setPwm (0 , 0 );
451450
452451 // phase B should be aligned
453452 // 1) we just need to verify that it has been measured
0 commit comments