|
|
|
|
@ -90,7 +90,7 @@
|
|
|
|
|
* M33 - Get the longname version of a path. (Requires LONG_FILENAME_HOST_SUPPORT)
|
|
|
|
|
* M34 - Set SD Card sorting options. (Requires SDCARD_SORT_ALPHA)
|
|
|
|
|
* M42 - Change pin status via gcode: M42 P<pin> S<value>. LED pin assumed if P is omitted.
|
|
|
|
|
* M43 - Monitor pins & report changes - report active pins
|
|
|
|
|
* M43 - Display pin status, watch pins for changes, watch endstops & toggle LED, Z servo probe test, toggle pins
|
|
|
|
|
* M48 - Measure Z Probe repeatability: M48 P<points> X<pos> Y<pos> V<level> E<engage> L<legs>. (Requires Z_MIN_PROBE_REPEATABILITY_TEST)
|
|
|
|
|
* M75 - Start the print job timer.
|
|
|
|
|
* M76 - Pause the print job timer.
|
|
|
|
|
@ -5308,23 +5308,176 @@ inline void gcode_M42() {
|
|
|
|
|
|
|
|
|
|
#include "pinsDebug.h"
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
inline void toggle_pins() {
|
|
|
|
|
int pin, j, start = 0, I_flag = 0, end = NUM_DIGITAL_PINS - 1, wait = 500, repeat = 1;
|
|
|
|
|
|
|
|
|
|
if (code_seen('R'))
|
|
|
|
|
repeat = code_value_int();
|
|
|
|
|
|
|
|
|
|
if (code_seen('S'))
|
|
|
|
|
start = code_value_int();
|
|
|
|
|
|
|
|
|
|
if (code_seen('E'))
|
|
|
|
|
end = code_value_int();
|
|
|
|
|
|
|
|
|
|
if (code_seen('I') )
|
|
|
|
|
I_flag++;
|
|
|
|
|
|
|
|
|
|
if (code_seen('W'))
|
|
|
|
|
wait = code_value_int();
|
|
|
|
|
|
|
|
|
|
for(pin = start; pin <= end; pin++) {
|
|
|
|
|
if ( I_flag == 0 && pin_is_protected(pin)) {
|
|
|
|
|
SERIAL_ECHOPAIR("Sensitive Pin: ", pin);
|
|
|
|
|
SERIAL_ECHOPGM(" untouched.\n");
|
|
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
SERIAL_ECHOPAIR("Pulsing Pin: ", pin);
|
|
|
|
|
pinMode(pin, OUTPUT);
|
|
|
|
|
for(j = 0; j < repeat; j++) {
|
|
|
|
|
digitalWrite(pin, 0);
|
|
|
|
|
idle();
|
|
|
|
|
delay(wait);
|
|
|
|
|
digitalWrite(pin, 1);
|
|
|
|
|
idle();
|
|
|
|
|
delay(wait);
|
|
|
|
|
digitalWrite(pin, 0);
|
|
|
|
|
idle();
|
|
|
|
|
delay(wait);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
SERIAL_ECHOPGM("\n");
|
|
|
|
|
}
|
|
|
|
|
SERIAL_ECHOPGM("Done\n");
|
|
|
|
|
return;
|
|
|
|
|
} // toggle pin(s)
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
inline void servo_probe_test(){
|
|
|
|
|
#if !(NUM_SERVOS >= 1 && HAS_SERVO_0)
|
|
|
|
|
SERIAL_ERROR_START;
|
|
|
|
|
SERIAL_ERRORLNPGM("SERVO not setup");
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
|
|
#if !defined(z_servo_angle)
|
|
|
|
|
const int z_servo_angle[2] = Z_SERVO_ANGLES;
|
|
|
|
|
#endif
|
|
|
|
|
uint8_t probe_index = code_seen('P') ? code_value_byte() : 0;
|
|
|
|
|
SERIAL_PROTOCOLLNPGM("Servo probe test");
|
|
|
|
|
SERIAL_PROTOCOLLNPAIR(". using index: ", probe_index);
|
|
|
|
|
SERIAL_PROTOCOLLNPAIR(". deploy angle: ", z_servo_angle[0]);
|
|
|
|
|
SERIAL_PROTOCOLLNPAIR(". stow angle: ", z_servo_angle[1]);
|
|
|
|
|
bool probe_inverting;
|
|
|
|
|
#if ENABLED(Z_MIN_PROBE_USES_Z_MIN_ENDSTOP_PIN)
|
|
|
|
|
#define PROBE_TEST_PIN Z_MIN_PIN
|
|
|
|
|
SERIAL_PROTOCOLLNPAIR(". probe uses Z_MIN pin: ", PROBE_TEST_PIN);
|
|
|
|
|
SERIAL_PROTOCOLLNPGM(". uses Z_MIN_ENDSTOP_INVERTING (ignores Z_MIN_PROBE_ENDSTOP_INVERTING)");
|
|
|
|
|
SERIAL_PROTOCOLPGM(". Z_MIN_ENDSTOP_INVERTING: ");
|
|
|
|
|
if (Z_MIN_ENDSTOP_INVERTING) SERIAL_PROTOCOLLNPGM("true");
|
|
|
|
|
else SERIAL_PROTOCOLLNPGM("false");
|
|
|
|
|
probe_inverting = Z_MIN_ENDSTOP_INVERTING;
|
|
|
|
|
#elif ENABLED(Z_MIN_PROBE_ENDSTOP)
|
|
|
|
|
#define PROBE_TEST_PIN Z_MIN_PROBE_PIN
|
|
|
|
|
|
|
|
|
|
SERIAL_PROTOCOLLNPAIR(". probe uses Z_MIN_PROBE_PIN: ", PROBE_TEST_PIN);
|
|
|
|
|
SERIAL_PROTOCOLLNPGM(". uses Z_MIN_PROBE_ENDSTOP_INVERTING (ignores Z_MIN_ENDSTOP_INVERTING)");
|
|
|
|
|
SERIAL_PROTOCOLPGM(". Z_MIN_PROBE_ENDSTOP_INVERTING: ");
|
|
|
|
|
if (Z_MIN_PROBE_ENDSTOP_INVERTING) SERIAL_PROTOCOLLNPGM("true");
|
|
|
|
|
else SERIAL_PROTOCOLLNPGM("false");
|
|
|
|
|
probe_inverting = Z_MIN_PROBE_ENDSTOP_INVERTING;
|
|
|
|
|
#else
|
|
|
|
|
#error "ERROR - probe pin not defined - strange, SANITY_CHECK should have caught this"
|
|
|
|
|
#endif
|
|
|
|
|
SERIAL_PROTOCOLLNPGM(". deploy & stow 4 times");
|
|
|
|
|
pinMode(PROBE_TEST_PIN, INPUT_PULLUP);
|
|
|
|
|
bool deploy_state;
|
|
|
|
|
bool stow_state;
|
|
|
|
|
for (uint8_t i = 0; i < 4; i++) {
|
|
|
|
|
servo[probe_index].move(z_servo_angle[0]); //deploy
|
|
|
|
|
safe_delay(500);
|
|
|
|
|
deploy_state = digitalRead(PROBE_TEST_PIN);
|
|
|
|
|
servo[probe_index].move(z_servo_angle[1]); //stow
|
|
|
|
|
safe_delay(500);
|
|
|
|
|
stow_state = digitalRead(PROBE_TEST_PIN);
|
|
|
|
|
}
|
|
|
|
|
if (probe_inverting != deploy_state) SERIAL_PROTOCOLLNPGM("WARNING - INVERTING setting probably backwards");
|
|
|
|
|
refresh_cmd_timeout();
|
|
|
|
|
if (deploy_state != stow_state) {
|
|
|
|
|
SERIAL_PROTOCOLLNPGM("TLTouch detected"); // BLTouch clone?
|
|
|
|
|
if (deploy_state) {
|
|
|
|
|
SERIAL_PROTOCOLLNPGM(". DEPLOYED state: HIGH (logic 1)");
|
|
|
|
|
SERIAL_PROTOCOLLNPGM(". STOWED (triggered) state: LOW (logic 0)");
|
|
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
SERIAL_PROTOCOLLNPGM(". DEPLOYED state: LOW (logic 0)");
|
|
|
|
|
SERIAL_PROTOCOLLNPGM(". STOWED (triggered) state: HIGH (logic 1)");
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else { // measure active signal length
|
|
|
|
|
servo[probe_index].move(z_servo_angle[0]); //deploy
|
|
|
|
|
safe_delay(500);
|
|
|
|
|
SERIAL_PROTOCOLLNPGM("please trigger probe");
|
|
|
|
|
uint16_t probe_counter = 0;
|
|
|
|
|
for (uint16_t j = 0; j < 500*30 && probe_counter == 0 ; j++) { // allow 30 seconds max for operator to trigger probe
|
|
|
|
|
safe_delay(2);
|
|
|
|
|
if ( 0 == j%(500*1)) {refresh_cmd_timeout(); watchdog_reset();} // beat the dog every 45 seconds
|
|
|
|
|
if (deploy_state != digitalRead(PROBE_TEST_PIN)) { // probe triggered
|
|
|
|
|
for (probe_counter = 1; probe_counter < 50 && (deploy_state != digitalRead(PROBE_TEST_PIN)); probe_counter ++) {
|
|
|
|
|
safe_delay(2);
|
|
|
|
|
}
|
|
|
|
|
if (probe_counter == 50) {
|
|
|
|
|
SERIAL_PROTOCOLLNPGM("Z Servo Probe detected"); // >= 100mS active time
|
|
|
|
|
}
|
|
|
|
|
else if (probe_counter >= 2 ) {
|
|
|
|
|
SERIAL_PROTOCOLLNPAIR("BLTouch compatible probe detected - pulse width (+/- 4mS): ", probe_counter * 2 ); // allow 4 - 100mS pulse
|
|
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
SERIAL_PROTOCOLLNPGM("noise detected - please re-run test"); // less than 2mS pulse
|
|
|
|
|
}
|
|
|
|
|
servo[probe_index].move(z_servo_angle[1]); //stow
|
|
|
|
|
} // pulse detected
|
|
|
|
|
} // for loop waiting for trigger
|
|
|
|
|
if (probe_counter == 0) SERIAL_PROTOCOLLNPGM("trigger not detected");
|
|
|
|
|
} // measure active signal length
|
|
|
|
|
#endif
|
|
|
|
|
} // servo_probe_test
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* M43: Pin report and debug
|
|
|
|
|
* M43: Pin debug - report pin state, watch pins, toggle pins and servo probe test/report
|
|
|
|
|
*
|
|
|
|
|
* M43 - report name and state of pin(s)
|
|
|
|
|
* P<pin> Pin to read or watch. If omitted, reads all pins.
|
|
|
|
|
* I Flag to ignore Marlin's pin protection.
|
|
|
|
|
*
|
|
|
|
|
* E<bool> Enable / disable background endstop monitoring
|
|
|
|
|
* - Machine continues to operate
|
|
|
|
|
* - Reports changes to endstops
|
|
|
|
|
* - Toggles LED when an endstop changes
|
|
|
|
|
* M43 W - Watch pins -reporting changes- until reset, click, or M108.
|
|
|
|
|
* P<pin> Pin to read or watch. If omitted, read/watch all pins.
|
|
|
|
|
* I Flag to ignore Marlin's pin protection.
|
|
|
|
|
*
|
|
|
|
|
* or
|
|
|
|
|
* M43 E<bool> - Enable / disable background endstop monitoring
|
|
|
|
|
* - Machine continues to operate
|
|
|
|
|
* - Reports changes to endstops
|
|
|
|
|
* - Toggles LED when an endstop changes
|
|
|
|
|
* - Can not reliably catch the 5mS pulse from BLTouch type probes
|
|
|
|
|
*
|
|
|
|
|
* P<pin> Pin to read or watch. If omitted, read/watch all pins.
|
|
|
|
|
* W<bool> Watch pins -reporting changes- until reset, click, or M108.
|
|
|
|
|
* I<bool> Flag to ignore Marlin's pin protection.
|
|
|
|
|
* M43 T - Toggle pin(s) and report which pin is being toggled
|
|
|
|
|
* S<pin> - Start Pin number. If not given, will default to 0
|
|
|
|
|
* L<pin> - End Pin number. If not given, will default to last pin defined for this board
|
|
|
|
|
* I - Flag to ignore Marlin's pin protection. Use with caution!!!!
|
|
|
|
|
* R - Repeat pulses on each pin this number of times before continueing to next pin
|
|
|
|
|
* W - Wait time (in miliseconds) between pulses. If not given will default to 500
|
|
|
|
|
*
|
|
|
|
|
* M43 S - Servo probe test
|
|
|
|
|
* P<index> - Probe index (optional - defaults to 0
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
inline void gcode_M43() {
|
|
|
|
|
|
|
|
|
|
if (code_seen('T')) { // must be first ot else it's "S" and "E" parameters will execute endstop or servo test
|
|
|
|
|
toggle_pins();
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Enable or disable endstop monitoring
|
|
|
|
|
if (code_seen('E')) {
|
|
|
|
|
endstop_monitor_flag = code_value_bool();
|
|
|
|
|
@ -5334,6 +5487,12 @@ inline void gcode_M42() {
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (code_seen('S')) {
|
|
|
|
|
servo_probe_test();
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Get the range of pins to test or watch
|
|
|
|
|
int first_pin = 0, last_pin = NUM_DIGITAL_PINS - 1;
|
|
|
|
|
if (code_seen('P')) {
|
|
|
|
|
@ -5341,10 +5500,11 @@ inline void gcode_M42() {
|
|
|
|
|
if (first_pin > NUM_DIGITAL_PINS - 1) return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
const bool ignore_protection = code_seen('I') ? code_value_bool() : false;
|
|
|
|
|
bool ignore_protection = code_seen('I');
|
|
|
|
|
|
|
|
|
|
// Watch until click, M108, or reset
|
|
|
|
|
if (code_seen('W') && code_value_bool()) { // watch digital pins
|
|
|
|
|
if (code_seen('W')) { // watch digital pins
|
|
|
|
|
SERIAL_PROTOCOLLNPGM("Watching pins");
|
|
|
|
|
byte pin_state[last_pin - first_pin + 1];
|
|
|
|
|
for (int8_t pin = first_pin; pin <= last_pin; pin++) {
|
|
|
|
|
if (pin_is_protected(pin) && !ignore_protection) continue;
|
|
|
|
|
@ -5387,6 +5547,7 @@ inline void gcode_M42() {
|
|
|
|
|
report_pin_state_extended(pin, ignore_protection);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#endif // PINS_DEBUGGING
|
|
|
|
|
|
|
|
|
|
#if ENABLED(Z_MIN_PROBE_REPEATABILITY_TEST)
|
|
|
|
|
|
Bob-the-Kuhn
8 years ago
committed by