@ -22,7 +22,7 @@
# include "../../inc/MarlinConfig.h"
# if ENABLED(PRUSA_MMU2)
# if HAS_PRUSA_MMU2
# include "mmu2.h"
# include "../../lcd/menu/menu_mmu2.h"
@ -94,7 +94,7 @@ MMU2 mmu2;
# define mmuSerial MMU2_SERIAL
bool MMU2 : : enabled , MMU2 : : ready , MMU2 : : mmu_print_saved ;
# if ENABLED(PRUSA_MMU2_S_MODE)
# if HAS_PRUSA_MMU2S
bool MMU2 : : mmu2s_triggered ;
# endif
uint8_t MMU2 : : cmd , MMU2 : : cmd_arg , MMU2 : : last_cmd , MMU2 : : extruder ;
@ -105,8 +105,6 @@ int16_t MMU2::version = -1, MMU2::buildnr = -1;
millis_t MMU2 : : prev_request , MMU2 : : prev_P0_request ;
char MMU2 : : rx_buffer [ MMU_RX_SIZE ] , MMU2 : : tx_buffer [ MMU_TX_SIZE ] ;
# if BOTH(HAS_LCD_MENU, MMU2_MENUS)
struct E_Step {
float extrude ; //!< extrude distance in mm
feedRate_t feedRate ; //!< feed rate in mm/s
@ -115,14 +113,12 @@ char MMU2::rx_buffer[MMU_RX_SIZE], MMU2::tx_buffer[MMU_TX_SIZE];
static constexpr E_Step
ramming_sequence [ ] PROGMEM = { MMU2_RAMMING_SEQUENCE }
, load_to_nozzle_sequence [ ] PROGMEM = { MMU2_LOAD_TO_NOZZLE_SEQUENCE }
# if ENABLED(PRUSA_MMU2_S_MODE)
# if HAS_PRUSA_MMU2S
, can_load_sequence [ ] PROGMEM = { MMU2_CAN_LOAD_SEQUENCE }
, can_load_increment_sequence [ ] PROGMEM = { MMU2_CAN_LOAD_INCREMENT_SEQUENCE }
# endif
;
# endif // MMU2_MENUS
MMU2 : : MMU2 ( ) {
rx_buffer [ 0 ] = ' \0 ' ;
}
@ -162,7 +158,7 @@ uint8_t MMU2::get_current_tool() {
return extruder = = MMU2_NO_TOOL ? - 1 : extruder ;
}
# if EITHER( PRUSA_MMU2_ S_MODE , MMU_EXTRUDER_SENSOR)
# if EITHER( HAS_ PRUSA_MMU2S, MMU_EXTRUDER_SENSOR)
# define FILAMENT_PRESENT() (READ(FIL_RUNOUT1_PIN) != FIL_RUNOUT1_STATE)
# endif
@ -188,7 +184,7 @@ void MMU2::mmu_loop() {
case - 2 :
if ( rx_ok ( ) ) {
sscanf ( rx_buffer , " % uok\n " , & version ) ;
sscanf ( rx_buffer , " % h uok\n " , & version ) ;
DEBUG_ECHOLNPAIR ( " MMU => " , version , " \n MMU <= 'S2' " ) ;
@ -199,7 +195,7 @@ void MMU2::mmu_loop() {
case - 3 :
if ( rx_ok ( ) ) {
sscanf ( rx_buffer , " % uok\n " , & buildnr ) ;
sscanf ( rx_buffer , " % h uok\n " , & buildnr ) ;
DEBUG_ECHOLNPAIR ( " MMU => " , buildnr ) ;
@ -242,7 +238,7 @@ void MMU2::mmu_loop() {
enabled = true ;
state = 1 ;
TERN_ ( _ S_MODE , mmu2s_triggered = false ) ;
TERN_ ( HAS_ PRUSA_MMU2S, mmu2s_triggered = false ) ;
}
break ;
@ -307,7 +303,7 @@ void MMU2::mmu_loop() {
state = 2 ; // wait for response
}
TERN_ ( _ S_MODE , check_filament ( ) ) ;
TERN_ ( HAS_ PRUSA_MMU2S, check_filament ( ) ) ;
break ;
case 2 : // response to command P0
@ -324,7 +320,7 @@ void MMU2::mmu_loop() {
else if ( ELAPSED ( millis ( ) , prev_request + MMU_P0_TIMEOUT ) ) // Resend request after timeout (3s)
state = 1 ;
TERN_ ( _ S_MODE , check_filament ( ) ) ;
TERN_ ( HAS_ PRUSA_MMU2S, check_filament ( ) ) ;
break ;
case 3 : // response to mmu commands
@ -340,9 +336,9 @@ void MMU2::mmu_loop() {
# endif
if ( rx_ok ( ) ) {
// Response to C0 mmu command in PRUSA_MMU2_S_MODE
// Response to C0 mmu command in MMU2S model
bool can_reset = true ;
# if ENABLED(PRUSA_MMU2_S_MODE)
# if HAS_PRUSA_MMU2S
if ( ! mmu2s_triggered & & last_cmd = = MMU_CMD_C0 ) {
can_reset = false ;
// MMU ok received but filament sensor not triggered, retrying...
@ -367,7 +363,7 @@ void MMU2::mmu_loop() {
}
state = 1 ;
}
TERN_ ( _ S_MODE , check_filament ( ) ) ;
TERN_ ( HAS_ PRUSA_MMU2S, check_filament ( ) ) ;
break ;
}
}
@ -487,7 +483,7 @@ static void mmu2_not_responding() {
BUZZ ( 100 , 659 ) ;
}
# if ENABLED(PRUSA_MMU2_S_MODE)
# if HAS_PRUSA_MMU2S
bool MMU2 : : load_to_gears ( ) {
command ( MMU_CMD_C0 ) ;
@ -541,23 +537,25 @@ static void mmu2_not_responding() {
* Tc Load to nozzle after filament was prepared by Tx and extruder nozzle is already heated .
*/
void MMU2 : : tool_change ( const char * special ) {
if ( ! enabled ) return ;
# if ENABLED(MMU2_MENUS)
set_runout_valid ( false ) ;
switch ( * special ) {
case ' ? ' : {
uint8_t index = mmu2_choose_filament ( ) ;
# if ENABLED(MMU2_MENUS)
const uint8_t index = mmu2_choose_filament ( ) ;
while ( ! thermalManager . wait_for_hotend ( active_extruder , false ) ) safe_delay ( 100 ) ;
load_filament_to_nozzle ( index ) ;
# else
BUZZ ( 400 , 40 ) ;
# endif
} break ;
case ' x ' : {
# if ENABLED(MMU2_MENUS)
planner . synchronize ( ) ;
uint8_t index = mmu2_choose_filament ( ) ;
const uint8_t index = mmu2_choose_filament ( ) ;
DISABLE_AXIS_E0 ( ) ;
command ( MMU_CMD_T0 + index ) ;
manage_response ( true , true ) ;
@ -568,6 +566,9 @@ static void mmu2_not_responding() {
extruder = index ;
active_extruder = 0 ;
}
# else
BUZZ ( 400 , 40 ) ;
# endif
} break ;
case ' c ' : {
@ -577,8 +578,6 @@ static void mmu2_not_responding() {
}
set_runout_valid ( true ) ;
# endif // MMU2_MENUS
}
# elif ENABLED(MMU_EXTRUDER_SENSOR)
@ -628,20 +627,23 @@ static void mmu2_not_responding() {
void MMU2 : : tool_change ( const char * special ) {
if ( ! enabled ) return ;
# if ENABLED(MMU2_MENUS)
set_runout_valid ( false ) ;
switch ( * special ) {
case ' ? ' : {
DEBUG_ECHOLNPGM ( " case ? \n " ) ;
# if ENABLED(MMU2_MENUS)
uint8_t index = mmu2_choose_filament ( ) ;
while ( ! thermalManager . wait_for_hotend ( active_extruder , false ) ) safe_delay ( 100 ) ;
load_filament_to_nozzle ( index ) ;
# else
BUZZ ( 400 , 40 ) ;
# endif
} break ;
case ' x ' : {
DEBUG_ECHOLNPGM ( " case x \n " ) ;
# if ENABLED(MMU2_MENUS)
planner . synchronize ( ) ;
uint8_t index = mmu2_choose_filament ( ) ;
DISABLE_AXIS_E0 ( ) ;
@ -654,6 +656,9 @@ static void mmu2_not_responding() {
ENABLE_AXIS_E0 ( ) ;
extruder = index ;
active_extruder = 0 ;
# else
BUZZ ( 400 , 40 ) ;
# endif
} break ;
case ' c ' : {
@ -664,8 +669,6 @@ static void mmu2_not_responding() {
}
set_runout_valid ( true ) ;
# endif // MMU2_MENUS
}
void MMU2 : : mmu_continue_loading ( ) {
@ -682,7 +685,7 @@ static void mmu2_not_responding() {
mmu_idl_sens = 0 ;
}
# el if DISABLED(MMU_EXTRUDER_SENSOR) && DISABLED(PRUSA_MMU2_S_MODE)
# el se // !HAS_PRUSA_MMU2S && !MMU_EXTRUDER_SENSOR
/**
* Handle tool change
@ -719,20 +722,23 @@ void MMU2::tool_change(const uint8_t index) {
void MMU2 : : tool_change ( const char * special ) {
if ( ! enabled ) return ;
# if ENABLED(MMU2_MENUS)
set_runout_valid ( false ) ;
switch ( * special ) {
case ' ? ' : {
DEBUG_ECHOLNPGM ( " case ? \n " ) ;
# if ENABLED(MMU2_MENUS)
uint8_t index = mmu2_choose_filament ( ) ;
while ( ! thermalManager . wait_for_hotend ( active_extruder , false ) ) safe_delay ( 100 ) ;
load_filament_to_nozzle ( index ) ;
# else
BUZZ ( 400 , 40 ) ;
# endif
} break ;
case ' x ' : {
DEBUG_ECHOLNPGM ( " case x \n " ) ;
# if ENABLED(MMU2_MENUS)
planner . synchronize ( ) ;
uint8_t index = mmu2_choose_filament ( ) ;
DISABLE_AXIS_E0 ( ) ;
@ -744,6 +750,9 @@ void MMU2::tool_change(const char* special) {
ENABLE_AXIS_E0 ( ) ;
extruder = index ;
active_extruder = 0 ;
# else
BUZZ ( 400 , 40 ) ;
# endif
} break ;
case ' c ' : {
@ -754,11 +763,9 @@ void MMU2::tool_change(const char* special) {
}
set_runout_valid ( true ) ;
# endif
}
# endif // MMU_EXTRUDER_SENSOR
# endif // HAS_PRUSA_MMU2S
/**
* Set next command
@ -866,7 +873,7 @@ void MMU2::filament_runout() {
planner . synchronize ( ) ;
}
# if ENABLED(PRUSA_MMU2_S_MODE)
# if HAS_PRUSA_MMU2S
void MMU2 : : check_filament ( ) {
const bool present = FILAMENT_PRESENT ( ) ;
@ -907,9 +914,8 @@ void MMU2::filament_runout() {
DEBUG_ECHOLNPGM ( " succeeded. " ) ;
return true ;
}
# endif
# BOTH(HAS_LCD_MENU, MMU2_MENUS)
# end if
// Load filament into MMU2
void MMU2 : : load_filament ( const uint8_t index ) {
@ -972,7 +978,7 @@ void MMU2::filament_runout() {
ENABLE_AXIS_E0 ( ) ;
current_position . e - = MMU2_FILAMENTCHANGE_EJECT_FEED ;
line_to_current_position ( 2500 / 60 ) ;
line_to_current_position ( MMM_TO_MMS ( 2500 ) ) ;
planner . synchronize ( ) ;
command ( MMU_CMD_E0 + index ) ;
manage_response ( false , false ) ;
@ -1063,6 +1069,4 @@ void MMU2::filament_runout() {
DISABLE_AXIS_E0 ( ) ;
}
# endif // HAS_LCD_MENU && MMU2_MENUS
# endif // PRUSA_MMU2
# endif // HAS_PRUSA_MMU2
Giuliano Zaro
4 years ago
committed by
GitHub