Move M702 MK2_MULTIPLEXER to cpp

This commit is contained in:
Scott Lahteine
2017-09-17 16:58:16 -05:00
parent 7ba2ab4fb3
commit 75cf17d816
6 changed files with 81 additions and 18 deletions

View File

@ -20,21 +20,19 @@
*
*/
inline void select_multiplexed_stepper(const uint8_t e) {
stepper.synchronize();
disable_e_steppers();
WRITE(E_MUX0_PIN, TEST(e, 0) ? HIGH : LOW);
WRITE(E_MUX1_PIN, TEST(e, 1) ? HIGH : LOW);
WRITE(E_MUX2_PIN, TEST(e, 2) ? HIGH : LOW);
safe_delay(100);
}
#include "../../../inc/MarlinConfig.h"
#if ENABLED(MK2_MULTIPLEXER)
#include "../../gcode.h"
#include "../../../feature/snmm.h"
/**
* M702: Unload all extruders
*/
void gcode_M702() {
void GcodeSuite::M702() {
for (uint8_t s = 0; s < E_STEPPERS; s++) {
select_multiplexed_stepper(e);
select_multiplexed_stepper(s);
// TODO: standard unload filament function
// MK2 firmware behavior:
// - Make sure temperature is high enough
@ -48,3 +46,5 @@ void gcode_M702() {
select_multiplexed_stepper(active_extruder);
disable_e_steppers();
}
#endif // MK2_MULTIPLEXER

View File

@ -123,7 +123,6 @@ extern void gcode_M350();
extern void gcode_M351();
extern void gcode_M355();
extern void gcode_M605();
extern void gcode_M702();
extern void gcode_M900();
extern void gcode_M906();
extern void gcode_M911();
@ -658,9 +657,7 @@ void GcodeSuite::process_next_command() {
#endif // DUAL_X_CARRIAGE
#if ENABLED(MK2_MULTIPLEXER)
case 702: // M702: Unload all extruders
gcode_M702();
break;
case 702: M702(); break; // M702: Unload all extruders
#endif
#if ENABLED(LIN_ADVANCE)