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