diff --git a/Firmware/tmc2130.cpp b/Firmware/tmc2130.cpp index 30f4724bc..05340622d 100755 --- a/Firmware/tmc2130.cpp +++ b/Firmware/tmc2130.cpp @@ -580,10 +580,10 @@ void tmc2130_setup_chopper(uint8_t axis, uint8_t mres, const MotorCurrents *curr void tmc2130_print_currents() { printf_P(_n("tmc2130_print_currents()\n\tH\tR\nX\t%d\t%d\nY\t%d\t%d\nZ\t%d\t%d\nE\t%d\t%d\n"), - currents[0].getiHold(), currents[0].getiRun(), - currents[1].getiHold(), currents[1].getiRun(), - currents[2].getiHold(), currents[2].getiRun(), - currents[3].getiHold(), currents[3].getiRun() + currents[0].getOriginaliHold(), currents[0].getOriginaliRun(), + currents[1].getOriginaliHold(), currents[1].getOriginaliRun(), + currents[2].getOriginaliHold(), currents[2].getOriginaliRun(), + currents[3].getOriginaliHold(), currents[3].getOriginaliRun() ); } diff --git a/Firmware/tmc2130.h b/Firmware/tmc2130.h index 6cf48f04e..6c1308113 100644 --- a/Firmware/tmc2130.h +++ b/Firmware/tmc2130.h @@ -105,6 +105,8 @@ struct MotorCurrents { inline uint8_t getiRun() const { return iRun; } inline uint8_t getiHold() const { return min(iHold, iRun); } + inline uint8_t getOriginaliRun() const { return vSense ? iRun : iRun << 1; } + inline uint8_t getOriginaliHold() const { return min(vSense ? iHold : iHold << 1, getOriginaliRun()); } inline bool iHoldIsClamped() const { return iHold > iRun; } inline uint8_t getvSense() const { return vSense; }