소스 검색

Force high power mode when running belt test

vintagepc 5 년 전
부모
커밋
1384e783bf
1개의 변경된 파일9개의 추가작업 그리고 0개의 파일을 삭제
  1. 9 0
      Firmware/ultralcd.cpp

+ 9 - 0
Firmware/ultralcd.cpp

@@ -7455,6 +7455,11 @@ void lcd_belttest()
 {
     int _progress = 0;
     bool _result = true;
+    
+    #ifdef TMC2130 // Belttest requires high power mode. Enable it.
+	    FORCE_HIGH_POWER_START;
+    #endif
+    
     uint16_t   X = eeprom_read_word((uint16_t*)(EEPROM_BELTSTATUS_X));
     uint16_t   Y = eeprom_read_word((uint16_t*)(EEPROM_BELTSTATUS_Y));
     lcd_belttest_print(_i("Checking X..."), X, Y);
@@ -7482,6 +7487,10 @@ void lcd_belttest()
 
     lcd_belttest_print(_i("Done"), X, Y);
 
+    #ifdef TMC2130
+	    FORCE_HIGH_POWER_END;
+    #endif
+    
     KEEPALIVE_STATE(NOT_BUSY);
     _delay(3000);
 }