mmu.cpp 44 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606
  1. //! @file
  2. #include "mmu.h"
  3. #include "planner.h"
  4. #include "language.h"
  5. #include "lcd.h"
  6. #include "uart2.h"
  7. #include "temperature.h"
  8. #include "Configuration_prusa.h"
  9. #include "fsensor.h"
  10. #include "cardreader.h"
  11. #include "cmdqueue.h"
  12. #include "ultralcd.h"
  13. #include "menu.h"
  14. #include "sound.h"
  15. #include "printers.h"
  16. #include <avr/pgmspace.h>
  17. #include "AutoDeplete.h"
  18. #include "fastio.h"
  19. #include "pins.h"
  20. //-//
  21. #include "util.h"
  22. #ifdef TMC2130
  23. #include "tmc2130.h"
  24. #endif //TMC2130
  25. #define MMU_TODELAY 100
  26. #define MMU_TIMEOUT 10
  27. #define MMU_CMD_TIMEOUT 45000ul //45s timeout for mmu commands (except P0)
  28. #define MMU_P0_TIMEOUT 3000ul //timeout for P0 command: 3seconds
  29. #define MMU_MAX_RESEND_ATTEMPTS 2
  30. namespace
  31. {
  32. enum class S : uint_least8_t
  33. {
  34. WaitStealthMode,
  35. GetFindaInit,
  36. GetBuildNr,
  37. GetVersion,
  38. Init,
  39. Disabled,
  40. Idle,
  41. GetFinda,
  42. WaitCmd, //!< wait for command response
  43. Pause,
  44. GetDrvError, //!< get power failures count
  45. SwitchMode //switch mmu between stealth and normal mode
  46. };
  47. }
  48. bool mmu_enabled = false;
  49. bool mmu_ready = false;
  50. bool mmu_fil_loaded = false; //if true: blocks execution of duplicit T-codes
  51. static S mmu_state = S::Disabled;
  52. MmuCmd mmu_cmd = MmuCmd::None;
  53. //idler ir sensor
  54. static uint8_t mmu_idl_sens = 0;
  55. bool ir_sensor_detected = false;
  56. static bool mmu_loading_flag = false; //when set to true, we assume that mmu2 unload was finished and loading phase is now performed; printer can send 'A' to mmu2 to abort loading process
  57. uint8_t mmu_extruder = MMU_FILAMENT_UNKNOWN;
  58. //! This variable probably has no meaning and is planed to be removed
  59. uint8_t tmp_extruder = MMU_FILAMENT_UNKNOWN;
  60. int8_t mmu_finda = -1;
  61. uint32_t mmu_last_finda_response = 0;
  62. int16_t mmu_version = -1;
  63. int16_t mmu_buildnr = -1;
  64. uint32_t mmu_last_request = 0;
  65. uint32_t mmu_last_response = 0;
  66. MmuCmd mmu_last_cmd = MmuCmd::None;
  67. uint16_t mmu_power_failures = 0;
  68. #ifdef MMU_DEBUG
  69. static const auto DEBUG_PUTCHAR = putchar;
  70. static const auto DEBUG_PUTS_P = puts_P;
  71. static const auto DEBUG_PRINTF_P = printf_P;
  72. #else //MMU_DEBUG
  73. #define DEBUG_PUTCHAR(c)
  74. #define DEBUG_PUTS_P(str)
  75. #define DEBUG_PRINTF_P( __fmt, ... )
  76. #endif //MMU_DEBUG
  77. #if defined(MMU_FINDA_DEBUG) && defined(MMU_DEBUG)
  78. static const auto FDEBUG_PUTS_P = puts_P;
  79. static const auto FDEBUG_PRINTF_P = printf_P;
  80. #else
  81. #define FDEBUG_PUTS_P(str)
  82. #define FDEBUG_PRINTF_P( __fmt, ... )
  83. #endif //defined(MMU_FINDA_DEBUG) && defined(MMU_DEBUG)
  84. //clear rx buffer
  85. void mmu_clr_rx_buf(void)
  86. {
  87. while (fgetc(uart2io) >= 0);
  88. }
  89. //send command - puts
  90. int mmu_puts_P(const char* str)
  91. {
  92. mmu_clr_rx_buf(); //clear rx buffer
  93. int r = fputs_P(str, uart2io); //send command
  94. mmu_last_request = _millis();
  95. return r;
  96. }
  97. //send command - printf
  98. int mmu_printf_P(const char* format, ...)
  99. {
  100. va_list args;
  101. va_start(args, format);
  102. mmu_clr_rx_buf(); //clear rx buffer
  103. int r = vfprintf_P(uart2io, format, args); //send command
  104. va_end(args);
  105. mmu_last_request = _millis();
  106. return r;
  107. }
  108. //check 'ok' response
  109. int8_t mmu_rx_ok(void)
  110. {
  111. int8_t res = uart2_rx_str_P(PSTR("ok\n"));
  112. if (res == 1) mmu_last_response = _millis();
  113. return res;
  114. }
  115. //check 'start' response
  116. int8_t mmu_rx_start(void)
  117. {
  118. int8_t res = uart2_rx_str_P(PSTR("start\n"));
  119. if (res == 1) mmu_last_response = _millis();
  120. return res;
  121. }
  122. //initialize mmu2 unit - first part - should be done at begining of startup process
  123. void mmu_init(void)
  124. {
  125. #ifdef MMU_HWRESET
  126. WRITE(MMU_RST_PIN, 1);
  127. SET_OUTPUT(MMU_RST_PIN); //setup reset pin
  128. #endif //MMU_HWRESET
  129. uart2_init(); //init uart2
  130. _delay_ms(10); //wait 10ms for sure
  131. mmu_reset(); //reset mmu (HW or SW), do not wait for response
  132. mmu_state = S::Init;
  133. SET_INPUT(IR_SENSOR_PIN); //input mode
  134. WRITE(IR_SENSOR_PIN, 1); //pullup
  135. }
  136. //if IR_SENSOR defined, always returns true
  137. //otherwise check for ir sensor and returns true if idler IR sensor was detected, otherwise returns false
  138. bool check_for_ir_sensor()
  139. {
  140. #ifdef IR_SENSOR
  141. return true;
  142. #else //IR_SENSOR
  143. bool detected = false;
  144. //if IR_SENSOR_PIN input is low and pat9125sensor is not present we detected idler sensor
  145. if ((READ(IR_SENSOR_PIN) == 0)
  146. #ifdef PAT9125
  147. && fsensor_not_responding
  148. #endif //PAT9125
  149. )
  150. {
  151. detected = true;
  152. //printf_P(PSTR("Idler IR sensor detected\n"));
  153. }
  154. else
  155. {
  156. //printf_P(PSTR("Idler IR sensor not detected\n"));
  157. }
  158. return detected;
  159. #endif //IR_SENSOR
  160. }
  161. static bool activate_stealth_mode()
  162. {
  163. #ifdef MMU_FORCE_STEALTH_MODE
  164. return true;
  165. #else
  166. return (eeprom_read_byte((uint8_t*)EEPROM_MMU_STEALTH) == 1);
  167. #endif
  168. }
  169. //mmu main loop - state machine processing
  170. void mmu_loop(void)
  171. {
  172. static uint8_t mmu_attempt_nr = 0;
  173. // printf_P(PSTR("MMU loop, state=%d\n"), mmu_state);
  174. switch (mmu_state)
  175. {
  176. case S::Disabled:
  177. return;
  178. case S::Init:
  179. if (mmu_rx_start() > 0)
  180. {
  181. DEBUG_PUTS_P(PSTR("MMU => 'start'"));
  182. DEBUG_PUTS_P(PSTR("MMU <= 'S1'"));
  183. mmu_puts_P(PSTR("S1\n")); //send 'read version' request
  184. mmu_state = S::GetVersion;
  185. }
  186. else if (_millis() > 30000) //30sec after reset disable mmu
  187. {
  188. puts_P(PSTR("MMU not responding - DISABLED"));
  189. mmu_state = S::Disabled;
  190. }
  191. return;
  192. case S::GetVersion:
  193. if (mmu_rx_ok() > 0)
  194. {
  195. fscanf_P(uart2io, PSTR("%u"), &mmu_version); //scan version from buffer
  196. DEBUG_PRINTF_P(PSTR("MMU => '%dok'\n"), mmu_version);
  197. DEBUG_PUTS_P(PSTR("MMU <= 'S2'"));
  198. mmu_puts_P(PSTR("S2\n")); //send 'read buildnr' request
  199. mmu_state = S::GetBuildNr;
  200. }
  201. return;
  202. case S::GetBuildNr:
  203. if (mmu_rx_ok() > 0)
  204. {
  205. fscanf_P(uart2io, PSTR("%u"), &mmu_buildnr); //scan buildnr from buffer
  206. DEBUG_PRINTF_P(PSTR("MMU => '%dok'\n"), mmu_buildnr);
  207. bool version_valid = mmu_check_version();
  208. if (!version_valid) mmu_show_warning();
  209. else puts_P(PSTR("MMU version valid"));
  210. if (!activate_stealth_mode())
  211. {
  212. FDEBUG_PUTS_P(PSTR("MMU <= 'P0'"));
  213. mmu_puts_P(PSTR("P0\n")); //send 'read finda' request
  214. mmu_state = S::GetFindaInit;
  215. }
  216. else
  217. {
  218. DEBUG_PUTS_P(PSTR("MMU <= 'M1'"));
  219. mmu_puts_P(PSTR("M1\n")); //set mmu mode to stealth
  220. mmu_state = S::WaitStealthMode;
  221. }
  222. }
  223. return;
  224. case S::WaitStealthMode:
  225. if (mmu_rx_ok() > 0)
  226. {
  227. FDEBUG_PUTS_P(PSTR("MMU <= 'P0'"));
  228. mmu_puts_P(PSTR("P0\n")); //send 'read finda' request
  229. mmu_state = S::GetFindaInit;
  230. }
  231. return;
  232. case S::GetFindaInit:
  233. if (mmu_rx_ok() > 0)
  234. {
  235. fscanf_P(uart2io, PSTR("%hhu"), &mmu_finda); //scan finda from buffer
  236. mmu_last_finda_response = _millis();
  237. FDEBUG_PRINTF_P(PSTR("MMU => '%dok'\n"), mmu_finda);
  238. puts_P(PSTR("MMU - ENABLED"));
  239. mmu_enabled = true;
  240. //-//
  241. // ... PrinterType/Name
  242. fSetMmuMode(true);
  243. mmu_state = S::Idle;
  244. }
  245. return;
  246. case S::Idle:
  247. if (mmu_cmd != MmuCmd::None) //command request ?
  248. {
  249. if ((mmu_cmd >= MmuCmd::T0) && (mmu_cmd <= MmuCmd::T4))
  250. {
  251. const uint8_t filament = mmu_cmd - MmuCmd::T0;
  252. DEBUG_PRINTF_P(PSTR("MMU <= 'T%d'\n"), filament);
  253. mmu_printf_P(PSTR("T%d\n"), filament);
  254. mmu_state = S::WaitCmd; // wait for response
  255. mmu_fil_loaded = true;
  256. mmu_idl_sens = 1;
  257. }
  258. else if ((mmu_cmd >= MmuCmd::L0) && (mmu_cmd <= MmuCmd::L4))
  259. {
  260. const uint8_t filament = mmu_cmd - MmuCmd::L0;
  261. DEBUG_PRINTF_P(PSTR("MMU <= 'L%d'\n"), filament);
  262. mmu_printf_P(PSTR("L%d\n"), filament);
  263. mmu_state = S::WaitCmd; // wait for response
  264. }
  265. else if (mmu_cmd == MmuCmd::C0)
  266. {
  267. DEBUG_PRINTF_P(PSTR("MMU <= 'C0'\n"));
  268. mmu_puts_P(PSTR("C0\n")); //send 'continue loading'
  269. mmu_state = S::WaitCmd;
  270. mmu_idl_sens = 1;
  271. }
  272. else if (mmu_cmd == MmuCmd::U0)
  273. {
  274. DEBUG_PRINTF_P(PSTR("MMU <= 'U0'\n"));
  275. mmu_puts_P(PSTR("U0\n")); //send 'unload current filament'
  276. mmu_fil_loaded = false;
  277. mmu_state = S::WaitCmd;
  278. }
  279. else if ((mmu_cmd >= MmuCmd::E0) && (mmu_cmd <= MmuCmd::E4))
  280. {
  281. const uint8_t filament = mmu_cmd - MmuCmd::E0;
  282. DEBUG_PRINTF_P(PSTR("MMU <= 'E%d'\n"), filament);
  283. mmu_printf_P(PSTR("E%d\n"), filament); //send eject filament
  284. mmu_fil_loaded = false;
  285. mmu_state = S::WaitCmd;
  286. }
  287. else if ((mmu_cmd >= MmuCmd::K0) && (mmu_cmd <= MmuCmd::K4))
  288. {
  289. const uint8_t filament = mmu_cmd - MmuCmd::K0;
  290. DEBUG_PRINTF_P(PSTR("MMU <= 'K%d'\n"), filament);
  291. mmu_printf_P(PSTR("K%d\n"), filament); //send eject filament
  292. mmu_fil_loaded = false;
  293. mmu_state = S::WaitCmd;
  294. }
  295. else if (mmu_cmd == MmuCmd::R0)
  296. {
  297. DEBUG_PRINTF_P(PSTR("MMU <= 'R0'\n"));
  298. mmu_puts_P(PSTR("R0\n")); //send recover after eject
  299. mmu_state = S::WaitCmd;
  300. }
  301. else if (mmu_cmd == MmuCmd::S3)
  302. {
  303. DEBUG_PRINTF_P(PSTR("MMU <= 'S3'\n"));
  304. mmu_puts_P(PSTR("S3\n")); //send power failures request
  305. mmu_state = S::GetDrvError;
  306. }
  307. else if (mmu_cmd == MmuCmd::W0)
  308. {
  309. DEBUG_PRINTF_P(PSTR("MMU <= 'W0'\n"));
  310. mmu_puts_P(PSTR("W0\n"));
  311. mmu_state = S::Pause;
  312. }
  313. mmu_last_cmd = mmu_cmd;
  314. mmu_cmd = MmuCmd::None;
  315. }
  316. else if ((eeprom_read_byte((uint8_t*)EEPROM_MMU_STEALTH) != SilentModeMenu_MMU) && mmu_ready) {
  317. DEBUG_PRINTF_P(PSTR("MMU <= 'M%d'\n"), SilentModeMenu_MMU);
  318. mmu_printf_P(PSTR("M%d\n"), SilentModeMenu_MMU);
  319. mmu_state = S::SwitchMode;
  320. }
  321. else if ((mmu_last_response + 300) < _millis()) //request every 300ms
  322. {
  323. #ifndef IR_SENSOR
  324. if(check_for_ir_sensor()) ir_sensor_detected = true;
  325. #endif //IR_SENSOR not defined
  326. FDEBUG_PUTS_P(PSTR("MMU <= 'P0'"));
  327. mmu_puts_P(PSTR("P0\n")); //send 'read finda' request
  328. mmu_state = S::GetFinda;
  329. }
  330. return;
  331. case S::GetFinda: //response to command P0
  332. if (mmu_idl_sens)
  333. {
  334. if (READ(IR_SENSOR_PIN) == 0 && mmu_loading_flag)
  335. {
  336. #ifdef MMU_DEBUG
  337. printf_P(PSTR("MMU <= 'A'\n"));
  338. #endif //MMU_DEBUG
  339. mmu_puts_P(PSTR("A\n")); //send 'abort' request
  340. mmu_idl_sens = 0;
  341. //printf_P(PSTR("MMU IDLER_SENSOR = 0 - ABORT\n"));
  342. }
  343. //else
  344. //printf_P(PSTR("MMU IDLER_SENSOR = 1 - WAIT\n"));
  345. }
  346. if (mmu_rx_ok() > 0)
  347. {
  348. fscanf_P(uart2io, PSTR("%hhu"), &mmu_finda); //scan finda from buffer
  349. mmu_last_finda_response = _millis();
  350. FDEBUG_PRINTF_P(PSTR("MMU => '%dok'\n"), mmu_finda);
  351. //printf_P(PSTR("Eact: %d\n"), int(e_active()));
  352. if (!mmu_finda && CHECK_FSENSOR && fsensor_enabled) {
  353. fsensor_checkpoint_print();
  354. if (mmu_extruder != MMU_FILAMENT_UNKNOWN) // Can't deplete unknown extruder.
  355. ad_markDepleted(mmu_extruder);
  356. if (lcd_autoDepleteEnabled() && !ad_allDepleted() && mmu_extruder != MMU_FILAMENT_UNKNOWN) // Can't auto if F=?
  357. {
  358. enquecommand_front_P(PSTR("M600 AUTO")); //save print and run M600 command
  359. }
  360. else
  361. {
  362. enquecommand_front_P(PSTR("M600")); //save print and run M600 command
  363. }
  364. }
  365. mmu_state = S::Idle;
  366. if (mmu_cmd == MmuCmd::None)
  367. mmu_ready = true;
  368. }
  369. else if ((mmu_last_request + MMU_P0_TIMEOUT) < _millis())
  370. { //resend request after timeout (30s)
  371. mmu_state = S::Idle;
  372. }
  373. return;
  374. case S::WaitCmd: //response to mmu commands
  375. if (mmu_idl_sens)
  376. {
  377. if (READ(IR_SENSOR_PIN) == 0 && mmu_loading_flag)
  378. {
  379. DEBUG_PRINTF_P(PSTR("MMU <= 'A'\n"));
  380. mmu_puts_P(PSTR("A\n")); //send 'abort' request
  381. mmu_idl_sens = 0;
  382. //printf_P(PSTR("MMU IDLER_SENSOR = 0 - ABORT\n"));
  383. }
  384. //else
  385. //printf_P(PSTR("MMU IDLER_SENSOR = 1 - WAIT\n"));
  386. }
  387. if (mmu_rx_ok() > 0)
  388. {
  389. DEBUG_PRINTF_P(PSTR("MMU => 'ok'\n"));
  390. mmu_attempt_nr = 0;
  391. mmu_last_cmd = MmuCmd::None;
  392. mmu_ready = true;
  393. mmu_state = S::Idle;
  394. }
  395. else if ((mmu_last_request + MMU_CMD_TIMEOUT) < _millis())
  396. { //resend request after timeout (5 min)
  397. if (mmu_last_cmd != MmuCmd::None)
  398. {
  399. if (mmu_attempt_nr++ < MMU_MAX_RESEND_ATTEMPTS &&
  400. mmu_last_cmd >= MmuCmd::T0 && mmu_last_cmd <= MmuCmd::T4)
  401. {
  402. DEBUG_PRINTF_P(PSTR("MMU retry attempt nr. %d\n"), mmu_attempt_nr - 1);
  403. mmu_cmd = mmu_last_cmd;
  404. }
  405. else {
  406. mmu_cmd = MmuCmd::None;
  407. mmu_last_cmd = MmuCmd::None; //check
  408. mmu_attempt_nr = 0;
  409. }
  410. }
  411. mmu_state = S::Idle;
  412. }
  413. return;
  414. case S::Pause:
  415. if (mmu_rx_ok() > 0)
  416. {
  417. DEBUG_PRINTF_P(PSTR("MMU => 'ok', resume print\n"));
  418. mmu_attempt_nr = 0;
  419. mmu_last_cmd = MmuCmd::None;
  420. mmu_ready = true;
  421. mmu_state = S::Idle;
  422. lcd_resume_print();
  423. }
  424. if (mmu_cmd != MmuCmd::None)
  425. {
  426. mmu_state = S::Idle;
  427. }
  428. return;
  429. case S::GetDrvError:
  430. if (mmu_rx_ok() > 0)
  431. {
  432. fscanf_P(uart2io, PSTR("%d"), &mmu_power_failures); //scan power failures
  433. DEBUG_PRINTF_P(PSTR("MMU => 'ok'\n"));
  434. mmu_last_cmd = MmuCmd::None;
  435. mmu_ready = true;
  436. mmu_state = S::Idle;
  437. }
  438. else if ((mmu_last_request + MMU_CMD_TIMEOUT) < _millis())
  439. { //timeout 45 s
  440. mmu_state = S::Idle;
  441. }
  442. return;
  443. case S::SwitchMode:
  444. if (mmu_rx_ok() > 0)
  445. {
  446. DEBUG_PRINTF_P(PSTR("MMU => 'ok'\n"));
  447. eeprom_update_byte((uint8_t*)EEPROM_MMU_STEALTH, SilentModeMenu_MMU);
  448. mmu_state = S::Idle;
  449. }
  450. else if ((mmu_last_request + MMU_CMD_TIMEOUT) < _millis())
  451. { //timeout 45 s
  452. mmu_state = S::Idle;
  453. }
  454. return;
  455. }
  456. }
  457. void mmu_reset(void)
  458. {
  459. #ifdef MMU_HWRESET //HW - pulse reset pin
  460. WRITE(MMU_RST_PIN, 0);
  461. _delay_us(100);
  462. WRITE(MMU_RST_PIN, 1);
  463. #else //SW - send X0 command
  464. mmu_puts_P(PSTR("X0\n"));
  465. #endif
  466. }
  467. int8_t mmu_set_filament_type(uint8_t extruder, uint8_t filament)
  468. {
  469. printf_P(PSTR("MMU <= 'F%d %d'\n"), extruder, filament);
  470. mmu_printf_P(PSTR("F%d %d\n"), extruder, filament);
  471. unsigned char timeout = MMU_TIMEOUT; //10x100ms
  472. while ((mmu_rx_ok() <= 0) && (--timeout))
  473. delay_keep_alive(MMU_TODELAY);
  474. return timeout?1:0;
  475. }
  476. //! @brief Enqueue MMUv2 command
  477. //!
  478. //! Call manage_response() after enqueuing to process command.
  479. //! If T command is enqueued, it disables current for extruder motor if TMC2130 driver present.
  480. //! If T or L command is enqueued, it marks filament loaded in AutoDeplete module.
  481. void mmu_command(MmuCmd cmd)
  482. {
  483. if ((cmd >= MmuCmd::T0) && (cmd <= MmuCmd::T4))
  484. {
  485. //disable extruder motor
  486. #ifdef TMC2130
  487. tmc2130_set_pwr(E_AXIS, 0);
  488. #endif //TMC2130
  489. //printf_P(PSTR("E-axis disabled\n"));
  490. ad_markLoaded(cmd - MmuCmd::T0);
  491. }
  492. if ((cmd >= MmuCmd::L0) && (cmd <= MmuCmd::L4))
  493. {
  494. ad_markLoaded(cmd - MmuCmd::L0);
  495. }
  496. mmu_cmd = cmd;
  497. mmu_ready = false;
  498. }
  499. //! @brief Rotate extruder idler to catch filament
  500. //! @par synchronize
  501. //! * true blocking call
  502. //! * false non-blocking call
  503. void mmu_load_step(bool synchronize)
  504. {
  505. current_position[E_AXIS] = current_position[E_AXIS] + MMU_LOAD_FEEDRATE * 0.1;
  506. plan_buffer_line_curposXYZE(MMU_LOAD_FEEDRATE);
  507. if (synchronize) st_synchronize();
  508. }
  509. //! @brief Is nozzle hot enough to move extruder wheels and do we have idler sensor?
  510. //!
  511. //! Do load steps only if temperature is higher then min. temp for safe extrusion and
  512. //! idler sensor present.
  513. //! Otherwise "cold extrusion prevented" would be send to serial line periodically
  514. //! and watchdog reset will be triggered by lack of keep_alive processing.
  515. //!
  516. //! @retval true temperature is high enough to move extruder
  517. //! @retval false temperature is not high enough to move extruder, turned
  518. //! off E-stepper to prevent over-heating and allow filament pull-out if necessary
  519. bool can_extrude()
  520. {
  521. if ((degHotend(active_extruder) < EXTRUDE_MINTEMP) || !ir_sensor_detected)
  522. {
  523. disable_e0();
  524. delay_keep_alive(100);
  525. return false;
  526. }
  527. return true;
  528. }
  529. static void get_response_print_info(uint8_t move) {
  530. printf_P(PSTR("mmu_get_response - begin move: "), move);
  531. switch (move) {
  532. case MMU_LOAD_MOVE: puts_P(PSTR("load")); break;
  533. case MMU_UNLOAD_MOVE: puts_P(PSTR("unload")); break;
  534. case MMU_TCODE_MOVE: puts_P(PSTR("T-code")); break;
  535. case MMU_NO_MOVE: puts_P(PSTR("no move")); break;
  536. default: puts_P(PSTR("error: unknown move")); break;
  537. }
  538. }
  539. bool mmu_get_response(uint8_t move)
  540. {
  541. get_response_print_info(move);
  542. KEEPALIVE_STATE(IN_PROCESS);
  543. while (mmu_cmd != MmuCmd::None)
  544. {
  545. delay_keep_alive(100);
  546. }
  547. while (!mmu_ready)
  548. {
  549. if ((mmu_state != S::WaitCmd) && (mmu_last_cmd == MmuCmd::None))
  550. break;
  551. switch (move) {
  552. case MMU_LOAD_MOVE:
  553. mmu_loading_flag = true;
  554. if (can_extrude()) mmu_load_step();
  555. //don't rely on "ok" signal from mmu unit; if filament detected by idler sensor during loading stop loading movements to prevent infinite loading
  556. if (READ(IR_SENSOR_PIN) == 0) move = MMU_NO_MOVE;
  557. break;
  558. case MMU_UNLOAD_MOVE:
  559. if (READ(IR_SENSOR_PIN) == 0) //filament is still detected by idler sensor, printer helps with unlading
  560. {
  561. if (can_extrude())
  562. {
  563. puts_P(PSTR("Unload 1"));
  564. current_position[E_AXIS] = current_position[E_AXIS] - MMU_LOAD_FEEDRATE * MMU_LOAD_TIME_MS*0.001;
  565. plan_buffer_line_curposXYZE(MMU_LOAD_FEEDRATE);
  566. st_synchronize();
  567. }
  568. }
  569. else //filament was unloaded from idler, no additional movements needed
  570. {
  571. puts_P(PSTR("Unloading finished 1"));
  572. disable_e0(); //turn off E-stepper to prevent overheating and alow filament pull-out if necessary
  573. move = MMU_NO_MOVE;
  574. }
  575. break;
  576. case MMU_TCODE_MOVE: //first do unload and then continue with infinite loading movements
  577. if (READ(IR_SENSOR_PIN) == 0) //filament detected by idler sensor, we must unload first
  578. {
  579. if (can_extrude())
  580. {
  581. puts_P(PSTR("Unload 2"));
  582. current_position[E_AXIS] = current_position[E_AXIS] - MMU_LOAD_FEEDRATE * MMU_LOAD_TIME_MS*0.001;
  583. plan_buffer_line_curposXYZE(MMU_LOAD_FEEDRATE);
  584. st_synchronize();
  585. }
  586. }
  587. else //delay to allow mmu unit to pull out filament from bondtech gears and then start with infinite loading
  588. {
  589. puts_P(PSTR("Unloading finished 2"));
  590. disable_e0(); //turn off E-stepper to prevent overheating and alow filament pull-out if necessary
  591. delay_keep_alive(MMU_LOAD_TIME_MS);
  592. move = MMU_LOAD_MOVE;
  593. get_response_print_info(move);
  594. }
  595. break;
  596. case MMU_NO_MOVE:
  597. default:
  598. delay_keep_alive(100);
  599. break;
  600. }
  601. }
  602. printf_P(PSTR("mmu_get_response() returning: %d\n"), mmu_ready);
  603. bool ret = mmu_ready;
  604. mmu_ready = false;
  605. // printf_P(PSTR("mmu_get_response - end %d\n"), ret?1:0);
  606. return ret;
  607. }
  608. //! @brief Wait for active extruder to reach temperature set
  609. //!
  610. //! This function is blocking and showing lcd_wait_for_heater() screen
  611. //! which is constantly updated with nozzle temperature.
  612. void mmu_wait_for_heater_blocking()
  613. {
  614. while ((degTargetHotend(active_extruder) - degHotend(active_extruder)) > 5)
  615. {
  616. delay_keep_alive(1000);
  617. lcd_wait_for_heater();
  618. }
  619. }
  620. void manage_response(bool move_axes, bool turn_off_nozzle, uint8_t move)
  621. {
  622. bool response = false;
  623. mmu_print_saved = false;
  624. bool lcd_update_was_enabled = false;
  625. float hotend_temp_bckp = degTargetHotend(active_extruder);
  626. float z_position_bckp = current_position[Z_AXIS];
  627. float x_position_bckp = current_position[X_AXIS];
  628. float y_position_bckp = current_position[Y_AXIS];
  629. uint8_t screen = 0; //used for showing multiscreen messages
  630. mmu_loading_flag = false;
  631. while(!response)
  632. {
  633. response = mmu_get_response(move); //wait for "ok" from mmu
  634. if (!response) { //no "ok" was received in reserved time frame, user will fix the issue on mmu unit
  635. if (!mmu_print_saved) { //first occurence, we are saving current position, park print head in certain position and disable nozzle heater
  636. uint8_t mmu_fail = eeprom_read_byte((uint8_t*)EEPROM_MMU_FAIL);
  637. uint16_t mmu_fail_tot = eeprom_read_word((uint16_t*)EEPROM_MMU_FAIL_TOT);
  638. if(mmu_fail < 255) eeprom_update_byte((uint8_t*)EEPROM_MMU_FAIL, mmu_fail + 1);
  639. if(mmu_fail_tot < 65535) eeprom_update_word((uint16_t*)EEPROM_MMU_FAIL_TOT, mmu_fail_tot + 1);
  640. if (lcd_update_enabled) {
  641. lcd_update_was_enabled = true;
  642. lcd_update_enable(false);
  643. }
  644. st_synchronize();
  645. mmu_print_saved = true;
  646. puts_P(PSTR("MMU not responding"));
  647. KEEPALIVE_STATE(PAUSED_FOR_USER);
  648. hotend_temp_bckp = degTargetHotend(active_extruder);
  649. if (move_axes) {
  650. z_position_bckp = current_position[Z_AXIS];
  651. x_position_bckp = current_position[X_AXIS];
  652. y_position_bckp = current_position[Y_AXIS];
  653. //lift z
  654. current_position[Z_AXIS] += Z_PAUSE_LIFT;
  655. if (current_position[Z_AXIS] > Z_MAX_POS) current_position[Z_AXIS] = Z_MAX_POS;
  656. plan_buffer_line_curposXYZE(15);
  657. st_synchronize();
  658. //Move XY to side
  659. current_position[X_AXIS] = X_PAUSE_POS;
  660. current_position[Y_AXIS] = Y_PAUSE_POS;
  661. plan_buffer_line_curposXYZE(50);
  662. st_synchronize();
  663. }
  664. if (turn_off_nozzle) {
  665. //set nozzle target temperature to 0
  666. setAllTargetHotends(0);
  667. }
  668. disable_e0(); //turn off E-stepper to prevent overheating and alow filament pull-out if necessary
  669. }
  670. //first three lines are used for printing multiscreen message; last line contains measured and target nozzle temperature
  671. if (screen == 0) { //screen 0
  672. lcd_display_message_fullscreen_P(_i("MMU needs user attention."));////MSG_MMU_USER_ATTENTION c=20 r=3
  673. screen++;
  674. }
  675. else { //screen 1
  676. if((degTargetHotend(active_extruder) == 0) && turn_off_nozzle) lcd_display_message_fullscreen_P(_i("Press the knob to resume nozzle temperature."));////MSG_RESUME_NOZZLE_TEMP c=20 r=4
  677. else lcd_display_message_fullscreen_P(_i("Fix the issue and then press button on MMU unit."));////MSG_MMU_FIX_ISSUE c=20 r=4
  678. screen=0;
  679. }
  680. lcd_set_degree();
  681. //5 seconds delay
  682. for (uint8_t i = 0; i < 5; i++) {
  683. if (lcd_clicked()) {
  684. setTargetHotend(hotend_temp_bckp, active_extruder);
  685. /// mmu_cmd = mmu_last_cmd;
  686. break;
  687. }
  688. //Print the hotend temperature (9 chars total) and fill rest of the line with space
  689. lcd_set_cursor(0, 4); //line 4
  690. int chars = lcd_printf_P(_N("%c%3d/%d%c"), LCD_STR_THERMOMETER[0],(int)(degHotend(active_extruder) + 0.5), (int)(degTargetHotend(active_extruder) + 0.5), LCD_STR_DEGREE[0]);
  691. lcd_space(9 - chars);
  692. delay_keep_alive(1000);
  693. }
  694. }
  695. else if (mmu_print_saved) {
  696. puts_P(PSTR("MMU starts responding"));
  697. KEEPALIVE_STATE(IN_HANDLER);
  698. mmu_loading_flag = false;
  699. if (turn_off_nozzle)
  700. {
  701. lcd_clear();
  702. setTargetHotend(hotend_temp_bckp, active_extruder);
  703. if (((degTargetHotend(active_extruder) - degHotend(active_extruder)) > 5)) {
  704. lcd_display_message_fullscreen_P(_i("MMU OK. Resuming temperature..."));
  705. delay_keep_alive(3000);
  706. }
  707. mmu_wait_for_heater_blocking();
  708. }
  709. if (move_axes) {
  710. lcd_clear();
  711. lcd_display_message_fullscreen_P(_i("MMU OK. Resuming position..."));
  712. current_position[X_AXIS] = x_position_bckp;
  713. current_position[Y_AXIS] = y_position_bckp;
  714. plan_buffer_line_curposXYZE(50);
  715. st_synchronize();
  716. current_position[Z_AXIS] = z_position_bckp;
  717. plan_buffer_line_curposXYZE(15);
  718. st_synchronize();
  719. }
  720. else {
  721. lcd_clear();
  722. lcd_display_message_fullscreen_P(_i("MMU OK. Resuming..."));
  723. delay_keep_alive(1000); //delay just for showing MMU OK message for a while in case that there are no xyz movements
  724. }
  725. }
  726. }
  727. if (lcd_update_was_enabled) lcd_update_enable(true);
  728. #ifdef TMC2130
  729. //enable extruder motor (disabled in mmu_command, start of T-code processing)
  730. tmc2130_set_pwr(E_AXIS, 1);
  731. //printf_P(PSTR("E-axis enabled\n"));
  732. #endif //TMC2130
  733. }
  734. //! @brief load filament to nozzle of multimaterial printer
  735. //!
  736. //! This function is used only only after T? (user select filament) and M600 (change filament).
  737. //! It is not used after T0 .. T4 command (select filament), in such case, gcode is responsible for loading
  738. //! filament to nozzle.
  739. //!
  740. void mmu_load_to_nozzle()
  741. {
  742. st_synchronize();
  743. const bool saved_e_relative_mode = axis_relative_modes & E_AXIS_MASK;
  744. if (!saved_e_relative_mode) axis_relative_modes |= E_AXIS_MASK;
  745. if (ir_sensor_detected)
  746. {
  747. current_position[E_AXIS] += 3.0f;
  748. }
  749. else
  750. {
  751. current_position[E_AXIS] += 7.2f;
  752. }
  753. float feedrate = 562;
  754. plan_buffer_line_curposXYZE(feedrate / 60);
  755. st_synchronize();
  756. current_position[E_AXIS] += 14.4f;
  757. feedrate = 871;
  758. plan_buffer_line_curposXYZE(feedrate / 60);
  759. st_synchronize();
  760. current_position[E_AXIS] += 36.0f;
  761. feedrate = 1393;
  762. plan_buffer_line_curposXYZE(feedrate / 60);
  763. st_synchronize();
  764. current_position[E_AXIS] += 14.4f;
  765. feedrate = 871;
  766. plan_buffer_line_curposXYZE(feedrate / 60);
  767. st_synchronize();
  768. if (!saved_e_relative_mode) axis_relative_modes &= ~E_AXIS_MASK;
  769. }
  770. void mmu_M600_wait_and_beep() {
  771. //Beep and wait for user to remove old filament and prepare new filament for load
  772. KEEPALIVE_STATE(PAUSED_FOR_USER);
  773. int counterBeep = 0;
  774. lcd_display_message_fullscreen_P(_i("Remove old filament and press the knob to start loading new filament.")); ////MSG_REMOVE_OLD_FILAMENT c=20 r=5
  775. bool bFirst=true;
  776. while (!lcd_clicked()){
  777. manage_heater();
  778. manage_inactivity(true);
  779. #if BEEPER > 0
  780. if (counterBeep == 500) {
  781. counterBeep = 0;
  782. }
  783. SET_OUTPUT(BEEPER);
  784. if (counterBeep == 0) {
  785. if((eSoundMode==e_SOUND_MODE_BLIND)|| (eSoundMode==e_SOUND_MODE_LOUD)||((eSoundMode==e_SOUND_MODE_ONCE)&&bFirst))
  786. {
  787. bFirst=false;
  788. WRITE(BEEPER, HIGH);
  789. }
  790. }
  791. if (counterBeep == 20) {
  792. WRITE(BEEPER, LOW);
  793. }
  794. counterBeep++;
  795. #endif //BEEPER > 0
  796. delay_keep_alive(4);
  797. }
  798. WRITE(BEEPER, LOW);
  799. }
  800. //! @brief load filament for mmu v2
  801. //! @par nozzle_temp nozzle temperature to load filament
  802. void mmu_M600_load_filament(bool automatic, float nozzle_temp)
  803. {
  804. tmp_extruder = mmu_extruder;
  805. if (!automatic)
  806. {
  807. #ifdef MMU_M600_SWITCH_EXTRUDER
  808. bool yes = lcd_show_fullscreen_message_yes_no_and_wait_P(_i("Do you want to switch extruder?"), false);
  809. if(yes) tmp_extruder = choose_extruder_menu();
  810. #endif //MMU_M600_SWITCH_EXTRUDER
  811. }
  812. else
  813. {
  814. tmp_extruder = ad_getAlternative(tmp_extruder);
  815. }
  816. lcd_update_enable(false);
  817. lcd_clear();
  818. lcd_puts_at_P(0, 1, _T(MSG_LOADING_FILAMENT));
  819. lcd_print(' ');
  820. lcd_print(tmp_extruder + 1);
  821. snmm_filaments_used |= (1 << tmp_extruder); //for stop print
  822. //printf_P(PSTR("T code: %d \n"), tmp_extruder);
  823. //mmu_printf_P(PSTR("T%d\n"), tmp_extruder);
  824. setTargetHotend(nozzle_temp,active_extruder);
  825. mmu_wait_for_heater_blocking();
  826. mmu_command(MmuCmd::T0 + tmp_extruder);
  827. manage_response(false, true, MMU_LOAD_MOVE);
  828. mmu_continue_loading(is_usb_printing || (lcd_commands_type == LcdCommands::Layer1Cal));
  829. mmu_extruder = tmp_extruder; //filament change is finished
  830. mmu_load_to_nozzle();
  831. load_filament_final_feed();
  832. st_synchronize();
  833. }
  834. #ifdef SNMM
  835. void extr_mov(float shift, float feed_rate)
  836. { //move extruder no matter what the current heater temperature is
  837. set_extrude_min_temp(.0);
  838. current_position[E_AXIS] += shift;
  839. plan_buffer_line_curposXYZE(feed_rate, active_extruder);
  840. set_extrude_min_temp(EXTRUDE_MINTEMP);
  841. }
  842. #endif //SNMM
  843. void change_extr(int
  844. #ifdef SNMM
  845. extr
  846. #endif //SNMM
  847. ) { //switches multiplexer for extruders
  848. #ifdef SNMM
  849. st_synchronize();
  850. _delay(100);
  851. disable_e0();
  852. disable_e1();
  853. disable_e2();
  854. mmu_extruder = extr;
  855. SET_OUTPUT(E_MUX0_PIN);
  856. SET_OUTPUT(E_MUX1_PIN);
  857. switch (extr) {
  858. case 1:
  859. WRITE(E_MUX0_PIN, HIGH);
  860. WRITE(E_MUX1_PIN, LOW);
  861. break;
  862. case 2:
  863. WRITE(E_MUX0_PIN, LOW);
  864. WRITE(E_MUX1_PIN, HIGH);
  865. break;
  866. case 3:
  867. WRITE(E_MUX0_PIN, HIGH);
  868. WRITE(E_MUX1_PIN, HIGH);
  869. break;
  870. default:
  871. WRITE(E_MUX0_PIN, LOW);
  872. WRITE(E_MUX1_PIN, LOW);
  873. break;
  874. }
  875. _delay(100);
  876. #endif
  877. }
  878. int get_ext_nr()
  879. { //reads multiplexer input pins and return current extruder number (counted from 0)
  880. #ifndef SNMM
  881. return(mmu_extruder); //update needed
  882. #else
  883. return(2 * READ(E_MUX1_PIN) + READ(E_MUX0_PIN));
  884. #endif
  885. }
  886. void display_loading()
  887. {
  888. switch (mmu_extruder)
  889. {
  890. case 1: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T1)); break;
  891. case 2: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T2)); break;
  892. case 3: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T3)); break;
  893. default: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T0)); break;
  894. }
  895. }
  896. void extr_adj(uint8_t extruder) //loading filament for SNMM
  897. {
  898. #ifndef SNMM
  899. MmuCmd cmd = MmuCmd::L0 + extruder;
  900. if (extruder > (MmuCmd::L4 - MmuCmd::L0))
  901. {
  902. printf_P(PSTR("Filament out of range %d \n"),extruder);
  903. return;
  904. }
  905. mmu_command(cmd);
  906. //show which filament is currently loaded
  907. lcd_update_enable(false);
  908. lcd_clear();
  909. lcd_puts_at_P(0, 1, _T(MSG_LOADING_FILAMENT));
  910. //if(strlen(_T(MSG_LOADING_FILAMENT))>18) lcd.setCursor(0, 1);
  911. //else lcd.print(" ");
  912. lcd_print(' ');
  913. lcd_print(extruder + 1);
  914. // get response
  915. manage_response(false, false);
  916. lcd_update_enable(true);
  917. //lcd_return_to_status();
  918. #else
  919. bool correct;
  920. max_feedrate[E_AXIS] =80;
  921. //max_feedrate[E_AXIS] = 50;
  922. START:
  923. lcd_clear();
  924. lcd_set_cursor(0, 0);
  925. switch (extruder) {
  926. case 1: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T1)); break;
  927. case 2: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T2)); break;
  928. case 3: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T3)); break;
  929. default: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T0)); break;
  930. }
  931. KEEPALIVE_STATE(PAUSED_FOR_USER);
  932. do{
  933. extr_mov(0.001,1000);
  934. delay_keep_alive(2);
  935. } while (!lcd_clicked());
  936. //delay_keep_alive(500);
  937. KEEPALIVE_STATE(IN_HANDLER);
  938. st_synchronize();
  939. //correct = lcd_show_fullscreen_message_yes_no_and_wait_P(MSG_FIL_LOADED_CHECK, false);
  940. //if (!correct) goto START;
  941. //extr_mov(BOWDEN_LENGTH/2.f, 500); //dividing by 2 is there because of max. extrusion length limitation (x_max + y_max)
  942. //extr_mov(BOWDEN_LENGTH/2.f, 500);
  943. extr_mov(bowden_length[extruder], 500);
  944. lcd_clear();
  945. lcd_set_cursor(0, 0); lcd_puts_P(_T(MSG_LOADING_FILAMENT));
  946. if(strlen(_T(MSG_LOADING_FILAMENT))>18) lcd_set_cursor(0, 1);
  947. else lcd_print(' ');
  948. lcd_print(mmu_extruder + 1);
  949. lcd_set_cursor(0, 2); lcd_puts_P(_T(MSG_PLEASE_WAIT));
  950. st_synchronize();
  951. max_feedrate[E_AXIS] = 50;
  952. lcd_update_enable(true);
  953. lcd_return_to_status();
  954. lcdDrawUpdate = 2;
  955. #endif
  956. }
  957. struct E_step
  958. {
  959. float extrude; //!< extrude distance in mm
  960. float feed_rate; //!< feed rate in mm/s
  961. };
  962. static const E_step ramming_sequence[] PROGMEM =
  963. {
  964. {1.0, 1000.0/60},
  965. {1.0, 1500.0/60},
  966. {2.0, 2000.0/60},
  967. {1.5, 3000.0/60},
  968. {2.5, 4000.0/60},
  969. {-15.0, 5000.0/60},
  970. {-14.0, 1200.0/60},
  971. {-6.0, 600.0/60},
  972. {10.0, 700.0/60},
  973. {-10.0, 400.0/60},
  974. {-50.0, 2000.0/60},
  975. };
  976. //! @brief Unload sequence to optimize shape of the tip of the unloaded filament
  977. void mmu_filament_ramming()
  978. {
  979. for(uint8_t i = 0; i < (sizeof(ramming_sequence)/sizeof(E_step));++i)
  980. {
  981. current_position[E_AXIS] += pgm_read_float(&(ramming_sequence[i].extrude));
  982. plan_buffer_line_curposXYZE(pgm_read_float(&(ramming_sequence[i].feed_rate)));
  983. st_synchronize();
  984. }
  985. }
  986. //! @brief show which filament is currently unloaded
  987. void extr_unload_view()
  988. {
  989. lcd_clear();
  990. lcd_puts_at_P(0, 1, _T(MSG_UNLOADING_FILAMENT));
  991. lcd_print(' ');
  992. if (mmu_extruder == MMU_FILAMENT_UNKNOWN) lcd_print(' ');
  993. else lcd_print(mmu_extruder + 1);
  994. }
  995. void extr_unload()
  996. { //unload just current filament for multimaterial printers
  997. #ifdef SNMM
  998. float tmp_motor[3] = DEFAULT_PWM_MOTOR_CURRENT;
  999. float tmp_motor_loud[3] = DEFAULT_PWM_MOTOR_CURRENT_LOUD;
  1000. uint8_t SilentMode = eeprom_read_byte((uint8_t*)EEPROM_SILENT);
  1001. #endif
  1002. if (degHotend0() > EXTRUDE_MINTEMP)
  1003. {
  1004. #ifndef SNMM
  1005. st_synchronize();
  1006. menu_submenu(extr_unload_view);
  1007. mmu_filament_ramming();
  1008. mmu_command(MmuCmd::U0);
  1009. // get response
  1010. manage_response(false, true, MMU_UNLOAD_MOVE);
  1011. menu_back();
  1012. #else //SNMM
  1013. lcd_clear();
  1014. lcd_display_message_fullscreen_P(PSTR(""));
  1015. max_feedrate[E_AXIS] = 50;
  1016. lcd_set_cursor(0, 0); lcd_puts_P(_T(MSG_UNLOADING_FILAMENT));
  1017. lcd_print(' ');
  1018. lcd_print(mmu_extruder + 1);
  1019. lcd_set_cursor(0, 2); lcd_puts_P(_T(MSG_PLEASE_WAIT));
  1020. if (current_position[Z_AXIS] < 15) {
  1021. current_position[Z_AXIS] += 15; //lifting in Z direction to make space for extrusion
  1022. plan_buffer_line_curposXYZE(25, active_extruder);
  1023. }
  1024. current_position[E_AXIS] += 10; //extrusion
  1025. plan_buffer_line_curposXYZE(10, active_extruder);
  1026. st_current_set(2, E_MOTOR_HIGH_CURRENT);
  1027. if (current_temperature[0] < 230) { //PLA & all other filaments
  1028. current_position[E_AXIS] += 5.4;
  1029. plan_buffer_line_curposXYZE(2800 / 60, active_extruder);
  1030. current_position[E_AXIS] += 3.2;
  1031. plan_buffer_line_curposXYZE(3000 / 60, active_extruder);
  1032. current_position[E_AXIS] += 3;
  1033. plan_buffer_line_curposXYZE(3400 / 60, active_extruder);
  1034. }
  1035. else { //ABS
  1036. current_position[E_AXIS] += 3.1;
  1037. plan_buffer_line_curposXYZE(2000 / 60, active_extruder);
  1038. current_position[E_AXIS] += 3.1;
  1039. plan_buffer_line_curposXYZE(2500 / 60, active_extruder);
  1040. current_position[E_AXIS] += 4;
  1041. plan_buffer_line_curposXYZE(3000 / 60, active_extruder);
  1042. /*current_position[X_AXIS] += 23; //delay
  1043. plan_buffer_line_curposXYZE(600 / 60, active_extruder); //delay
  1044. current_position[X_AXIS] -= 23; //delay
  1045. plan_buffer_line_curposXYZE(600 / 60, active_extruder); //delay*/
  1046. delay_keep_alive(4700);
  1047. }
  1048. max_feedrate[E_AXIS] = 80;
  1049. current_position[E_AXIS] -= (bowden_length[mmu_extruder] + 60 + FIL_LOAD_LENGTH) / 2;
  1050. plan_buffer_line_curposXYZE(500, active_extruder);
  1051. current_position[E_AXIS] -= (bowden_length[mmu_extruder] + 60 + FIL_LOAD_LENGTH) / 2;
  1052. plan_buffer_line_curposXYZE(500, active_extruder);
  1053. st_synchronize();
  1054. //st_current_init();
  1055. if (SilentMode != SILENT_MODE_OFF) st_current_set(2, tmp_motor[2]); //set back to normal operation currents
  1056. else st_current_set(2, tmp_motor_loud[2]);
  1057. lcd_update_enable(true);
  1058. lcd_return_to_status();
  1059. max_feedrate[E_AXIS] = 50;
  1060. #endif //SNMM
  1061. }
  1062. else
  1063. {
  1064. show_preheat_nozzle_warning();
  1065. }
  1066. }
  1067. //wrapper functions for loading filament
  1068. void extr_adj_0()
  1069. {
  1070. #ifndef SNMM
  1071. enquecommand_P(PSTR("M701 E0"));
  1072. #else
  1073. change_extr(0);
  1074. extr_adj(0);
  1075. #endif
  1076. }
  1077. void extr_adj_1()
  1078. {
  1079. #ifndef SNMM
  1080. enquecommand_P(PSTR("M701 E1"));
  1081. #else
  1082. change_extr(1);
  1083. extr_adj(1);
  1084. #endif
  1085. }
  1086. void extr_adj_2()
  1087. {
  1088. #ifndef SNMM
  1089. enquecommand_P(PSTR("M701 E2"));
  1090. #else
  1091. change_extr(2);
  1092. extr_adj(2);
  1093. #endif
  1094. }
  1095. void extr_adj_3()
  1096. {
  1097. #ifndef SNMM
  1098. enquecommand_P(PSTR("M701 E3"));
  1099. #else
  1100. change_extr(3);
  1101. extr_adj(3);
  1102. #endif
  1103. }
  1104. void extr_adj_4()
  1105. {
  1106. #ifndef SNMM
  1107. enquecommand_P(PSTR("M701 E4"));
  1108. #else
  1109. change_extr(4);
  1110. extr_adj(4);
  1111. #endif
  1112. }
  1113. void load_all()
  1114. {
  1115. #ifndef SNMM
  1116. enquecommand_P(PSTR("M701 E0"));
  1117. enquecommand_P(PSTR("M701 E1"));
  1118. enquecommand_P(PSTR("M701 E2"));
  1119. enquecommand_P(PSTR("M701 E3"));
  1120. enquecommand_P(PSTR("M701 E4"));
  1121. #else
  1122. for (int i = 0; i < 4; i++)
  1123. {
  1124. change_extr(i);
  1125. extr_adj(i);
  1126. }
  1127. #endif
  1128. }
  1129. //wrapper functions for changing extruders
  1130. void extr_change_0()
  1131. {
  1132. change_extr(0);
  1133. lcd_return_to_status();
  1134. }
  1135. void extr_change_1()
  1136. {
  1137. change_extr(1);
  1138. lcd_return_to_status();
  1139. }
  1140. void extr_change_2()
  1141. {
  1142. change_extr(2);
  1143. lcd_return_to_status();
  1144. }
  1145. void extr_change_3()
  1146. {
  1147. change_extr(3);
  1148. lcd_return_to_status();
  1149. }
  1150. #ifdef SNMM
  1151. //wrapper functions for unloading filament
  1152. void extr_unload_all()
  1153. {
  1154. if (degHotend0() > EXTRUDE_MINTEMP)
  1155. {
  1156. for (int i = 0; i < 4; i++)
  1157. {
  1158. change_extr(i);
  1159. extr_unload();
  1160. }
  1161. }
  1162. else
  1163. {
  1164. show_preheat_nozzle_warning();
  1165. lcd_return_to_status();
  1166. }
  1167. }
  1168. //unloading just used filament (for snmm)
  1169. void extr_unload_used()
  1170. {
  1171. if (degHotend0() > EXTRUDE_MINTEMP) {
  1172. for (int i = 0; i < 4; i++) {
  1173. if (snmm_filaments_used & (1 << i)) {
  1174. change_extr(i);
  1175. extr_unload();
  1176. }
  1177. }
  1178. snmm_filaments_used = 0;
  1179. }
  1180. else {
  1181. show_preheat_nozzle_warning();
  1182. lcd_return_to_status();
  1183. }
  1184. }
  1185. #endif //SNMM
  1186. void extr_unload_0()
  1187. {
  1188. change_extr(0);
  1189. extr_unload();
  1190. }
  1191. void extr_unload_1()
  1192. {
  1193. change_extr(1);
  1194. extr_unload();
  1195. }
  1196. void extr_unload_2()
  1197. {
  1198. change_extr(2);
  1199. extr_unload();
  1200. }
  1201. void extr_unload_3()
  1202. {
  1203. change_extr(3);
  1204. extr_unload();
  1205. }
  1206. void extr_unload_4()
  1207. {
  1208. change_extr(4);
  1209. extr_unload();
  1210. }
  1211. bool mmu_check_version()
  1212. {
  1213. return (mmu_buildnr >= MMU_REQUIRED_FW_BUILDNR);
  1214. }
  1215. void mmu_show_warning()
  1216. {
  1217. printf_P(PSTR("MMU2 firmware version invalid. Required version: build number %d or higher."), MMU_REQUIRED_FW_BUILDNR);
  1218. kill(_i("Please update firmware in your MMU2. Waiting for reset."));
  1219. }
  1220. void lcd_mmu_load_to_nozzle(uint8_t filament_nr)
  1221. {
  1222. menu_back();
  1223. bFilamentAction = false; // NOT in "mmu_load_to_nozzle_menu()"
  1224. if (degHotend0() > EXTRUDE_MINTEMP)
  1225. {
  1226. tmp_extruder = filament_nr;
  1227. lcd_update_enable(false);
  1228. lcd_clear();
  1229. lcd_puts_at_P(0, 1, _T(MSG_LOADING_FILAMENT));
  1230. lcd_print(' ');
  1231. lcd_print(tmp_extruder + 1);
  1232. mmu_command(MmuCmd::T0 + tmp_extruder);
  1233. manage_response(true, true, MMU_TCODE_MOVE);
  1234. mmu_continue_loading(false);
  1235. mmu_extruder = tmp_extruder; //filament change is finished
  1236. raise_z_above(MIN_Z_FOR_LOAD, false);
  1237. mmu_load_to_nozzle();
  1238. load_filament_final_feed();
  1239. st_synchronize();
  1240. custom_message_type = CustomMsg::FilamentLoading;
  1241. lcd_setstatuspgm(_T(MSG_LOADING_FILAMENT));
  1242. lcd_return_to_status();
  1243. lcd_update_enable(true);
  1244. lcd_load_filament_color_check();
  1245. lcd_setstatuspgm(_T(WELCOME_MSG));
  1246. custom_message_type = CustomMsg::Status;
  1247. }
  1248. else
  1249. {
  1250. show_preheat_nozzle_warning();
  1251. }
  1252. }
  1253. #ifdef MMU_HAS_CUTTER
  1254. void mmu_cut_filament(uint8_t filament_nr)
  1255. {
  1256. menu_back();
  1257. bFilamentAction=false; // NOT in "mmu_load_to_nozzle_menu()"
  1258. if (degHotend0() > EXTRUDE_MINTEMP)
  1259. {
  1260. LcdUpdateDisabler disableLcdUpdate;
  1261. lcd_clear();
  1262. lcd_puts_at_P(0, 1, _i("Cutting filament")); ////MSG_MMU_CUTTING_FIL c=18
  1263. lcd_print(' ');
  1264. lcd_print(filament_nr + 1);
  1265. mmu_filament_ramming();
  1266. mmu_command(MmuCmd::K0 + filament_nr);
  1267. manage_response(false, false, MMU_UNLOAD_MOVE);
  1268. }
  1269. else
  1270. {
  1271. show_preheat_nozzle_warning();
  1272. }
  1273. }
  1274. #endif //MMU_HAS_CUTTER
  1275. void mmu_eject_filament(uint8_t filament, bool recover)
  1276. {
  1277. //-//
  1278. bFilamentAction=false; // NOT in "mmu_fil_eject_menu()"
  1279. if (filament < 5)
  1280. {
  1281. if (degHotend0() > EXTRUDE_MINTEMP)
  1282. {
  1283. st_synchronize();
  1284. {
  1285. LcdUpdateDisabler disableLcdUpdate;
  1286. lcd_clear();
  1287. lcd_puts_at_P(0, 1, _i("Ejecting filament"));
  1288. mmu_filament_ramming();
  1289. mmu_command(MmuCmd::E0 + filament);
  1290. manage_response(false, false, MMU_UNLOAD_MOVE);
  1291. if (recover)
  1292. {
  1293. lcd_show_fullscreen_message_and_wait_P(_i("Please remove filament and then press the knob."));
  1294. mmu_command(MmuCmd::R0);
  1295. manage_response(false, false);
  1296. }
  1297. }
  1298. }
  1299. else
  1300. {
  1301. show_preheat_nozzle_warning();
  1302. }
  1303. }
  1304. else
  1305. {
  1306. puts_P(PSTR("Filament nr out of range!"));
  1307. }
  1308. }
  1309. //! @brief Fits filament tip into heatbreak?
  1310. //!
  1311. //! If PTFE tube is jammed, this causes filament to be unloaded and no longer
  1312. //! being detected by the pulley IR sensor.
  1313. //! @retval true Fits
  1314. //! @retval false Doesn't fit
  1315. static bool can_load()
  1316. {
  1317. current_position[E_AXIS] += 60;
  1318. plan_buffer_line_curposXYZE(MMU_LOAD_FEEDRATE);
  1319. current_position[E_AXIS] -= 52;
  1320. plan_buffer_line_curposXYZE(MMU_LOAD_FEEDRATE);
  1321. st_synchronize();
  1322. uint_least8_t filament_detected_count = 0;
  1323. const float e_increment = 0.2;
  1324. const uint_least8_t steps = 6.0 / e_increment;
  1325. DEBUG_PUTS_P(PSTR("MMU can_load:"));
  1326. for(uint_least8_t i = 0; i < steps; ++i)
  1327. {
  1328. current_position[E_AXIS] -= e_increment;
  1329. plan_buffer_line_curposXYZE(MMU_LOAD_FEEDRATE);
  1330. st_synchronize();
  1331. if(0 == READ(IR_SENSOR_PIN))
  1332. {
  1333. ++filament_detected_count;
  1334. DEBUG_PUTCHAR('O');
  1335. }
  1336. else
  1337. {
  1338. DEBUG_PUTCHAR('o');
  1339. }
  1340. }
  1341. if (filament_detected_count > steps - 4)
  1342. {
  1343. DEBUG_PUTS_P(PSTR(" succeeded."));
  1344. return true;
  1345. }
  1346. else
  1347. {
  1348. DEBUG_PUTS_P(PSTR(" failed."));
  1349. return false;
  1350. }
  1351. }
  1352. //! @brief load more
  1353. //!
  1354. //! Try to feed more filament from MMU if it is not detected by filament sensor.
  1355. //! @retval true Success, filament detected by IR sensor
  1356. //! @retval false Failed, filament not detected by IR sensor after maximum number of attempts
  1357. static bool load_more()
  1358. {
  1359. for (uint8_t i = 0; i < MMU_IDLER_SENSOR_ATTEMPTS_NR; i++)
  1360. {
  1361. if (READ(IR_SENSOR_PIN) == 0) return true;
  1362. DEBUG_PRINTF_P(PSTR("Additional load attempt nr. %d\n"), i);
  1363. mmu_command(MmuCmd::C0);
  1364. manage_response(true, true, MMU_LOAD_MOVE);
  1365. }
  1366. return false;
  1367. }
  1368. static void increment_load_fail()
  1369. {
  1370. uint8_t mmu_load_fail = eeprom_read_byte((uint8_t*)EEPROM_MMU_LOAD_FAIL);
  1371. uint16_t mmu_load_fail_tot = eeprom_read_word((uint16_t*)EEPROM_MMU_LOAD_FAIL_TOT);
  1372. if(mmu_load_fail < 255) eeprom_update_byte((uint8_t*)EEPROM_MMU_LOAD_FAIL, mmu_load_fail + 1);
  1373. if(mmu_load_fail_tot < 65535) eeprom_update_word((uint16_t*)EEPROM_MMU_LOAD_FAIL_TOT, mmu_load_fail_tot + 1);
  1374. }
  1375. //! @brief continue loading filament
  1376. //! @par blocking
  1377. //! * true blocking - do not return until successful load
  1378. //! * false non-blocking - pause print and return on load failure
  1379. //!
  1380. //! @startuml
  1381. //! [*] --> [*] : !ir_sensor_detected /\n send MmuCmd::C0
  1382. //! [*] --> LoadMore
  1383. //! LoadMore --> [*] : filament \ndetected
  1384. //! LoadMore --> Retry : !filament detected /\n increment load fail
  1385. //! Retry --> [*] : filament \ndetected
  1386. //! Retry --> Unload : !filament \ndetected
  1387. //! Unload --> [*] : non-blocking
  1388. //! Unload --> Retry : button \nclicked
  1389. //!
  1390. //! Retry : Cut filament if enabled
  1391. //! Retry : repeat last T-code
  1392. //! Unload : unload filament
  1393. //! Unload : pause print
  1394. //! Unload : show error message
  1395. //!
  1396. //! @enduml
  1397. void mmu_continue_loading(bool blocking)
  1398. {
  1399. if (!ir_sensor_detected)
  1400. {
  1401. mmu_command(MmuCmd::C0);
  1402. return;
  1403. }
  1404. bool success = load_more();
  1405. if (success) success = can_load();
  1406. enum class Ls : uint_least8_t
  1407. {
  1408. Enter,
  1409. Retry,
  1410. Unload,
  1411. };
  1412. Ls state = Ls::Enter;
  1413. const uint_least8_t max_retry = 3;
  1414. uint_least8_t retry = 0;
  1415. while (!success)
  1416. {
  1417. switch (state)
  1418. {
  1419. case Ls::Enter:
  1420. increment_load_fail();
  1421. // FALLTHRU
  1422. case Ls::Retry:
  1423. ++retry; // overflow not handled, as it is not dangerous.
  1424. if (retry >= max_retry)
  1425. {
  1426. state = Ls::Unload;
  1427. #ifdef MMU_HAS_CUTTER
  1428. if (1 == eeprom_read_byte((uint8_t*)EEPROM_MMU_CUTTER_ENABLED))
  1429. {
  1430. mmu_command(MmuCmd::K0 + tmp_extruder);
  1431. manage_response(true, true, MMU_UNLOAD_MOVE);
  1432. }
  1433. #endif //MMU_HAS_CUTTER
  1434. }
  1435. mmu_command(MmuCmd::T0 + tmp_extruder);
  1436. manage_response(true, true, MMU_TCODE_MOVE);
  1437. success = load_more();
  1438. if (success) success = can_load();
  1439. break;
  1440. case Ls::Unload:
  1441. stop_and_save_print_to_ram(0, 0);
  1442. long_pause();
  1443. mmu_command(MmuCmd::U0);
  1444. manage_response(false, true, MMU_UNLOAD_MOVE);
  1445. setAllTargetHotends(0);
  1446. lcd_setstatuspgm(_i("MMU load failed"));////MSG_MMU_LOAD_FAILED c=20
  1447. if (blocking)
  1448. {
  1449. marlin_wait_for_click();
  1450. st_synchronize();
  1451. restore_print_from_ram_and_continue(0);
  1452. state = Ls::Retry;
  1453. }
  1454. else
  1455. {
  1456. mmu_fil_loaded = false; //so we can retry same T-code again
  1457. isPrintPaused = true;
  1458. mmu_command(MmuCmd::W0);
  1459. return;
  1460. }
  1461. break;
  1462. }
  1463. }
  1464. }