parent
e469929c1c
commit
7e8ad83e25
|
|
@ -25,8 +25,15 @@ void MovableBase::PlanHome() {
|
||||||
|
|
||||||
void MovableBase::SetCurrents(uint8_t iRun, uint8_t iHold) {
|
void MovableBase::SetCurrents(uint8_t iRun, uint8_t iHold) {
|
||||||
hal::tmc2130::MotorCurrents tempCurrent = mm::axisParams[axis].currents;
|
hal::tmc2130::MotorCurrents tempCurrent = mm::axisParams[axis].currents;
|
||||||
|
if (iRun < 32) {
|
||||||
|
tempCurrent.vSense = 1;
|
||||||
tempCurrent.iRun = iRun;
|
tempCurrent.iRun = iRun;
|
||||||
tempCurrent.iHold = iHold;
|
tempCurrent.iHold = iHold;
|
||||||
|
} else {
|
||||||
|
tempCurrent.vSense = 0;
|
||||||
|
tempCurrent.iRun = iRun >> 1;
|
||||||
|
tempCurrent.iHold = iHold >> 1;
|
||||||
|
}
|
||||||
mm::motion.DriverForAxis(axis).SetCurrents(mm::axisParams[axis].params, tempCurrent);
|
mm::motion.DriverForAxis(axis).SetCurrents(mm::axisParams[axis].params, tempCurrent);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue