mirror/Grbl_Esp32
1
0
Fork 0
mirror of https://github.com/bdring/Grbl_Esp32.git synced 2025-08-15 11:04:16 +02:00
Code Issues Releases Wiki Activity

Update TrinamicDriver.cpp

Browse Source
This commit is contained in:
bdring
2022-01-02 13:44:19 -06:00
parent 7d649cb0c9
commit 4d6bd3492d
1 changed files with 12 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

15
Grbl_Esp32/src/Motors/TrinamicDriver.cpp
View File

@@ -376,16 +376,25 @@ namespace Motors {
digitalWrite(_disable_pin, _disabled);
uint8_t _toff_value = 0;
#ifdef USE_TRINAMIC_ENABLE
if (_disabled) {
tmcstepper->toff(TRINAMIC_TOFF_DISABLE);
_toff_value = TRINAMIC_TOFF_DISABLE;
} else {
if (_mode == TrinamicMode::StealthChop) {
tmcstepper->toff(TRINAMIC_TOFF_STEALTHCHOP);
_toff_value = TRINAMIC_TOFF_STEALTHCHOP;
} else {
tmcstepper->toff(TRINAMIC_TOFF_COOLSTEP);
_toff_value = TRINAMIC_TOFF_COOLSTEP;
}
}
if (tmc2130) {
tmc2130->toff(_toff_value);
} else {
tmc5160->toff(_toff_value);
}
#endif
// the pin based enable could be added here.
// This would be for individual motors, not the single pin for all motors.