Skip to content

Commit dbc62a1

Browse files
committed
a correction for stepper
1 parent cf70cce commit dbc62a1

File tree

1 file changed

+7
-8
lines changed

1 file changed

+7
-8
lines changed

src/common/base_classes/CurrentSense.cpp

+7-8
Original file line numberDiff line numberDiff line change
@@ -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
394394
int 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

Comments
 (0)