🎨 MKS Hardware Test followup (#22414)
Co-authored-by: Scott Lahteine <thinkyhead@users.noreply.github.com>
This commit is contained in:
ellensp
GitHub
@@ -38,12 +38,44 @@
|
||||
#if ENABLED(MKS_TEST)
|
||||
|
||||
#include "mks_hardware.h"
|
||||
#include "../../../module/endstops.h"
|
||||
|
||||
bool pw_det_sta, pw_off_sta, mt_det_sta;
|
||||
#if PIN_EXISTS(MT_DET_2)
|
||||
bool mt_det2_sta;
|
||||
#endif
|
||||
bool endstopx1_sta, endstopx2_sta, endstopy1_sta, endstopy2_sta, endstopz1_sta, endstopz2_sta;
|
||||
#if HAS_X_MIN || HAS_X_MAX
|
||||
bool endstopx1_sta;
|
||||
#else
|
||||
constexpr static bool endstopx1_sta = true;
|
||||
#endif
|
||||
#if HAS_X2_MIN || HAS_X2_MAX
|
||||
bool endstopx2_sta;
|
||||
#else
|
||||
constexpr static bool endstopx2_sta = true;
|
||||
#endif
|
||||
#if HAS_Y_MIN || HAS_Y_MAX
|
||||
bool endstopy1_sta;
|
||||
#else
|
||||
constexpr static bool endstopy1_sta = true;
|
||||
#endif
|
||||
#if HAS_Y2_MIN || HAS_Y2_MAX
|
||||
bool endstopy2_sta;
|
||||
#else
|
||||
constexpr static bool endstopy2_sta = true;
|
||||
#endif
|
||||
#if HAS_Z_MIN || HAS_Z_MAX
|
||||
bool endstopz1_sta;
|
||||
#else
|
||||
constexpr static bool endstopz1_sta = true;
|
||||
#endif
|
||||
#if HAS_Z2_MIN || HAS_Z2_MAX
|
||||
bool endstopz2_sta;
|
||||
#else
|
||||
constexpr static bool endstopz2_sta = true;
|
||||
#endif
|
||||
|
||||
#define ESTATE(S) (READ(S##_PIN) != S##_ENDSTOP_INVERTING)
|
||||
|
||||
void test_gpio_readlevel_L() {
|
||||
WRITE(WIFI_IO0_PIN, HIGH);
|
||||
@@ -54,10 +86,36 @@
|
||||
#if PIN_EXISTS(MT_DET_2)
|
||||
mt_det2_sta = (READ(MT_DET_2_PIN) == LOW);
|
||||
#endif
|
||||
endstopx1_sta = (READ(X_MIN_PIN) == LOW);
|
||||
endstopy1_sta = (READ(Y_MIN_PIN) == LOW);
|
||||
endstopz1_sta = (READ(Z_MIN_PIN) == LOW);
|
||||
endstopz2_sta = (READ(Z_MAX_PIN) == LOW);
|
||||
#if HAS_X_MIN
|
||||
endstopx1_sta = ESTATE(X_MIN);
|
||||
#elif HAS_X_MAX
|
||||
endstopx1_sta = ESTATE(X_MAX);
|
||||
#endif
|
||||
#if HAS_X2_MIN
|
||||
endstopx2_sta = ESTATE(X2_MIN);
|
||||
#elif HAS_X2_MAX
|
||||
endstopx2_sta = ESTATE(X2_MAX);
|
||||
#endif
|
||||
#if HAS_Y_MIN
|
||||
endstopy1_sta = ESTATE(Y_MIN);
|
||||
#elif HAS_Y_MAX
|
||||
endstopy1_sta = ESTATE(Y_MAX);
|
||||
#endif
|
||||
#if HAS_Y2_MIN
|
||||
endstopy2_sta = ESTATE(Y2_MIN);
|
||||
#elif HAS_Y2_MAX
|
||||
endstopy2_sta = ESTATE(Y2_MAX);
|
||||
#endif
|
||||
#if HAS_Z_MIN
|
||||
endstopz1_sta = ESTATE(Z_MIN);
|
||||
#elif HAS_Z_MAX
|
||||
endstopz1_sta = ESTATE(Z_MAX);
|
||||
#endif
|
||||
#if HAS_Z2_MIN
|
||||
endstopz2_sta = ESTATE(Z2_MIN);
|
||||
#elif HAS_Z2_MAX
|
||||
endstopz2_sta = ESTATE(Z2_MAX);
|
||||
#endif
|
||||
}
|
||||
|
||||
void test_gpio_readlevel_H() {
|
||||
@@ -69,44 +127,66 @@
|
||||
#if PIN_EXISTS(MT_DET_2)
|
||||
mt_det2_sta = (READ(MT_DET_2_PIN) == HIGH);
|
||||
#endif
|
||||
endstopx1_sta = (READ(X_MIN_PIN) == HIGH);
|
||||
endstopy1_sta = (READ(Y_MIN_PIN) == HIGH);
|
||||
endstopz1_sta = (READ(Z_MIN_PIN) == HIGH);
|
||||
endstopz2_sta = (READ(Z_MAX_PIN) == HIGH);
|
||||
#if HAS_X_MIN
|
||||
endstopx1_sta = !ESTATE(X_MIN);
|
||||
#elif HAS_X_MAX
|
||||
endstopx1_sta = !ESTATE(X_MAX);
|
||||
#endif
|
||||
#if HAS_X2_MIN
|
||||
endstopx2_sta = !ESTATE(X2_MIN);
|
||||
#elif HAS_X2_MAX
|
||||
endstopx2_sta = !ESTATE(X2_MAX);
|
||||
#endif
|
||||
#if HAS_Y_MIN
|
||||
endstopy1_sta = !ESTATE(Y_MIN);
|
||||
#elif HAS_Y_MAX
|
||||
endstopy1_sta = !ESTATE(Y_MAX);
|
||||
#endif
|
||||
#if HAS_Y2_MIN
|
||||
endstopy2_sta = !ESTATE(Y2_MIN);
|
||||
#elif HAS_Y2_MAX
|
||||
endstopy2_sta = !ESTATE(Y2_MAX);
|
||||
#endif
|
||||
#if HAS_Z_MIN
|
||||
endstopz1_sta = !ESTATE(Z_MIN);
|
||||
#elif HAS_Z_MAX
|
||||
endstopz1_sta = !ESTATE(Z_MAX);
|
||||
#endif
|
||||
#if HAS_Z2_MIN
|
||||
endstopz2_sta = !ESTATE(Z2_MIN);
|
||||
#elif HAS_Z2_MAX
|
||||
endstopz2_sta = !ESTATE(Z2_MAX);
|
||||
#endif
|
||||
}
|
||||
|
||||
void init_test_gpio() {
|
||||
SET_INPUT_PULLUP(X_MIN_PIN);
|
||||
SET_INPUT_PULLUP(Y_MIN_PIN);
|
||||
SET_INPUT_PULLUP(Z_MIN_PIN);
|
||||
SET_INPUT_PULLUP(Z_MAX_PIN);
|
||||
endstops.init();
|
||||
|
||||
SET_OUTPUT(WIFI_IO0_PIN);
|
||||
|
||||
SET_INPUT_PULLUP(MT_DET_1_PIN);
|
||||
#if PIN_EXISTS(MT_DET_1)
|
||||
SET_INPUT_PULLUP(MT_DET_1_PIN);
|
||||
#endif
|
||||
#if PIN_EXISTS(MT_DET_2)
|
||||
SET_INPUT_PULLUP(MT_DET_2_PIN);
|
||||
#endif
|
||||
|
||||
SET_INPUT_PULLUP(MKS_TEST_POWER_LOSS_PIN);
|
||||
SET_INPUT_PULLUP(MKS_TEST_PS_ON_PIN);
|
||||
|
||||
SET_INPUT_PULLUP(SERVO0_PIN);
|
||||
|
||||
SET_OUTPUT(X_ENABLE_PIN);
|
||||
SET_OUTPUT(Y_ENABLE_PIN);
|
||||
SET_OUTPUT(Z_ENABLE_PIN);
|
||||
SET_OUTPUT(E0_ENABLE_PIN);
|
||||
#if DISABLED(MKS_HARDWARE_TEST_ONLY_E0)
|
||||
SET_OUTPUT(E1_ENABLE_PIN);
|
||||
OUT_WRITE(X_ENABLE_PIN, LOW);
|
||||
#if HAS_Y_AXIS
|
||||
OUT_WRITE(Y_ENABLE_PIN, LOW);
|
||||
#endif
|
||||
|
||||
WRITE(X_ENABLE_PIN, LOW);
|
||||
WRITE(Y_ENABLE_PIN, LOW);
|
||||
WRITE(Z_ENABLE_PIN, LOW);
|
||||
WRITE(E0_ENABLE_PIN, LOW);
|
||||
#if DISABLED(MKS_HARDWARE_TEST_ONLY_E0)
|
||||
WRITE(E1_ENABLE_PIN, LOW);
|
||||
#if HAS_Z_AXIS
|
||||
OUT_WRITE(Z_ENABLE_PIN, LOW);
|
||||
#endif
|
||||
#if HAS_EXTRUDERS
|
||||
OUT_WRITE(E0_ENABLE_PIN, LOW);
|
||||
#endif
|
||||
#if HAS_MULTI_EXTRUDER && DISABLED(MKS_HARDWARE_TEST_ONLY_E0)
|
||||
OUT_WRITE(E1_ENABLE_PIN, LOW);
|
||||
#endif
|
||||
|
||||
#if ENABLED(MKS_HARDWARE_TEST_ONLY_E0)
|
||||
@@ -161,34 +241,54 @@
|
||||
|
||||
void mks_hardware_test() {
|
||||
if (millis() % 2000 < 1000) {
|
||||
thermalManager.fan_speed[0] = 255;
|
||||
WRITE(X_DIR_PIN, LOW);
|
||||
WRITE(Y_DIR_PIN, LOW);
|
||||
WRITE(Z_DIR_PIN, LOW);
|
||||
WRITE(E0_DIR_PIN, LOW);
|
||||
#if DISABLED(MKS_HARDWARE_TEST_ONLY_E0)
|
||||
#if HAS_Y_AXIS
|
||||
WRITE(Y_DIR_PIN, LOW);
|
||||
#endif
|
||||
#if HAS_Z_AXIS
|
||||
WRITE(Z_DIR_PIN, LOW);
|
||||
#endif
|
||||
#if HAS_EXTRUDERS
|
||||
WRITE(E0_DIR_PIN, LOW);
|
||||
#endif
|
||||
#if HAS_MULTI_EXTRUDER && DISABLED(MKS_HARDWARE_TEST_ONLY_E0)
|
||||
WRITE(E1_DIR_PIN, LOW);
|
||||
#endif
|
||||
thermalManager.fan_speed[0] = 255;
|
||||
#if DISABLED(MKS_HARDWARE_TEST_ONLY_E0)
|
||||
#if HAS_MULTI_HOTEND && DISABLED(MKS_HARDWARE_TEST_ONLY_E0)
|
||||
WRITE(HEATER_1_PIN, HIGH); // HE1
|
||||
#endif
|
||||
WRITE(HEATER_0_PIN, HIGH); // HE0
|
||||
WRITE(HEATER_BED_PIN, HIGH); // HOT-BED
|
||||
#if HAS_HOTEND
|
||||
WRITE(HEATER_0_PIN, HIGH); // HE0
|
||||
#endif
|
||||
#if HAS_HEATED_BED
|
||||
WRITE(HEATER_BED_PIN, HIGH); // HOT-BED
|
||||
#endif
|
||||
}
|
||||
else {
|
||||
thermalManager.fan_speed[0] = 0;
|
||||
WRITE(X_DIR_PIN, HIGH);
|
||||
WRITE(Y_DIR_PIN, HIGH);
|
||||
WRITE(Z_DIR_PIN, HIGH);
|
||||
WRITE(E0_DIR_PIN, HIGH);
|
||||
#if DISABLED(MKS_HARDWARE_TEST_ONLY_E0)
|
||||
#if HAS_Y_AXIS
|
||||
WRITE(Y_DIR_PIN, HIGH);
|
||||
#endif
|
||||
#if HAS_Y_AXIS
|
||||
WRITE(Z_DIR_PIN, HIGH);
|
||||
#endif
|
||||
#if HAS_EXTRUDERS
|
||||
WRITE(E0_DIR_PIN, HIGH);
|
||||
#endif
|
||||
#if HAS_MULTI_EXTRUDER && DISABLED(MKS_HARDWARE_TEST_ONLY_E0)
|
||||
WRITE(E1_DIR_PIN, HIGH);
|
||||
#endif
|
||||
thermalManager.fan_speed[0] = 0;
|
||||
#if DISABLED(MKS_HARDWARE_TEST_ONLY_E0)
|
||||
#if HAS_MULTI_HOTEND && DISABLED(MKS_HARDWARE_TEST_ONLY_E0)
|
||||
WRITE(HEATER_1_PIN, LOW); // HE1
|
||||
#endif
|
||||
WRITE(HEATER_0_PIN, LOW); // HE0
|
||||
WRITE(HEATER_BED_PIN, LOW); // HOT-BED
|
||||
#if HAS_HOTEND
|
||||
WRITE(HEATER_0_PIN, LOW); // HE0
|
||||
#endif
|
||||
#if HAS_HEATED_BED
|
||||
WRITE(HEATER_BED_PIN, LOW); // HOT-BED
|
||||
#endif
|
||||
}
|
||||
|
||||
if (endstopx1_sta && endstopx2_sta && endstopy1_sta && endstopy2_sta && endstopz1_sta && endstopz2_sta) {
|
||||
|
||||
Reference in New Issue
Block a user