My Marlin configs for Fabrikator Mini and CTC i3 Pro B
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

ultralcd.cpp 62KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835
  1. #include "temperature.h"
  2. #include "ultralcd.h"
  3. #ifdef ULTRA_LCD
  4. #include "Marlin.h"
  5. #include "language.h"
  6. #include "cardreader.h"
  7. #include "temperature.h"
  8. #include "stepper.h"
  9. #include "ConfigurationStore.h"
  10. int8_t encoderDiff; /* encoderDiff is updated from interrupt context and added to encoderPosition every LCD update */
  11. bool encoderRateMultiplierEnabled;
  12. int32_t lastEncoderMovementMillis;
  13. /* Configuration settings */
  14. int plaPreheatHotendTemp;
  15. int plaPreheatHPBTemp;
  16. int plaPreheatFanSpeed;
  17. int absPreheatHotendTemp;
  18. int absPreheatHPBTemp;
  19. int absPreheatFanSpeed;
  20. #ifdef FILAMENT_LCD_DISPLAY
  21. unsigned long message_millis = 0;
  22. #endif
  23. #ifdef ULTIPANEL
  24. static float manual_feedrate[] = MANUAL_FEEDRATE;
  25. #endif // ULTIPANEL
  26. /* !Configuration settings */
  27. //Function pointer to menu functions.
  28. typedef void (*menuFunc_t)();
  29. uint8_t lcd_status_message_level;
  30. char lcd_status_message[LCD_WIDTH+1] = WELCOME_MSG;
  31. #ifdef DOGLCD
  32. #include "dogm_lcd_implementation.h"
  33. #else
  34. #include "ultralcd_implementation_hitachi_HD44780.h"
  35. #endif
  36. /* Different menus */
  37. static void lcd_status_screen();
  38. #ifdef ULTIPANEL
  39. extern bool powersupply;
  40. static void lcd_main_menu();
  41. static void lcd_tune_menu();
  42. static void lcd_prepare_menu();
  43. static void lcd_move_menu();
  44. static void lcd_control_menu();
  45. static void lcd_control_temperature_menu();
  46. static void lcd_control_temperature_preheat_pla_settings_menu();
  47. static void lcd_control_temperature_preheat_abs_settings_menu();
  48. static void lcd_control_motion_menu();
  49. static void lcd_control_volumetric_menu();
  50. #ifdef DOGLCD
  51. static void lcd_set_contrast();
  52. #endif
  53. static void lcd_control_retract_menu();
  54. static void lcd_sdcard_menu();
  55. #ifdef DELTA_CALIBRATION_MENU
  56. static void lcd_delta_calibrate_menu();
  57. #endif // DELTA_CALIBRATION_MENU
  58. #if defined(MANUAL_BED_LEVELING)
  59. #include "mesh_bed_leveling.h"
  60. static void _lcd_level_bed();
  61. static void _lcd_level_bed_homing();
  62. static void lcd_level_bed();
  63. #endif // MANUAL_BED_LEVELING
  64. static void lcd_quick_feedback();//Cause an LCD refresh, and give the user visual or audible feedback that something has happened
  65. /* Different types of actions that can be used in menu items. */
  66. static void menu_action_back(menuFunc_t data);
  67. static void menu_action_submenu(menuFunc_t data);
  68. static void menu_action_gcode(const char* pgcode);
  69. static void menu_action_function(menuFunc_t data);
  70. static void menu_action_sdfile(const char* filename, char* longFilename);
  71. static void menu_action_sddirectory(const char* filename, char* longFilename);
  72. static void menu_action_setting_edit_bool(const char* pstr, bool* ptr);
  73. static void menu_action_setting_edit_int3(const char* pstr, int* ptr, int minValue, int maxValue);
  74. static void menu_action_setting_edit_float3(const char* pstr, float* ptr, float minValue, float maxValue);
  75. static void menu_action_setting_edit_float32(const char* pstr, float* ptr, float minValue, float maxValue);
  76. static void menu_action_setting_edit_float43(const char* pstr, float* ptr, float minValue, float maxValue);
  77. static void menu_action_setting_edit_float5(const char* pstr, float* ptr, float minValue, float maxValue);
  78. static void menu_action_setting_edit_float51(const char* pstr, float* ptr, float minValue, float maxValue);
  79. static void menu_action_setting_edit_float52(const char* pstr, float* ptr, float minValue, float maxValue);
  80. static void menu_action_setting_edit_long5(const char* pstr, unsigned long* ptr, unsigned long minValue, unsigned long maxValue);
  81. static void menu_action_setting_edit_callback_bool(const char* pstr, bool* ptr, menuFunc_t callbackFunc);
  82. static void menu_action_setting_edit_callback_int3(const char* pstr, int* ptr, int minValue, int maxValue, menuFunc_t callbackFunc);
  83. static void menu_action_setting_edit_callback_float3(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
  84. static void menu_action_setting_edit_callback_float32(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
  85. static void menu_action_setting_edit_callback_float43(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
  86. static void menu_action_setting_edit_callback_float5(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
  87. static void menu_action_setting_edit_callback_float51(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
  88. static void menu_action_setting_edit_callback_float52(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
  89. static void menu_action_setting_edit_callback_long5(const char* pstr, unsigned long* ptr, unsigned long minValue, unsigned long maxValue, menuFunc_t callbackFunc);
  90. #define ENCODER_FEEDRATE_DEADZONE 10
  91. #if !defined(LCD_I2C_VIKI)
  92. #ifndef ENCODER_STEPS_PER_MENU_ITEM
  93. #define ENCODER_STEPS_PER_MENU_ITEM 5
  94. #endif
  95. #ifndef ENCODER_PULSES_PER_STEP
  96. #define ENCODER_PULSES_PER_STEP 1
  97. #endif
  98. #else
  99. #ifndef ENCODER_STEPS_PER_MENU_ITEM
  100. #define ENCODER_STEPS_PER_MENU_ITEM 2 // VIKI LCD rotary encoder uses a different number of steps per rotation
  101. #endif
  102. #ifndef ENCODER_PULSES_PER_STEP
  103. #define ENCODER_PULSES_PER_STEP 1
  104. #endif
  105. #endif
  106. /* Helper macros for menus */
  107. #define START_MENU() do { \
  108. encoderRateMultiplierEnabled = false; \
  109. if (encoderPosition > 0x8000) encoderPosition = 0; \
  110. if (encoderPosition / ENCODER_STEPS_PER_MENU_ITEM < currentMenuViewOffset) currentMenuViewOffset = encoderPosition / ENCODER_STEPS_PER_MENU_ITEM;\
  111. uint8_t _lineNr = currentMenuViewOffset, _menuItemNr; \
  112. bool wasClicked = LCD_CLICKED;\
  113. for(uint8_t _drawLineNr = 0; _drawLineNr < LCD_HEIGHT; _drawLineNr++, _lineNr++) { \
  114. _menuItemNr = 0;
  115. #define MENU_ITEM(type, label, args...) do { \
  116. if (_menuItemNr == _lineNr) { \
  117. if (lcdDrawUpdate) { \
  118. const char* _label_pstr = PSTR(label); \
  119. if ((encoderPosition / ENCODER_STEPS_PER_MENU_ITEM) == _menuItemNr) { \
  120. lcd_implementation_drawmenu_ ## type ## _selected (_drawLineNr, _label_pstr , ## args ); \
  121. }else{\
  122. lcd_implementation_drawmenu_ ## type (_drawLineNr, _label_pstr , ## args ); \
  123. }\
  124. }\
  125. if (wasClicked && (encoderPosition / ENCODER_STEPS_PER_MENU_ITEM) == _menuItemNr) {\
  126. lcd_quick_feedback(); \
  127. menu_action_ ## type ( args ); \
  128. return;\
  129. }\
  130. }\
  131. _menuItemNr++;\
  132. } while(0)
  133. #ifdef ENCODER_RATE_MULTIPLIER
  134. #define MENU_MULTIPLIER_ITEM(type, label, args...) do { \
  135. if (_menuItemNr == _lineNr) { \
  136. if (lcdDrawUpdate) { \
  137. const char* _label_pstr = PSTR(label); \
  138. if ((encoderPosition / ENCODER_STEPS_PER_MENU_ITEM) == _menuItemNr) { \
  139. lcd_implementation_drawmenu_ ## type ## _selected (_drawLineNr, _label_pstr , ## args ); \
  140. } \
  141. else { \
  142. lcd_implementation_drawmenu_ ## type (_drawLineNr, _label_pstr , ## args ); \
  143. } \
  144. } \
  145. if (wasClicked && (encoderPosition / ENCODER_STEPS_PER_MENU_ITEM) == _menuItemNr) { \
  146. lcd_quick_feedback(); \
  147. encoderRateMultiplierEnabled = true; \
  148. lastEncoderMovementMillis = 0; \
  149. menu_action_ ## type ( args ); \
  150. return; \
  151. } \
  152. } \
  153. _menuItemNr++; \
  154. } while(0)
  155. #endif //ENCODER_RATE_MULTIPLIER
  156. #define MENU_ITEM_DUMMY() do { _menuItemNr++; } while(0)
  157. #define MENU_ITEM_EDIT(type, label, args...) MENU_ITEM(setting_edit_ ## type, label, PSTR(label) , ## args )
  158. #define MENU_ITEM_EDIT_CALLBACK(type, label, args...) MENU_ITEM(setting_edit_callback_ ## type, label, PSTR(label) , ## args )
  159. #ifdef ENCODER_RATE_MULTIPLIER
  160. #define MENU_MULTIPLIER_ITEM_EDIT(type, label, args...) MENU_MULTIPLIER_ITEM(setting_edit_ ## type, label, PSTR(label) , ## args )
  161. #define MENU_MULTIPLIER_ITEM_EDIT_CALLBACK(type, label, args...) MENU_MULTIPLIER_ITEM(setting_edit_callback_ ## type, label, PSTR(label) , ## args )
  162. #else //!ENCODER_RATE_MULTIPLIER
  163. #define MENU_MULTIPLIER_ITEM_EDIT(type, label, args...) MENU_ITEM(setting_edit_ ## type, label, PSTR(label) , ## args )
  164. #define MENU_MULTIPLIER_ITEM_EDIT_CALLBACK(type, label, args...) MENU_ITEM(setting_edit_callback_ ## type, label, PSTR(label) , ## args )
  165. #endif //!ENCODER_RATE_MULTIPLIER
  166. #define END_MENU() \
  167. if (encoderPosition / ENCODER_STEPS_PER_MENU_ITEM >= _menuItemNr) encoderPosition = _menuItemNr * ENCODER_STEPS_PER_MENU_ITEM - 1; \
  168. if ((uint8_t)(encoderPosition / ENCODER_STEPS_PER_MENU_ITEM) >= currentMenuViewOffset + LCD_HEIGHT) { currentMenuViewOffset = (encoderPosition / ENCODER_STEPS_PER_MENU_ITEM) - LCD_HEIGHT + 1; lcdDrawUpdate = 1; _lineNr = currentMenuViewOffset - 1; _drawLineNr = -1; } \
  169. } } while(0)
  170. /** Used variables to keep track of the menu */
  171. #ifndef REPRAPWORLD_KEYPAD
  172. volatile uint8_t buttons;//Contains the bits of the currently pressed buttons.
  173. #else
  174. volatile uint8_t buttons_reprapworld_keypad; // to store the reprapworld_keypad shift register values
  175. #endif
  176. #ifdef LCD_HAS_SLOW_BUTTONS
  177. volatile uint8_t slow_buttons;//Contains the bits of the currently pressed buttons.
  178. #endif
  179. uint8_t currentMenuViewOffset; /* scroll offset in the current menu */
  180. uint32_t blocking_enc;
  181. uint8_t lastEncoderBits;
  182. uint32_t encoderPosition;
  183. #if (SDCARDDETECT > 0)
  184. bool lcd_oldcardstatus;
  185. #endif
  186. #endif //ULTIPANEL
  187. menuFunc_t currentMenu = lcd_status_screen; /* function pointer to the currently active menu */
  188. uint32_t lcd_next_update_millis;
  189. uint8_t lcd_status_update_delay;
  190. bool ignore_click = false;
  191. bool wait_for_unclick;
  192. uint8_t lcdDrawUpdate = 2; /* Set to none-zero when the LCD needs to draw, decreased after every draw. Set to 2 in LCD routines so the LCD gets at least 1 full redraw (first redraw is partial) */
  193. //prevMenu and prevEncoderPosition are used to store the previous menu location when editing settings.
  194. menuFunc_t prevMenu = NULL;
  195. uint16_t prevEncoderPosition;
  196. //Variables used when editing values.
  197. const char* editLabel;
  198. void* editValue;
  199. int32_t minEditValue, maxEditValue;
  200. menuFunc_t callbackFunc;
  201. // place-holders for Ki and Kd edits
  202. float raw_Ki, raw_Kd;
  203. static void lcd_goto_menu(menuFunc_t menu, const uint32_t encoder=0, const bool feedback=true) {
  204. if (currentMenu != menu) {
  205. currentMenu = menu;
  206. encoderPosition = encoder;
  207. if (feedback) lcd_quick_feedback();
  208. // For LCD_PROGRESS_BAR re-initialize the custom characters
  209. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT) && !defined(DOGLCD)
  210. lcd_set_custom_characters(menu == lcd_status_screen);
  211. #endif
  212. }
  213. }
  214. /* Main status screen. It's up to the implementation specific part to show what is needed. As this is very display dependent */
  215. static void lcd_status_screen()
  216. {
  217. encoderRateMultiplierEnabled = false;
  218. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT) && !defined(DOGLCD)
  219. uint16_t mil = millis();
  220. #ifndef PROGRESS_MSG_ONCE
  221. if (mil > progressBarTick + PROGRESS_BAR_MSG_TIME + PROGRESS_BAR_BAR_TIME) {
  222. progressBarTick = mil;
  223. }
  224. #endif
  225. #if PROGRESS_MSG_EXPIRE > 0
  226. // keep the message alive if paused, count down otherwise
  227. if (messageTick > 0) {
  228. if (card.isFileOpen()) {
  229. if (IS_SD_PRINTING) {
  230. if ((mil-messageTick) >= PROGRESS_MSG_EXPIRE) {
  231. lcd_status_message[0] = '\0';
  232. messageTick = 0;
  233. }
  234. }
  235. else {
  236. messageTick += LCD_UPDATE_INTERVAL;
  237. }
  238. }
  239. else {
  240. messageTick = 0;
  241. }
  242. }
  243. #endif
  244. #endif //LCD_PROGRESS_BAR
  245. if (lcd_status_update_delay)
  246. lcd_status_update_delay--;
  247. else
  248. lcdDrawUpdate = 1;
  249. if (lcdDrawUpdate) {
  250. lcd_implementation_status_screen();
  251. lcd_status_update_delay = 10; /* redraw the main screen every second. This is easier then trying keep track of all things that change on the screen */
  252. }
  253. #ifdef ULTIPANEL
  254. bool current_click = LCD_CLICKED;
  255. if (ignore_click) {
  256. if (wait_for_unclick) {
  257. if (!current_click) {
  258. ignore_click = wait_for_unclick = false;
  259. }
  260. else {
  261. current_click = false;
  262. }
  263. }
  264. else if (current_click) {
  265. lcd_quick_feedback();
  266. wait_for_unclick = true;
  267. current_click = false;
  268. }
  269. }
  270. if (current_click)
  271. {
  272. lcd_goto_menu(lcd_main_menu);
  273. lcd_implementation_init( // to maybe revive the LCD if static electricity killed it.
  274. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT) && !defined(DOGLCD)
  275. currentMenu == lcd_status_screen
  276. #endif
  277. );
  278. #ifdef FILAMENT_LCD_DISPLAY
  279. message_millis = millis(); // get status message to show up for a while
  280. #endif
  281. }
  282. #ifdef ULTIPANEL_FEEDMULTIPLY
  283. // Dead zone at 100% feedrate
  284. if ((feedmultiply < 100 && (feedmultiply + int(encoderPosition)) > 100) ||
  285. (feedmultiply > 100 && (feedmultiply + int(encoderPosition)) < 100))
  286. {
  287. encoderPosition = 0;
  288. feedmultiply = 100;
  289. }
  290. if (feedmultiply == 100 && int(encoderPosition) > ENCODER_FEEDRATE_DEADZONE)
  291. {
  292. feedmultiply += int(encoderPosition) - ENCODER_FEEDRATE_DEADZONE;
  293. encoderPosition = 0;
  294. }
  295. else if (feedmultiply == 100 && int(encoderPosition) < -ENCODER_FEEDRATE_DEADZONE)
  296. {
  297. feedmultiply += int(encoderPosition) + ENCODER_FEEDRATE_DEADZONE;
  298. encoderPosition = 0;
  299. }
  300. else if (feedmultiply != 100)
  301. {
  302. feedmultiply += int(encoderPosition);
  303. encoderPosition = 0;
  304. }
  305. #endif //ULTIPANEL_FEEDMULTIPLY
  306. if (feedmultiply < 10)
  307. feedmultiply = 10;
  308. else if (feedmultiply > 999)
  309. feedmultiply = 999;
  310. #endif //ULTIPANEL
  311. }
  312. #ifdef ULTIPANEL
  313. static void lcd_return_to_status() { lcd_goto_menu(lcd_status_screen, 0, false); }
  314. static void lcd_sdcard_pause() { card.pauseSDPrint(); }
  315. static void lcd_sdcard_resume() { card.startFileprint(); }
  316. static void lcd_sdcard_stop() {
  317. card.sdprinting = false;
  318. card.closefile();
  319. quickStop();
  320. if (SD_FINISHED_STEPPERRELEASE) {
  321. enquecommands_P(PSTR(SD_FINISHED_RELEASECOMMAND));
  322. }
  323. autotempShutdown();
  324. cancel_heatup = true;
  325. lcd_setstatus(MSG_PRINT_ABORTED);
  326. }
  327. /* Menu implementation */
  328. static void lcd_main_menu() {
  329. START_MENU();
  330. MENU_ITEM(back, MSG_WATCH, lcd_status_screen);
  331. if (movesplanned() || IS_SD_PRINTING) {
  332. MENU_ITEM(submenu, MSG_TUNE, lcd_tune_menu);
  333. }
  334. else {
  335. MENU_ITEM(submenu, MSG_PREPARE, lcd_prepare_menu);
  336. #ifdef DELTA_CALIBRATION_MENU
  337. MENU_ITEM(submenu, MSG_DELTA_CALIBRATE, lcd_delta_calibrate_menu);
  338. #endif
  339. }
  340. MENU_ITEM(submenu, MSG_CONTROL, lcd_control_menu);
  341. #ifdef SDSUPPORT
  342. if (card.cardOK) {
  343. if (card.isFileOpen()) {
  344. if (card.sdprinting)
  345. MENU_ITEM(function, MSG_PAUSE_PRINT, lcd_sdcard_pause);
  346. else
  347. MENU_ITEM(function, MSG_RESUME_PRINT, lcd_sdcard_resume);
  348. MENU_ITEM(function, MSG_STOP_PRINT, lcd_sdcard_stop);
  349. }
  350. else {
  351. MENU_ITEM(submenu, MSG_CARD_MENU, lcd_sdcard_menu);
  352. #if SDCARDDETECT < 1
  353. MENU_ITEM(gcode, MSG_CNG_SDCARD, PSTR("M21")); // SD-card changed by user
  354. #endif
  355. }
  356. }
  357. else {
  358. MENU_ITEM(submenu, MSG_NO_CARD, lcd_sdcard_menu);
  359. #if SDCARDDETECT < 1
  360. MENU_ITEM(gcode, MSG_INIT_SDCARD, PSTR("M21")); // Manually initialize the SD-card via user interface
  361. #endif
  362. }
  363. #endif //SDSUPPORT
  364. END_MENU();
  365. }
  366. #ifdef SDSUPPORT
  367. static void lcd_autostart_sd() {
  368. card.autostart_index = 0;
  369. card.setroot();
  370. card.checkautostart(true);
  371. }
  372. #endif
  373. void lcd_set_home_offsets() {
  374. for(int8_t i=0; i < NUM_AXIS; i++) {
  375. if (i != E_AXIS) {
  376. add_homing[i] -= current_position[i];
  377. current_position[i] = 0.0;
  378. }
  379. }
  380. plan_set_position(0.0, 0.0, 0.0, current_position[E_AXIS]);
  381. // Audio feedback
  382. enquecommands_P(PSTR("M300 S659 P200\nM300 S698 P200"));
  383. lcd_return_to_status();
  384. }
  385. #ifdef BABYSTEPPING
  386. static void _lcd_babystep(int axis, const char *msg) {
  387. if (encoderPosition != 0) {
  388. babystepsTodo[axis] += (int)encoderPosition;
  389. encoderPosition = 0;
  390. lcdDrawUpdate = 1;
  391. }
  392. if (lcdDrawUpdate) lcd_implementation_drawedit(msg, "");
  393. if (LCD_CLICKED) lcd_goto_menu(lcd_tune_menu);
  394. }
  395. static void lcd_babystep_x() { _lcd_babystep(X_AXIS, PSTR(MSG_BABYSTEPPING_X)); }
  396. static void lcd_babystep_y() { _lcd_babystep(Y_AXIS, PSTR(MSG_BABYSTEPPING_Y)); }
  397. static void lcd_babystep_z() { _lcd_babystep(Z_AXIS, PSTR(MSG_BABYSTEPPING_Z)); }
  398. #endif //BABYSTEPPING
  399. static void lcd_tune_menu() {
  400. START_MENU();
  401. MENU_ITEM(back, MSG_MAIN, lcd_main_menu);
  402. MENU_ITEM_EDIT(int3, MSG_SPEED, &feedmultiply, 10, 999);
  403. #if TEMP_SENSOR_0 != 0
  404. MENU_MULTIPLIER_ITEM_EDIT(int3, MSG_NOZZLE, &target_temperature[0], 0, HEATER_0_MAXTEMP - 15);
  405. #endif
  406. #if TEMP_SENSOR_1 != 0
  407. MENU_MULTIPLIER_ITEM_EDIT(int3, MSG_NOZZLE MSG_N2, &target_temperature[1], 0, HEATER_1_MAXTEMP - 15);
  408. #endif
  409. #if TEMP_SENSOR_2 != 0
  410. MENU_MULTIPLIER_ITEM_EDIT(int3, MSG_NOZZLE MSG_N3, &target_temperature[2], 0, HEATER_2_MAXTEMP - 15);
  411. #endif
  412. #if TEMP_SENSOR_3 != 0
  413. MENU_MULTIPLIER_ITEM_EDIT(int3, MSG_NOZZLE MSG_N4, &target_temperature[3], 0, HEATER_3_MAXTEMP - 15);
  414. #endif
  415. #if TEMP_SENSOR_BED != 0
  416. MENU_MULTIPLIER_ITEM_EDIT(int3, MSG_BED, &target_temperature_bed, 0, BED_MAXTEMP - 15);
  417. #endif
  418. MENU_MULTIPLIER_ITEM_EDIT(int3, MSG_FAN_SPEED, &fanSpeed, 0, 255);
  419. MENU_ITEM_EDIT(int3, MSG_FLOW, &extrudemultiply, 10, 999);
  420. MENU_ITEM_EDIT(int3, MSG_FLOW MSG_F0, &extruder_multiply[0], 10, 999);
  421. #if TEMP_SENSOR_1 != 0
  422. MENU_ITEM_EDIT(int3, MSG_FLOW MSG_F1, &extruder_multiply[1], 10, 999);
  423. #endif
  424. #if TEMP_SENSOR_2 != 0
  425. MENU_ITEM_EDIT(int3, MSG_FLOW MSG_F2, &extruder_multiply[2], 10, 999);
  426. #endif
  427. #if TEMP_SENSOR_3 != 0
  428. MENU_ITEM_EDIT(int3, MSG_FLOW MSG_F3, &extruder_multiply[3], 10, 999);
  429. #endif
  430. #ifdef BABYSTEPPING
  431. #ifdef BABYSTEP_XY
  432. MENU_ITEM(submenu, MSG_BABYSTEP_X, lcd_babystep_x);
  433. MENU_ITEM(submenu, MSG_BABYSTEP_Y, lcd_babystep_y);
  434. #endif //BABYSTEP_XY
  435. MENU_ITEM(submenu, MSG_BABYSTEP_Z, lcd_babystep_z);
  436. #endif
  437. #ifdef FILAMENTCHANGEENABLE
  438. MENU_ITEM(gcode, MSG_FILAMENTCHANGE, PSTR("M600"));
  439. #endif
  440. END_MENU();
  441. }
  442. void _lcd_preheat(int endnum, const float temph, const float tempb, const int fan) {
  443. if (temph > 0) setTargetHotend(temph, endnum);
  444. setTargetBed(tempb);
  445. fanSpeed = fan;
  446. lcd_return_to_status();
  447. setWatch(); // heater sanity check timer
  448. }
  449. void lcd_preheat_pla0() { _lcd_preheat(0, plaPreheatHotendTemp, plaPreheatHPBTemp, plaPreheatFanSpeed); }
  450. void lcd_preheat_abs0() { _lcd_preheat(0, absPreheatHotendTemp, absPreheatHPBTemp, absPreheatFanSpeed); }
  451. #if TEMP_SENSOR_1 != 0 //2nd extruder preheat
  452. void lcd_preheat_pla1() { _lcd_preheat(1, plaPreheatHotendTemp, plaPreheatHPBTemp, plaPreheatFanSpeed); }
  453. void lcd_preheat_abs1() { _lcd_preheat(1, absPreheatHotendTemp, absPreheatHPBTemp, absPreheatFanSpeed); }
  454. #endif //2nd extruder preheat
  455. #if TEMP_SENSOR_2 != 0 //3 extruder preheat
  456. void lcd_preheat_pla2() { _lcd_preheat(2, plaPreheatHotendTemp, plaPreheatHPBTemp, plaPreheatFanSpeed); }
  457. void lcd_preheat_abs2() { _lcd_preheat(2, absPreheatHotendTemp, absPreheatHPBTemp, absPreheatFanSpeed); }
  458. #endif //3 extruder preheat
  459. #if TEMP_SENSOR_3 != 0 //4 extruder preheat
  460. void lcd_preheat_pla3() { _lcd_preheat(3, plaPreheatHotendTemp, plaPreheatHPBTemp, plaPreheatFanSpeed); }
  461. void lcd_preheat_abs3() { _lcd_preheat(3, absPreheatHotendTemp, absPreheatHPBTemp, absPreheatFanSpeed); }
  462. #endif //4 extruder preheat
  463. #if TEMP_SENSOR_1 != 0 || TEMP_SENSOR_2 != 0 || TEMP_SENSOR_3 != 0 //more than one extruder present
  464. void lcd_preheat_pla0123() {
  465. setTargetHotend0(plaPreheatHotendTemp);
  466. setTargetHotend1(plaPreheatHotendTemp);
  467. setTargetHotend2(plaPreheatHotendTemp);
  468. _lcd_preheat(3, plaPreheatHotendTemp, plaPreheatHPBTemp, plaPreheatFanSpeed);
  469. }
  470. void lcd_preheat_abs0123() {
  471. setTargetHotend0(absPreheatHotendTemp);
  472. setTargetHotend1(absPreheatHotendTemp);
  473. setTargetHotend2(absPreheatHotendTemp);
  474. _lcd_preheat(3, absPreheatHotendTemp, absPreheatHPBTemp, absPreheatFanSpeed);
  475. }
  476. #endif //more than one extruder present
  477. void lcd_preheat_pla_bedonly() { _lcd_preheat(0, 0, plaPreheatHPBTemp, plaPreheatFanSpeed); }
  478. void lcd_preheat_abs_bedonly() { _lcd_preheat(0, 0, absPreheatHPBTemp, absPreheatFanSpeed); }
  479. static void lcd_preheat_pla_menu() {
  480. START_MENU();
  481. MENU_ITEM(back, MSG_PREPARE, lcd_prepare_menu);
  482. MENU_ITEM(function, MSG_PREHEAT_PLA_N MSG_H1, lcd_preheat_pla0);
  483. #if TEMP_SENSOR_1 != 0 //2 extruder preheat
  484. MENU_ITEM(function, MSG_PREHEAT_PLA_N MSG_H2, lcd_preheat_pla1);
  485. #endif //2 extruder preheat
  486. #if TEMP_SENSOR_2 != 0 //3 extruder preheat
  487. MENU_ITEM(function, MSG_PREHEAT_PLA_N MSG_H3, lcd_preheat_pla2);
  488. #endif //3 extruder preheat
  489. #if TEMP_SENSOR_3 != 0 //4 extruder preheat
  490. MENU_ITEM(function, MSG_PREHEAT_PLA_N MSG_H4, lcd_preheat_pla3);
  491. #endif //4 extruder preheat
  492. #if TEMP_SENSOR_1 != 0 || TEMP_SENSOR_2 != 0 || TEMP_SENSOR_3 != 0 //all extruder preheat
  493. MENU_ITEM(function, MSG_PREHEAT_PLA_ALL, lcd_preheat_pla0123);
  494. #endif //all extruder preheat
  495. #if TEMP_SENSOR_BED != 0
  496. MENU_ITEM(function, MSG_PREHEAT_PLA_BEDONLY, lcd_preheat_pla_bedonly);
  497. #endif
  498. END_MENU();
  499. }
  500. static void lcd_preheat_abs_menu() {
  501. START_MENU();
  502. MENU_ITEM(back, MSG_PREPARE, lcd_prepare_menu);
  503. MENU_ITEM(function, MSG_PREHEAT_ABS_N MSG_H1, lcd_preheat_abs0);
  504. #if TEMP_SENSOR_1 != 0 //2 extruder preheat
  505. MENU_ITEM(function, MSG_PREHEAT_ABS_N MSG_H2, lcd_preheat_abs1);
  506. #endif //2 extruder preheat
  507. #if TEMP_SENSOR_2 != 0 //3 extruder preheat
  508. MENU_ITEM(function, MSG_PREHEAT_ABS_N MSG_H3, lcd_preheat_abs2);
  509. #endif //3 extruder preheat
  510. #if TEMP_SENSOR_3 != 0 //4 extruder preheat
  511. MENU_ITEM(function, MSG_PREHEAT_ABS_N MSG_H4, lcd_preheat_abs3);
  512. #endif //4 extruder preheat
  513. #if TEMP_SENSOR_1 != 0 || TEMP_SENSOR_2 != 0 || TEMP_SENSOR_3 != 0 //all extruder preheat
  514. MENU_ITEM(function, MSG_PREHEAT_ABS_ALL, lcd_preheat_abs0123);
  515. #endif //all extruder preheat
  516. #if TEMP_SENSOR_BED != 0
  517. MENU_ITEM(function, MSG_PREHEAT_ABS_BEDONLY, lcd_preheat_abs_bedonly);
  518. #endif
  519. END_MENU();
  520. }
  521. void lcd_cooldown() {
  522. setTargetHotend0(0);
  523. setTargetHotend1(0);
  524. setTargetHotend2(0);
  525. setTargetHotend3(0);
  526. setTargetBed(0);
  527. fanSpeed = 0;
  528. lcd_return_to_status();
  529. }
  530. static void lcd_prepare_menu() {
  531. START_MENU();
  532. MENU_ITEM(back, MSG_MAIN, lcd_main_menu);
  533. #ifdef SDSUPPORT
  534. #ifdef MENU_ADDAUTOSTART
  535. MENU_ITEM(function, MSG_AUTOSTART, lcd_autostart_sd);
  536. #endif
  537. #endif
  538. MENU_ITEM(gcode, MSG_DISABLE_STEPPERS, PSTR("M84"));
  539. MENU_ITEM(gcode, MSG_AUTO_HOME, PSTR("G28"));
  540. MENU_ITEM(function, MSG_SET_HOME_OFFSETS, lcd_set_home_offsets);
  541. //MENU_ITEM(gcode, MSG_SET_ORIGIN, PSTR("G92 X0 Y0 Z0"));
  542. #if TEMP_SENSOR_0 != 0
  543. #if TEMP_SENSOR_1 != 0 || TEMP_SENSOR_2 != 0 || TEMP_SENSOR_BED != 0
  544. MENU_ITEM(submenu, MSG_PREHEAT_PLA, lcd_preheat_pla_menu);
  545. MENU_ITEM(submenu, MSG_PREHEAT_ABS, lcd_preheat_abs_menu);
  546. #else
  547. MENU_ITEM(function, MSG_PREHEAT_PLA, lcd_preheat_pla0);
  548. MENU_ITEM(function, MSG_PREHEAT_ABS, lcd_preheat_abs0);
  549. #endif
  550. #endif
  551. MENU_ITEM(function, MSG_COOLDOWN, lcd_cooldown);
  552. #if defined(POWER_SUPPLY) && POWER_SUPPLY > 0 && defined(PS_ON_PIN) && PS_ON_PIN > -1
  553. if (powersupply) {
  554. MENU_ITEM(gcode, MSG_SWITCH_PS_OFF, PSTR("M81"));
  555. }
  556. else {
  557. MENU_ITEM(gcode, MSG_SWITCH_PS_ON, PSTR("M80"));
  558. }
  559. #endif
  560. MENU_ITEM(submenu, MSG_MOVE_AXIS, lcd_move_menu);
  561. #if defined(MANUAL_BED_LEVELING)
  562. MENU_ITEM(submenu, MSG_LEVEL_BED, lcd_level_bed);
  563. #endif
  564. END_MENU();
  565. }
  566. #ifdef DELTA_CALIBRATION_MENU
  567. static void lcd_delta_calibrate_menu()
  568. {
  569. START_MENU();
  570. MENU_ITEM(back, MSG_MAIN, lcd_main_menu);
  571. MENU_ITEM(gcode, MSG_AUTO_HOME, PSTR("G28"));
  572. MENU_ITEM(gcode, MSG_DELTA_CALIBRATE_X, PSTR("G0 F8000 X-77.94 Y-45 Z0"));
  573. MENU_ITEM(gcode, MSG_DELTA_CALIBRATE_Y, PSTR("G0 F8000 X77.94 Y-45 Z0"));
  574. MENU_ITEM(gcode, MSG_DELTA_CALIBRATE_Z, PSTR("G0 F8000 X0 Y90 Z0"));
  575. MENU_ITEM(gcode, MSG_DELTA_CALIBRATE_CENTER, PSTR("G0 F8000 X0 Y0 Z0"));
  576. END_MENU();
  577. }
  578. #endif // DELTA_CALIBRATION_MENU
  579. float move_menu_scale;
  580. static void lcd_move_menu_axis();
  581. static void _lcd_move(const char *name, int axis, int min, int max) {
  582. if (encoderPosition != 0) {
  583. refresh_cmd_timeout();
  584. current_position[axis] += float((int)encoderPosition) * move_menu_scale;
  585. if (min_software_endstops && current_position[axis] < min) current_position[axis] = min;
  586. if (max_software_endstops && current_position[axis] > max) current_position[axis] = max;
  587. encoderPosition = 0;
  588. #ifdef DELTA
  589. calculate_delta(current_position);
  590. plan_buffer_line(delta[X_AXIS], delta[Y_AXIS], delta[Z_AXIS], current_position[E_AXIS], manual_feedrate[axis]/60, active_extruder);
  591. #else
  592. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], manual_feedrate[axis]/60, active_extruder);
  593. #endif
  594. lcdDrawUpdate = 1;
  595. }
  596. if (lcdDrawUpdate) lcd_implementation_drawedit(name, ftostr31(current_position[axis]));
  597. if (LCD_CLICKED) lcd_goto_menu(lcd_move_menu_axis);
  598. }
  599. static void lcd_move_x() { _lcd_move(PSTR("X"), X_AXIS, X_MIN_POS, X_MAX_POS); }
  600. static void lcd_move_y() { _lcd_move(PSTR("Y"), Y_AXIS, Y_MIN_POS, Y_MAX_POS); }
  601. static void lcd_move_z() { _lcd_move(PSTR("Z"), Z_AXIS, Z_MIN_POS, Z_MAX_POS); }
  602. static void lcd_move_e() {
  603. if (encoderPosition != 0) {
  604. current_position[E_AXIS] += float((int)encoderPosition) * move_menu_scale;
  605. encoderPosition = 0;
  606. #ifdef DELTA
  607. calculate_delta(current_position);
  608. plan_buffer_line(delta[X_AXIS], delta[Y_AXIS], delta[Z_AXIS], current_position[E_AXIS], manual_feedrate[E_AXIS]/60, active_extruder);
  609. #else
  610. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], manual_feedrate[E_AXIS]/60, active_extruder);
  611. #endif
  612. lcdDrawUpdate = 1;
  613. }
  614. if (lcdDrawUpdate) lcd_implementation_drawedit(PSTR("Extruder"), ftostr31(current_position[E_AXIS]));
  615. if (LCD_CLICKED) lcd_goto_menu(lcd_move_menu_axis);
  616. }
  617. static void lcd_move_menu_axis() {
  618. START_MENU();
  619. MENU_ITEM(back, MSG_MOVE_AXIS, lcd_move_menu);
  620. MENU_ITEM(submenu, MSG_MOVE_X, lcd_move_x);
  621. MENU_ITEM(submenu, MSG_MOVE_Y, lcd_move_y);
  622. if (move_menu_scale < 10.0) {
  623. MENU_ITEM(submenu, MSG_MOVE_Z, lcd_move_z);
  624. MENU_ITEM(submenu, MSG_MOVE_E, lcd_move_e);
  625. }
  626. END_MENU();
  627. }
  628. static void lcd_move_menu_10mm() {
  629. move_menu_scale = 10.0;
  630. lcd_move_menu_axis();
  631. }
  632. static void lcd_move_menu_1mm() {
  633. move_menu_scale = 1.0;
  634. lcd_move_menu_axis();
  635. }
  636. static void lcd_move_menu_01mm() {
  637. move_menu_scale = 0.1;
  638. lcd_move_menu_axis();
  639. }
  640. static void lcd_move_menu() {
  641. START_MENU();
  642. MENU_ITEM(back, MSG_PREPARE, lcd_prepare_menu);
  643. MENU_ITEM(submenu, MSG_MOVE_10MM, lcd_move_menu_10mm);
  644. MENU_ITEM(submenu, MSG_MOVE_1MM, lcd_move_menu_1mm);
  645. MENU_ITEM(submenu, MSG_MOVE_01MM, lcd_move_menu_01mm);
  646. //TODO:X,Y,Z,E
  647. END_MENU();
  648. }
  649. static void lcd_control_menu() {
  650. START_MENU();
  651. MENU_ITEM(back, MSG_MAIN, lcd_main_menu);
  652. MENU_ITEM(submenu, MSG_TEMPERATURE, lcd_control_temperature_menu);
  653. MENU_ITEM(submenu, MSG_MOTION, lcd_control_motion_menu);
  654. MENU_ITEM(submenu, MSG_VOLUMETRIC, lcd_control_volumetric_menu);
  655. #ifdef DOGLCD
  656. //MENU_ITEM_EDIT(int3, MSG_CONTRAST, &lcd_contrast, 0, 63);
  657. MENU_ITEM(submenu, MSG_CONTRAST, lcd_set_contrast);
  658. #endif
  659. #ifdef FWRETRACT
  660. MENU_ITEM(submenu, MSG_RETRACT, lcd_control_retract_menu);
  661. #endif
  662. #ifdef EEPROM_SETTINGS
  663. MENU_ITEM(function, MSG_STORE_EPROM, Config_StoreSettings);
  664. MENU_ITEM(function, MSG_LOAD_EPROM, Config_RetrieveSettings);
  665. #endif
  666. MENU_ITEM(function, MSG_RESTORE_FAILSAFE, Config_ResetDefault);
  667. END_MENU();
  668. }
  669. #ifdef PIDTEMP
  670. // Helpers for editing PID Ki & Kd values
  671. // grab the PID value out of the temp variable; scale it; then update the PID driver
  672. void copy_and_scalePID_i(int e) {
  673. PID_PARAM(Ki, e) = scalePID_i(raw_Ki);
  674. updatePID();
  675. }
  676. void copy_and_scalePID_d(int e) {
  677. PID_PARAM(Kd, e) = scalePID_d(raw_Kd);
  678. updatePID();
  679. }
  680. void copy_and_scalePID_i_E1() { copy_and_scalePID_i(0); }
  681. void copy_and_scalePID_d_E1() { copy_and_scalePID_d(0); }
  682. #ifdef PID_PARAMS_PER_EXTRUDER
  683. #if EXTRUDERS > 1
  684. void copy_and_scalePID_i_E2() { copy_and_scalePID_i(1); }
  685. void copy_and_scalePID_d_E2() { copy_and_scalePID_d(1); }
  686. #if EXTRUDERS > 2
  687. void copy_and_scalePID_i_E3() { copy_and_scalePID_i(2); }
  688. void copy_and_scalePID_d_E3() { copy_and_scalePID_d(2); }
  689. #if EXTRUDERS > 3
  690. void copy_and_scalePID_i_E4() { copy_and_scalePID_i(3); }
  691. void copy_and_scalePID_d_E4() { copy_and_scalePID_d(3); }
  692. #endif //EXTRUDERS > 3
  693. #endif //EXTRUDERS > 2
  694. #endif //EXTRUDERS > 1
  695. #endif //PID_PARAMS_PER_EXTRUDER
  696. #endif //PIDTEMP
  697. static void lcd_control_temperature_menu() {
  698. START_MENU();
  699. MENU_ITEM(back, MSG_CONTROL, lcd_control_menu);
  700. #if TEMP_SENSOR_0 != 0
  701. MENU_MULTIPLIER_ITEM_EDIT(int3, MSG_NOZZLE, &target_temperature[0], 0, HEATER_0_MAXTEMP - 15);
  702. #endif
  703. #if EXTRUDERS > 1
  704. #if TEMP_SENSOR_1 != 0
  705. MENU_MULTIPLIER_ITEM_EDIT(int3, MSG_NOZZLE MSG_N2, &target_temperature[1], 0, HEATER_1_MAXTEMP - 15);
  706. #endif
  707. #if EXTRUDERS > 2
  708. #if TEMP_SENSOR_2 != 0
  709. MENU_MULTIPLIER_ITEM_EDIT(int3, MSG_NOZZLE MSG_N3, &target_temperature[2], 0, HEATER_2_MAXTEMP - 15);
  710. #endif
  711. #if EXTRUDERS > 3
  712. #if TEMP_SENSOR_3 != 0
  713. MENU_MULTIPLIER_ITEM_EDIT(int3, MSG_NOZZLE MSG_N4, &target_temperature[3], 0, HEATER_3_MAXTEMP - 15);
  714. #endif
  715. #endif // EXTRUDERS > 3
  716. #endif // EXTRUDERS > 2
  717. #endif // EXTRUDERS > 1
  718. #if TEMP_SENSOR_BED != 0
  719. MENU_MULTIPLIER_ITEM_EDIT(int3, MSG_BED, &target_temperature_bed, 0, BED_MAXTEMP - 15);
  720. #endif
  721. MENU_MULTIPLIER_ITEM_EDIT(int3, MSG_FAN_SPEED, &fanSpeed, 0, 255);
  722. #if defined(AUTOTEMP) && (TEMP_SENSOR_0 != 0)
  723. MENU_ITEM_EDIT(bool, MSG_AUTOTEMP, &autotemp_enabled);
  724. MENU_ITEM_EDIT(float3, MSG_MIN, &autotemp_min, 0, HEATER_0_MAXTEMP - 15);
  725. MENU_ITEM_EDIT(float3, MSG_MAX, &autotemp_max, 0, HEATER_0_MAXTEMP - 15);
  726. MENU_ITEM_EDIT(float32, MSG_FACTOR, &autotemp_factor, 0.0, 1.0);
  727. #endif
  728. #ifdef PIDTEMP
  729. // set up temp variables - undo the default scaling
  730. raw_Ki = unscalePID_i(PID_PARAM(Ki,0));
  731. raw_Kd = unscalePID_d(PID_PARAM(Kd,0));
  732. MENU_ITEM_EDIT(float52, MSG_PID_P, &PID_PARAM(Kp,0), 1, 9990);
  733. // i is typically a small value so allows values below 1
  734. MENU_ITEM_EDIT_CALLBACK(float52, MSG_PID_I, &raw_Ki, 0.01, 9990, copy_and_scalePID_i_E1);
  735. MENU_ITEM_EDIT_CALLBACK(float52, MSG_PID_D, &raw_Kd, 1, 9990, copy_and_scalePID_d_E1);
  736. #ifdef PID_ADD_EXTRUSION_RATE
  737. MENU_ITEM_EDIT(float3, MSG_PID_C, &PID_PARAM(Kc,0), 1, 9990);
  738. #endif//PID_ADD_EXTRUSION_RATE
  739. #ifdef PID_PARAMS_PER_EXTRUDER
  740. #if EXTRUDERS > 1
  741. // set up temp variables - undo the default scaling
  742. raw_Ki = unscalePID_i(PID_PARAM(Ki,1));
  743. raw_Kd = unscalePID_d(PID_PARAM(Kd,1));
  744. MENU_ITEM_EDIT(float52, MSG_PID_P MSG_E2, &PID_PARAM(Kp,1), 1, 9990);
  745. // i is typically a small value so allows values below 1
  746. MENU_ITEM_EDIT_CALLBACK(float52, MSG_PID_I MSG_E2, &raw_Ki, 0.01, 9990, copy_and_scalePID_i_E2);
  747. MENU_ITEM_EDIT_CALLBACK(float52, MSG_PID_D MSG_E2, &raw_Kd, 1, 9990, copy_and_scalePID_d_E2);
  748. #ifdef PID_ADD_EXTRUSION_RATE
  749. MENU_ITEM_EDIT(float3, MSG_PID_C MSG_E2, &PID_PARAM(Kc,1), 1, 9990);
  750. #endif//PID_ADD_EXTRUSION_RATE
  751. #if EXTRUDERS > 2
  752. // set up temp variables - undo the default scaling
  753. raw_Ki = unscalePID_i(PID_PARAM(Ki,2));
  754. raw_Kd = unscalePID_d(PID_PARAM(Kd,2));
  755. MENU_ITEM_EDIT(float52, MSG_PID_P MSG_E3, &PID_PARAM(Kp,2), 1, 9990);
  756. // i is typically a small value so allows values below 1
  757. MENU_ITEM_EDIT_CALLBACK(float52, MSG_PID_I MSG_E3, &raw_Ki, 0.01, 9990, copy_and_scalePID_i_E3);
  758. MENU_ITEM_EDIT_CALLBACK(float52, MSG_PID_D MSG_E3, &raw_Kd, 1, 9990, copy_and_scalePID_d_E3);
  759. #ifdef PID_ADD_EXTRUSION_RATE
  760. MENU_ITEM_EDIT(float3, MSG_PID_C MSG_E3, &PID_PARAM(Kc,2), 1, 9990);
  761. #endif//PID_ADD_EXTRUSION_RATE
  762. #if EXTRUDERS > 3
  763. // set up temp variables - undo the default scaling
  764. raw_Ki = unscalePID_i(PID_PARAM(Ki,3));
  765. raw_Kd = unscalePID_d(PID_PARAM(Kd,3));
  766. MENU_ITEM_EDIT(float52, MSG_PID_P MSG_E4, &PID_PARAM(Kp,3), 1, 9990);
  767. // i is typically a small value so allows values below 1
  768. MENU_ITEM_EDIT_CALLBACK(float52, MSG_PID_I MSG_E4, &raw_Ki, 0.01, 9990, copy_and_scalePID_i_E4);
  769. MENU_ITEM_EDIT_CALLBACK(float52, MSG_PID_D MSG_E4, &raw_Kd, 1, 9990, copy_and_scalePID_d_E4);
  770. #ifdef PID_ADD_EXTRUSION_RATE
  771. MENU_ITEM_EDIT(float3, MSG_PID_C MSG_E4, &PID_PARAM(Kc,3), 1, 9990);
  772. #endif//PID_ADD_EXTRUSION_RATE
  773. #endif//EXTRUDERS > 3
  774. #endif//EXTRUDERS > 2
  775. #endif//EXTRUDERS > 1
  776. #endif //PID_PARAMS_PER_EXTRUDER
  777. #endif//PIDTEMP
  778. MENU_ITEM(submenu, MSG_PREHEAT_PLA_SETTINGS, lcd_control_temperature_preheat_pla_settings_menu);
  779. MENU_ITEM(submenu, MSG_PREHEAT_ABS_SETTINGS, lcd_control_temperature_preheat_abs_settings_menu);
  780. END_MENU();
  781. }
  782. static void lcd_control_temperature_preheat_pla_settings_menu() {
  783. START_MENU();
  784. MENU_ITEM(back, MSG_TEMPERATURE, lcd_control_temperature_menu);
  785. MENU_ITEM_EDIT(int3, MSG_FAN_SPEED, &plaPreheatFanSpeed, 0, 255);
  786. #if TEMP_SENSOR_0 != 0
  787. MENU_ITEM_EDIT(int3, MSG_NOZZLE, &plaPreheatHotendTemp, 0, HEATER_0_MAXTEMP - 15);
  788. #endif
  789. #if TEMP_SENSOR_BED != 0
  790. MENU_ITEM_EDIT(int3, MSG_BED, &plaPreheatHPBTemp, 0, BED_MAXTEMP - 15);
  791. #endif
  792. #ifdef EEPROM_SETTINGS
  793. MENU_ITEM(function, MSG_STORE_EPROM, Config_StoreSettings);
  794. #endif
  795. END_MENU();
  796. }
  797. static void lcd_control_temperature_preheat_abs_settings_menu() {
  798. START_MENU();
  799. MENU_ITEM(back, MSG_TEMPERATURE, lcd_control_temperature_menu);
  800. MENU_ITEM_EDIT(int3, MSG_FAN_SPEED, &absPreheatFanSpeed, 0, 255);
  801. #if TEMP_SENSOR_0 != 0
  802. MENU_ITEM_EDIT(int3, MSG_NOZZLE, &absPreheatHotendTemp, 0, HEATER_0_MAXTEMP - 15);
  803. #endif
  804. #if TEMP_SENSOR_BED != 0
  805. MENU_ITEM_EDIT(int3, MSG_BED, &absPreheatHPBTemp, 0, BED_MAXTEMP - 15);
  806. #endif
  807. #ifdef EEPROM_SETTINGS
  808. MENU_ITEM(function, MSG_STORE_EPROM, Config_StoreSettings);
  809. #endif
  810. END_MENU();
  811. }
  812. static void lcd_control_motion_menu() {
  813. START_MENU();
  814. MENU_ITEM(back, MSG_CONTROL, lcd_control_menu);
  815. #ifdef ENABLE_AUTO_BED_LEVELING
  816. MENU_ITEM_EDIT(float32, MSG_ZPROBE_ZOFFSET, &zprobe_zoffset, 0.5, 50);
  817. #endif
  818. MENU_ITEM_EDIT(float5, MSG_ACC, &acceleration, 500, 99000);
  819. MENU_ITEM_EDIT(float3, MSG_VXY_JERK, &max_xy_jerk, 1, 990);
  820. MENU_ITEM_EDIT(float52, MSG_VZ_JERK, &max_z_jerk, 0.1, 990);
  821. MENU_ITEM_EDIT(float3, MSG_VE_JERK, &max_e_jerk, 1, 990);
  822. MENU_ITEM_EDIT(float3, MSG_VMAX MSG_X, &max_feedrate[X_AXIS], 1, 999);
  823. MENU_ITEM_EDIT(float3, MSG_VMAX MSG_Y, &max_feedrate[Y_AXIS], 1, 999);
  824. MENU_ITEM_EDIT(float3, MSG_VMAX MSG_Z, &max_feedrate[Z_AXIS], 1, 999);
  825. MENU_ITEM_EDIT(float3, MSG_VMAX MSG_E, &max_feedrate[E_AXIS], 1, 999);
  826. MENU_ITEM_EDIT(float3, MSG_VMIN, &minimumfeedrate, 0, 999);
  827. MENU_ITEM_EDIT(float3, MSG_VTRAV_MIN, &mintravelfeedrate, 0, 999);
  828. MENU_ITEM_EDIT_CALLBACK(long5, MSG_AMAX MSG_X, &max_acceleration_units_per_sq_second[X_AXIS], 100, 99000, reset_acceleration_rates);
  829. MENU_ITEM_EDIT_CALLBACK(long5, MSG_AMAX MSG_Y, &max_acceleration_units_per_sq_second[Y_AXIS], 100, 99000, reset_acceleration_rates);
  830. MENU_ITEM_EDIT_CALLBACK(long5, MSG_AMAX MSG_Z, &max_acceleration_units_per_sq_second[Z_AXIS], 100, 99000, reset_acceleration_rates);
  831. MENU_ITEM_EDIT_CALLBACK(long5, MSG_AMAX MSG_E, &max_acceleration_units_per_sq_second[E_AXIS], 100, 99000, reset_acceleration_rates);
  832. MENU_ITEM_EDIT(float5, MSG_A_RETRACT, &retract_acceleration, 100, 99000);
  833. MENU_ITEM_EDIT(float5, MSG_A_TRAVEL, &travel_acceleration, 100, 99000);
  834. MENU_ITEM_EDIT(float52, MSG_XSTEPS, &axis_steps_per_unit[X_AXIS], 5, 9999);
  835. MENU_ITEM_EDIT(float52, MSG_YSTEPS, &axis_steps_per_unit[Y_AXIS], 5, 9999);
  836. MENU_ITEM_EDIT(float51, MSG_ZSTEPS, &axis_steps_per_unit[Z_AXIS], 5, 9999);
  837. MENU_ITEM_EDIT(float51, MSG_ESTEPS, &axis_steps_per_unit[E_AXIS], 5, 9999);
  838. #ifdef ABORT_ON_ENDSTOP_HIT_FEATURE_ENABLED
  839. MENU_ITEM_EDIT(bool, MSG_ENDSTOP_ABORT, &abort_on_endstop_hit);
  840. #endif
  841. #ifdef SCARA
  842. MENU_ITEM_EDIT(float74, MSG_XSCALE, &axis_scaling[X_AXIS],0.5,2);
  843. MENU_ITEM_EDIT(float74, MSG_YSCALE, &axis_scaling[Y_AXIS],0.5,2);
  844. #endif
  845. END_MENU();
  846. }
  847. static void lcd_control_volumetric_menu() {
  848. START_MENU();
  849. MENU_ITEM(back, MSG_CONTROL, lcd_control_menu);
  850. MENU_ITEM_EDIT_CALLBACK(bool, MSG_VOLUMETRIC_ENABLED, &volumetric_enabled, calculate_volumetric_multipliers);
  851. if (volumetric_enabled) {
  852. MENU_MULTIPLIER_ITEM_EDIT_CALLBACK(float43, MSG_FILAMENT_SIZE_EXTRUDER_0, &filament_size[0], 1.5, 3.25, calculate_volumetric_multipliers);
  853. #if EXTRUDERS > 1
  854. MENU_MULTIPLIER_ITEM_EDIT_CALLBACK(float43, MSG_FILAMENT_SIZE_EXTRUDER_1, &filament_size[1], 1.5, 3.25, calculate_volumetric_multipliers);
  855. #if EXTRUDERS > 2
  856. MENU_MULTIPLIER_ITEM_EDIT_CALLBACK(float43, MSG_FILAMENT_SIZE_EXTRUDER_2, &filament_size[2], 1.5, 3.25, calculate_volumetric_multipliers);
  857. #if EXTRUDERS > 3
  858. MENU_MULTIPLIER_ITEM_EDIT_CALLBACK(float43, MSG_FILAMENT_SIZE_EXTRUDER_3, &filament_size[3], 1.5, 3.25, calculate_volumetric_multipliers);
  859. #endif //EXTRUDERS > 3
  860. #endif //EXTRUDERS > 2
  861. #endif //EXTRUDERS > 1
  862. }
  863. END_MENU();
  864. }
  865. #ifdef DOGLCD
  866. static void lcd_set_contrast() {
  867. if (encoderPosition != 0) {
  868. lcd_contrast -= encoderPosition;
  869. if (lcd_contrast < 0) lcd_contrast = 0;
  870. else if (lcd_contrast > 63) lcd_contrast = 63;
  871. encoderPosition = 0;
  872. lcdDrawUpdate = 1;
  873. u8g.setContrast(lcd_contrast);
  874. }
  875. if (lcdDrawUpdate) lcd_implementation_drawedit(PSTR(MSG_CONTRAST), itostr2(lcd_contrast));
  876. if (LCD_CLICKED) lcd_goto_menu(lcd_control_menu);
  877. }
  878. #endif //DOGLCD
  879. #ifdef FWRETRACT
  880. static void lcd_control_retract_menu() {
  881. START_MENU();
  882. MENU_ITEM(back, MSG_CONTROL, lcd_control_menu);
  883. MENU_ITEM_EDIT(bool, MSG_AUTORETRACT, &autoretract_enabled);
  884. MENU_ITEM_EDIT(float52, MSG_CONTROL_RETRACT, &retract_length, 0, 100);
  885. #if EXTRUDERS > 1
  886. MENU_ITEM_EDIT(float52, MSG_CONTROL_RETRACT_SWAP, &retract_length_swap, 0, 100);
  887. #endif
  888. MENU_ITEM_EDIT(float3, MSG_CONTROL_RETRACTF, &retract_feedrate, 1, 999);
  889. MENU_ITEM_EDIT(float52, MSG_CONTROL_RETRACT_ZLIFT, &retract_zlift, 0, 999);
  890. MENU_ITEM_EDIT(float52, MSG_CONTROL_RETRACT_RECOVER, &retract_recover_length, 0, 100);
  891. #if EXTRUDERS > 1
  892. MENU_ITEM_EDIT(float52, MSG_CONTROL_RETRACT_RECOVER_SWAP, &retract_recover_length_swap, 0, 100);
  893. #endif
  894. MENU_ITEM_EDIT(float3, MSG_CONTROL_RETRACT_RECOVERF, &retract_recover_feedrate, 1, 999);
  895. END_MENU();
  896. }
  897. #endif //FWRETRACT
  898. #if SDCARDDETECT == -1
  899. static void lcd_sd_refresh() {
  900. card.initsd();
  901. currentMenuViewOffset = 0;
  902. }
  903. #endif
  904. static void lcd_sd_updir() {
  905. card.updir();
  906. currentMenuViewOffset = 0;
  907. }
  908. void lcd_sdcard_menu() {
  909. if (lcdDrawUpdate == 0 && LCD_CLICKED == 0) return; // nothing to do (so don't thrash the SD card)
  910. uint16_t fileCnt = card.getnrfilenames();
  911. START_MENU();
  912. MENU_ITEM(back, MSG_MAIN, lcd_main_menu);
  913. card.getWorkDirName();
  914. if (card.filename[0] == '/') {
  915. #if SDCARDDETECT == -1
  916. MENU_ITEM(function, LCD_STR_REFRESH MSG_REFRESH, lcd_sd_refresh);
  917. #endif
  918. }
  919. else {
  920. MENU_ITEM(function, LCD_STR_FOLDER "..", lcd_sd_updir);
  921. }
  922. for(uint16_t i = 0; i < fileCnt; i++) {
  923. if (_menuItemNr == _lineNr) {
  924. #ifndef SDCARD_RATHERRECENTFIRST
  925. card.getfilename(i);
  926. #else
  927. card.getfilename(fileCnt-1-i);
  928. #endif
  929. if (card.filenameIsDir)
  930. MENU_ITEM(sddirectory, MSG_CARD_MENU, card.filename, card.longFilename);
  931. else
  932. MENU_ITEM(sdfile, MSG_CARD_MENU, card.filename, card.longFilename);
  933. }
  934. else {
  935. MENU_ITEM_DUMMY();
  936. }
  937. }
  938. END_MENU();
  939. }
  940. #define menu_edit_type(_type, _name, _strFunc, scale) \
  941. bool _menu_edit_ ## _name () { \
  942. bool isClicked = LCD_CLICKED; \
  943. if ((int32_t)encoderPosition < 0) encoderPosition = 0; \
  944. if ((int32_t)encoderPosition > maxEditValue) encoderPosition = maxEditValue; \
  945. if (lcdDrawUpdate) \
  946. lcd_implementation_drawedit(editLabel, _strFunc(((_type)((int32_t)encoderPosition + minEditValue)) / scale)); \
  947. if (isClicked) { \
  948. *((_type*)editValue) = ((_type)((int32_t)encoderPosition + minEditValue)) / scale; \
  949. lcd_goto_menu(prevMenu, prevEncoderPosition); \
  950. } \
  951. return isClicked; \
  952. } \
  953. void menu_edit_ ## _name () { _menu_edit_ ## _name(); } \
  954. void menu_edit_callback_ ## _name () { if (_menu_edit_ ## _name ()) (*callbackFunc)(); } \
  955. static void _menu_action_setting_edit_ ## _name (const char* pstr, _type* ptr, _type minValue, _type maxValue) { \
  956. prevMenu = currentMenu; \
  957. prevEncoderPosition = encoderPosition; \
  958. \
  959. lcdDrawUpdate = 2; \
  960. currentMenu = menu_edit_ ## _name; \
  961. \
  962. editLabel = pstr; \
  963. editValue = ptr; \
  964. minEditValue = minValue * scale; \
  965. maxEditValue = maxValue * scale - minEditValue; \
  966. encoderPosition = (*ptr) * scale - minEditValue; \
  967. } \
  968. static void menu_action_setting_edit_ ## _name (const char* pstr, _type* ptr, _type minValue, _type maxValue) { \
  969. _menu_action_setting_edit_ ## _name(pstr, ptr, minValue, maxValue); \
  970. currentMenu = menu_edit_ ## _name; \
  971. }\
  972. static void menu_action_setting_edit_callback_ ## _name (const char* pstr, _type* ptr, _type minValue, _type maxValue, menuFunc_t callback) { \
  973. _menu_action_setting_edit_ ## _name(pstr, ptr, minValue, maxValue); \
  974. currentMenu = menu_edit_callback_ ## _name; \
  975. callbackFunc = callback; \
  976. }
  977. menu_edit_type(int, int3, itostr3, 1)
  978. menu_edit_type(float, float3, ftostr3, 1)
  979. menu_edit_type(float, float32, ftostr32, 100)
  980. menu_edit_type(float, float43, ftostr43, 1000)
  981. menu_edit_type(float, float5, ftostr5, 0.01)
  982. menu_edit_type(float, float51, ftostr51, 10)
  983. menu_edit_type(float, float52, ftostr52, 100)
  984. menu_edit_type(unsigned long, long5, ftostr5, 0.01)
  985. #ifdef REPRAPWORLD_KEYPAD
  986. static void reprapworld_keypad_move_z_up() {
  987. encoderPosition = 1;
  988. move_menu_scale = REPRAPWORLD_KEYPAD_MOVE_STEP;
  989. lcd_move_z();
  990. }
  991. static void reprapworld_keypad_move_z_down() {
  992. encoderPosition = -1;
  993. move_menu_scale = REPRAPWORLD_KEYPAD_MOVE_STEP;
  994. lcd_move_z();
  995. }
  996. static void reprapworld_keypad_move_x_left() {
  997. encoderPosition = -1;
  998. move_menu_scale = REPRAPWORLD_KEYPAD_MOVE_STEP;
  999. lcd_move_x();
  1000. }
  1001. static void reprapworld_keypad_move_x_right() {
  1002. encoderPosition = 1;
  1003. move_menu_scale = REPRAPWORLD_KEYPAD_MOVE_STEP;
  1004. lcd_move_x();
  1005. }
  1006. static void reprapworld_keypad_move_y_down() {
  1007. encoderPosition = 1;
  1008. move_menu_scale = REPRAPWORLD_KEYPAD_MOVE_STEP;
  1009. lcd_move_y();
  1010. }
  1011. static void reprapworld_keypad_move_y_up() {
  1012. encoderPosition = -1;
  1013. move_menu_scale = REPRAPWORLD_KEYPAD_MOVE_STEP;
  1014. lcd_move_y();
  1015. }
  1016. static void reprapworld_keypad_move_home() {
  1017. enquecommands_P((PSTR("G28"))); // move all axis home
  1018. }
  1019. #endif //REPRAPWORLD_KEYPAD
  1020. /** End of menus **/
  1021. static void lcd_quick_feedback() {
  1022. lcdDrawUpdate = 2;
  1023. blocking_enc = millis() + 500;
  1024. lcd_implementation_quick_feedback();
  1025. }
  1026. /** Menu action functions **/
  1027. static void menu_action_back(menuFunc_t data) { lcd_goto_menu(data); }
  1028. static void menu_action_submenu(menuFunc_t data) { lcd_goto_menu(data); }
  1029. static void menu_action_gcode(const char* pgcode) { enquecommands_P(pgcode); }
  1030. static void menu_action_function(menuFunc_t data) { (*data)(); }
  1031. static void menu_action_sdfile(const char* filename, char* longFilename) {
  1032. char cmd[30];
  1033. char* c;
  1034. sprintf_P(cmd, PSTR("M23 %s"), filename);
  1035. for(c = &cmd[4]; *c; c++) *c = tolower(*c);
  1036. enquecommand(cmd);
  1037. enquecommands_P(PSTR("M24"));
  1038. lcd_return_to_status();
  1039. }
  1040. static void menu_action_sddirectory(const char* filename, char* longFilename) {
  1041. card.chdir(filename);
  1042. encoderPosition = 0;
  1043. }
  1044. static void menu_action_setting_edit_bool(const char* pstr, bool* ptr) { *ptr = !(*ptr); }
  1045. static void menu_action_setting_edit_callback_bool(const char* pstr, bool* ptr, menuFunc_t callback) {
  1046. menu_action_setting_edit_bool(pstr, ptr);
  1047. (*callback)();
  1048. }
  1049. #endif //ULTIPANEL
  1050. /** LCD API **/
  1051. void lcd_init() {
  1052. lcd_implementation_init();
  1053. #ifdef NEWPANEL
  1054. SET_INPUT(BTN_EN1);
  1055. SET_INPUT(BTN_EN2);
  1056. WRITE(BTN_EN1,HIGH);
  1057. WRITE(BTN_EN2,HIGH);
  1058. #if BTN_ENC > 0
  1059. SET_INPUT(BTN_ENC);
  1060. WRITE(BTN_ENC,HIGH);
  1061. #endif
  1062. #ifdef REPRAPWORLD_KEYPAD
  1063. pinMode(SHIFT_CLK,OUTPUT);
  1064. pinMode(SHIFT_LD,OUTPUT);
  1065. pinMode(SHIFT_OUT,INPUT);
  1066. WRITE(SHIFT_OUT,HIGH);
  1067. WRITE(SHIFT_LD,HIGH);
  1068. #endif
  1069. #else // Not NEWPANEL
  1070. #ifdef SR_LCD_2W_NL // Non latching 2 wire shift register
  1071. pinMode (SR_DATA_PIN, OUTPUT);
  1072. pinMode (SR_CLK_PIN, OUTPUT);
  1073. #elif defined(SHIFT_CLK)
  1074. pinMode(SHIFT_CLK,OUTPUT);
  1075. pinMode(SHIFT_LD,OUTPUT);
  1076. pinMode(SHIFT_EN,OUTPUT);
  1077. pinMode(SHIFT_OUT,INPUT);
  1078. WRITE(SHIFT_OUT,HIGH);
  1079. WRITE(SHIFT_LD,HIGH);
  1080. WRITE(SHIFT_EN,LOW);
  1081. #else
  1082. #ifdef ULTIPANEL
  1083. #error ULTIPANEL requires an encoder
  1084. #endif
  1085. #endif // SR_LCD_2W_NL
  1086. #endif//!NEWPANEL
  1087. #if defined(SDSUPPORT) && defined(SDCARDDETECT) && (SDCARDDETECT > 0)
  1088. pinMode(SDCARDDETECT, INPUT);
  1089. WRITE(SDCARDDETECT, HIGH);
  1090. lcd_oldcardstatus = IS_SD_INSERTED;
  1091. #endif //(SDCARDDETECT > 0)
  1092. #ifdef LCD_HAS_SLOW_BUTTONS
  1093. slow_buttons = 0;
  1094. #endif
  1095. lcd_buttons_update();
  1096. #ifdef ULTIPANEL
  1097. encoderDiff = 0;
  1098. #endif
  1099. }
  1100. int lcd_strlen(char *s) {
  1101. int i = 0, j = 0;
  1102. while (s[i]) {
  1103. if ((s[i] & 0xc0) != 0x80) j++;
  1104. i++;
  1105. }
  1106. return j;
  1107. }
  1108. int lcd_strlen_P(const char *s) {
  1109. int j = 0;
  1110. while (pgm_read_byte(s)) {
  1111. if ((pgm_read_byte(s) & 0xc0) != 0x80) j++;
  1112. s++;
  1113. }
  1114. return j;
  1115. }
  1116. void lcd_update() {
  1117. static unsigned long timeoutToStatus = 0;
  1118. #ifdef LCD_HAS_SLOW_BUTTONS
  1119. slow_buttons = lcd_implementation_read_slow_buttons(); // buttons which take too long to read in interrupt context
  1120. #endif
  1121. lcd_buttons_update();
  1122. #if (SDCARDDETECT > 0)
  1123. if (IS_SD_INSERTED != lcd_oldcardstatus && lcd_detected()) {
  1124. lcdDrawUpdate = 2;
  1125. lcd_oldcardstatus = IS_SD_INSERTED;
  1126. lcd_implementation_init( // to maybe revive the LCD if static electricity killed it.
  1127. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT) && !defined(DOGLCD)
  1128. currentMenu == lcd_status_screen
  1129. #endif
  1130. );
  1131. if (lcd_oldcardstatus) {
  1132. card.initsd();
  1133. LCD_MESSAGEPGM(MSG_SD_INSERTED);
  1134. }
  1135. else {
  1136. card.release();
  1137. LCD_MESSAGEPGM(MSG_SD_REMOVED);
  1138. }
  1139. }
  1140. #endif//CARDINSERTED
  1141. long ms = millis();
  1142. if (ms > lcd_next_update_millis) {
  1143. #ifdef ULTIPANEL
  1144. #ifdef REPRAPWORLD_KEYPAD
  1145. if (REPRAPWORLD_KEYPAD_MOVE_Z_UP) reprapworld_keypad_move_z_up();
  1146. if (REPRAPWORLD_KEYPAD_MOVE_Z_DOWN) reprapworld_keypad_move_z_down();
  1147. if (REPRAPWORLD_KEYPAD_MOVE_X_LEFT) reprapworld_keypad_move_x_left();
  1148. if (REPRAPWORLD_KEYPAD_MOVE_X_RIGHT) reprapworld_keypad_move_x_right();
  1149. if (REPRAPWORLD_KEYPAD_MOVE_Y_DOWN) reprapworld_keypad_move_y_down();
  1150. if (REPRAPWORLD_KEYPAD_MOVE_Y_UP) reprapworld_keypad_move_y_up();
  1151. if (REPRAPWORLD_KEYPAD_MOVE_HOME) reprapworld_keypad_move_home();
  1152. #endif
  1153. bool encoderPastThreshold = (abs(encoderDiff) >= ENCODER_PULSES_PER_STEP);
  1154. if (encoderPastThreshold || LCD_CLICKED) {
  1155. if (encoderPastThreshold) {
  1156. int32_t encoderMultiplier = 1;
  1157. #ifdef ENCODER_RATE_MULTIPLIER
  1158. if (encoderRateMultiplierEnabled) {
  1159. int32_t encoderMovementSteps = abs(encoderDiff) / ENCODER_PULSES_PER_STEP;
  1160. if (lastEncoderMovementMillis != 0) {
  1161. // Note that the rate is always calculated between to passes through the
  1162. // loop and that the abs of the encoderDiff value is tracked.
  1163. float encoderStepRate = (float)(encoderMovementSteps) / ((float)(ms - lastEncoderMovementMillis)) * 1000.0;
  1164. if (encoderStepRate >= ENCODER_100X_STEPS_PER_SEC) encoderMultiplier = 100;
  1165. else if (encoderStepRate >= ENCODER_10X_STEPS_PER_SEC) encoderMultiplier = 10;
  1166. #ifdef ENCODER_RATE_MULTIPLIER_DEBUG
  1167. SERIAL_ECHO_START;
  1168. SERIAL_ECHO("Enc Step Rate: ");
  1169. SERIAL_ECHO(encoderStepRate);
  1170. SERIAL_ECHO(" Multiplier: ");
  1171. SERIAL_ECHO(encoderMultiplier);
  1172. SERIAL_ECHO(" ENCODER_10X_STEPS_PER_SEC: ");
  1173. SERIAL_ECHO(ENCODER_10X_STEPS_PER_SEC);
  1174. SERIAL_ECHO(" ENCODER_100X_STEPS_PER_SEC: ");
  1175. SERIAL_ECHOLN(ENCODER_100X_STEPS_PER_SEC);
  1176. #endif //ENCODER_RATE_MULTIPLIER_DEBUG
  1177. }
  1178. lastEncoderMovementMillis = ms;
  1179. }
  1180. #endif //ENCODER_RATE_MULTIPLIER
  1181. lcdDrawUpdate = 1;
  1182. encoderPosition += (encoderDiff * encoderMultiplier) / ENCODER_PULSES_PER_STEP;
  1183. encoderDiff = 0;
  1184. }
  1185. timeoutToStatus = ms + LCD_TIMEOUT_TO_STATUS;
  1186. }
  1187. #endif //ULTIPANEL
  1188. #ifdef DOGLCD // Changes due to different driver architecture of the DOGM display
  1189. blink++; // Variable for fan animation and alive dot
  1190. u8g.firstPage();
  1191. do {
  1192. u8g.setFont(FONT_MENU);
  1193. u8g.setPrintPos(125, 0);
  1194. if (blink % 2) u8g.setColorIndex(1); else u8g.setColorIndex(0); // Set color for the alive dot
  1195. u8g.drawPixel(127, 63); // draw alive dot
  1196. u8g.setColorIndex(1); // black on white
  1197. (*currentMenu)();
  1198. if (!lcdDrawUpdate) break; // Terminate display update, when nothing new to draw. This must be done before the last dogm.next()
  1199. } while( u8g.nextPage() );
  1200. #else
  1201. (*currentMenu)();
  1202. #endif
  1203. #ifdef LCD_HAS_STATUS_INDICATORS
  1204. lcd_implementation_update_indicators();
  1205. #endif
  1206. #ifdef ULTIPANEL
  1207. if (currentMenu != lcd_status_screen &&
  1208. #if defined(MANUAL_BED_LEVELING)
  1209. currentMenu != _lcd_level_bed &&
  1210. currentMenu != _lcd_level_bed_homing &&
  1211. #endif // MANUAL_BED_LEVELING
  1212. millis() > timeoutToStatus) {
  1213. lcd_return_to_status();
  1214. lcdDrawUpdate = 2;
  1215. }
  1216. #endif //ULTIPANEL
  1217. if (lcdDrawUpdate == 2) lcd_implementation_clear();
  1218. if (lcdDrawUpdate) lcdDrawUpdate--;
  1219. lcd_next_update_millis = millis() + LCD_UPDATE_INTERVAL;
  1220. }
  1221. }
  1222. void lcd_ignore_click(bool b) {
  1223. ignore_click = b;
  1224. wait_for_unclick = false;
  1225. }
  1226. void lcd_finishstatus() {
  1227. int len = lcd_strlen(lcd_status_message);
  1228. if (len > 0) {
  1229. while (len < LCD_WIDTH) {
  1230. lcd_status_message[len++] = ' ';
  1231. }
  1232. }
  1233. lcd_status_message[LCD_WIDTH] = '\0';
  1234. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT) && !defined(DOGLCD)
  1235. #if PROGRESS_MSG_EXPIRE > 0
  1236. messageTick =
  1237. #endif
  1238. progressBarTick = millis();
  1239. #endif
  1240. lcdDrawUpdate = 2;
  1241. #ifdef FILAMENT_LCD_DISPLAY
  1242. message_millis = millis(); //get status message to show up for a while
  1243. #endif
  1244. }
  1245. void lcd_setstatus(const char* message) {
  1246. if (lcd_status_message_level > 0) return;
  1247. strncpy(lcd_status_message, message, LCD_WIDTH);
  1248. lcd_finishstatus();
  1249. }
  1250. void lcd_setstatuspgm(const char* message) {
  1251. if (lcd_status_message_level > 0) return;
  1252. strncpy_P(lcd_status_message, message, LCD_WIDTH);
  1253. lcd_finishstatus();
  1254. }
  1255. void lcd_setalertstatuspgm(const char* message) {
  1256. lcd_setstatuspgm(message);
  1257. lcd_status_message_level = 1;
  1258. #ifdef ULTIPANEL
  1259. lcd_return_to_status();
  1260. #endif
  1261. }
  1262. void lcd_reset_alert_level() { lcd_status_message_level = 0; }
  1263. #ifdef DOGLCD
  1264. void lcd_setcontrast(uint8_t value) {
  1265. lcd_contrast = value & 63;
  1266. u8g.setContrast(lcd_contrast);
  1267. }
  1268. #endif
  1269. #ifdef ULTIPANEL
  1270. ////////////////////////
  1271. // Setup Rotary Encoder Bit Values (for two pin encoders to indicate movement)
  1272. // These values are independent of which pins are used for EN_A and EN_B indications
  1273. // The rotary encoder part is also independent to the chipset used for the LCD
  1274. #if defined(EN_A) && defined(EN_B)
  1275. #define encrot0 0
  1276. #define encrot1 2
  1277. #define encrot2 3
  1278. #define encrot3 1
  1279. #endif
  1280. /* Warning: This function is called from interrupt context */
  1281. void lcd_buttons_update() {
  1282. #ifdef NEWPANEL
  1283. uint8_t newbutton = 0;
  1284. if (READ(BTN_EN1) == 0) newbutton |= EN_A;
  1285. if (READ(BTN_EN2) == 0) newbutton |= EN_B;
  1286. #if BTN_ENC > 0
  1287. if (millis() > blocking_enc && READ(BTN_ENC) == 0) newbutton |= EN_C;
  1288. #endif
  1289. buttons = newbutton;
  1290. #ifdef LCD_HAS_SLOW_BUTTONS
  1291. buttons |= slow_buttons;
  1292. #endif
  1293. #ifdef REPRAPWORLD_KEYPAD
  1294. // for the reprapworld_keypad
  1295. uint8_t newbutton_reprapworld_keypad=0;
  1296. WRITE(SHIFT_LD, LOW);
  1297. WRITE(SHIFT_LD, HIGH);
  1298. for(int8_t i = 0; i < 8; i++) {
  1299. newbutton_reprapworld_keypad >>= 1;
  1300. if (READ(SHIFT_OUT)) newbutton_reprapworld_keypad |= BIT(7);
  1301. WRITE(SHIFT_CLK, HIGH);
  1302. WRITE(SHIFT_CLK, LOW);
  1303. }
  1304. buttons_reprapworld_keypad=~newbutton_reprapworld_keypad; //invert it, because a pressed switch produces a logical 0
  1305. #endif
  1306. #else //read it from the shift register
  1307. uint8_t newbutton = 0;
  1308. WRITE(SHIFT_LD, LOW);
  1309. WRITE(SHIFT_LD, HIGH);
  1310. unsigned char tmp_buttons = 0;
  1311. for(int8_t i=0; i<8; i++) {
  1312. newbutton >>= 1;
  1313. if (READ(SHIFT_OUT)) newbutton |= BIT(7);
  1314. WRITE(SHIFT_CLK, HIGH);
  1315. WRITE(SHIFT_CLK, LOW);
  1316. }
  1317. buttons = ~newbutton; //invert it, because a pressed switch produces a logical 0
  1318. #endif //!NEWPANEL
  1319. //manage encoder rotation
  1320. uint8_t enc=0;
  1321. if (buttons & EN_A) enc |= B01;
  1322. if (buttons & EN_B) enc |= B10;
  1323. if (enc != lastEncoderBits) {
  1324. switch(enc) {
  1325. case encrot0:
  1326. if (lastEncoderBits==encrot3) encoderDiff++;
  1327. else if (lastEncoderBits==encrot1) encoderDiff--;
  1328. break;
  1329. case encrot1:
  1330. if (lastEncoderBits==encrot0) encoderDiff++;
  1331. else if (lastEncoderBits==encrot2) encoderDiff--;
  1332. break;
  1333. case encrot2:
  1334. if (lastEncoderBits==encrot1) encoderDiff++;
  1335. else if (lastEncoderBits==encrot3) encoderDiff--;
  1336. break;
  1337. case encrot3:
  1338. if (lastEncoderBits==encrot2) encoderDiff++;
  1339. else if (lastEncoderBits==encrot0) encoderDiff--;
  1340. break;
  1341. }
  1342. }
  1343. lastEncoderBits = enc;
  1344. }
  1345. bool lcd_detected(void) {
  1346. #if (defined(LCD_I2C_TYPE_MCP23017) || defined(LCD_I2C_TYPE_MCP23008)) && defined(DETECT_DEVICE)
  1347. return lcd.LcdDetected() == 1;
  1348. #else
  1349. return true;
  1350. #endif
  1351. }
  1352. void lcd_buzz(long duration, uint16_t freq) {
  1353. #ifdef LCD_USE_I2C_BUZZER
  1354. lcd.buzz(duration,freq);
  1355. #endif
  1356. }
  1357. bool lcd_clicked() { return LCD_CLICKED; }
  1358. #endif //ULTIPANEL
  1359. /********************************/
  1360. /** Float conversion utilities **/
  1361. /********************************/
  1362. // convert float to string with +123.4 format
  1363. char conv[8];
  1364. char *ftostr3(const float &x)
  1365. {
  1366. return itostr3((int)x);
  1367. }
  1368. char *itostr2(const uint8_t &x)
  1369. {
  1370. //sprintf(conv,"%5.1f",x);
  1371. int xx=x;
  1372. conv[0]=(xx/10)%10+'0';
  1373. conv[1]=(xx)%10+'0';
  1374. conv[2]=0;
  1375. return conv;
  1376. }
  1377. // Convert float to string with 123.4 format, dropping sign
  1378. char *ftostr31(const float &x)
  1379. {
  1380. int xx=x*10;
  1381. conv[0]=(xx>=0)?'+':'-';
  1382. xx=abs(xx);
  1383. conv[1]=(xx/1000)%10+'0';
  1384. conv[2]=(xx/100)%10+'0';
  1385. conv[3]=(xx/10)%10+'0';
  1386. conv[4]='.';
  1387. conv[5]=(xx)%10+'0';
  1388. conv[6]=0;
  1389. return conv;
  1390. }
  1391. // Convert float to string with 123.4 format
  1392. char *ftostr31ns(const float &x)
  1393. {
  1394. int xx=x*10;
  1395. //conv[0]=(xx>=0)?'+':'-';
  1396. xx=abs(xx);
  1397. conv[0]=(xx/1000)%10+'0';
  1398. conv[1]=(xx/100)%10+'0';
  1399. conv[2]=(xx/10)%10+'0';
  1400. conv[3]='.';
  1401. conv[4]=(xx)%10+'0';
  1402. conv[5]=0;
  1403. return conv;
  1404. }
  1405. char *ftostr32(const float &x)
  1406. {
  1407. long xx=x*100;
  1408. if (xx >= 0)
  1409. conv[0]=(xx/10000)%10+'0';
  1410. else
  1411. conv[0]='-';
  1412. xx=abs(xx);
  1413. conv[1]=(xx/1000)%10+'0';
  1414. conv[2]=(xx/100)%10+'0';
  1415. conv[3]='.';
  1416. conv[4]=(xx/10)%10+'0';
  1417. conv[5]=(xx)%10+'0';
  1418. conv[6]=0;
  1419. return conv;
  1420. }
  1421. // Convert float to string with 1.234 format
  1422. char *ftostr43(const float &x)
  1423. {
  1424. long xx = x * 1000;
  1425. if (xx >= 0)
  1426. conv[0] = (xx / 1000) % 10 + '0';
  1427. else
  1428. conv[0] = '-';
  1429. xx = abs(xx);
  1430. conv[1] = '.';
  1431. conv[2] = (xx / 100) % 10 + '0';
  1432. conv[3] = (xx / 10) % 10 + '0';
  1433. conv[4] = (xx) % 10 + '0';
  1434. conv[5] = 0;
  1435. return conv;
  1436. }
  1437. //Float to string with 1.23 format
  1438. char *ftostr12ns(const float &x)
  1439. {
  1440. long xx=x*100;
  1441. xx=abs(xx);
  1442. conv[0]=(xx/100)%10+'0';
  1443. conv[1]='.';
  1444. conv[2]=(xx/10)%10+'0';
  1445. conv[3]=(xx)%10+'0';
  1446. conv[4]=0;
  1447. return conv;
  1448. }
  1449. // convert float to space-padded string with -_23.4_ format
  1450. char *ftostr32sp(const float &x) {
  1451. long xx = abs(x * 100);
  1452. uint8_t dig;
  1453. if (x < 0) { // negative val = -_0
  1454. conv[0] = '-';
  1455. dig = (xx / 1000) % 10;
  1456. conv[1] = dig ? '0' + dig : ' ';
  1457. }
  1458. else { // positive val = __0
  1459. dig = (xx / 10000) % 10;
  1460. if (dig) {
  1461. conv[0] = '0' + dig;
  1462. conv[1] = '0' + (xx / 1000) % 10;
  1463. }
  1464. else {
  1465. conv[0] = ' ';
  1466. dig = (xx / 1000) % 10;
  1467. conv[1] = dig ? '0' + dig : ' ';
  1468. }
  1469. }
  1470. conv[2] = '0' + (xx / 100) % 10; // lsd always
  1471. dig = xx % 10;
  1472. if (dig) { // 2 decimal places
  1473. conv[5] = '0' + dig;
  1474. conv[4] = '0' + (xx / 10) % 10;
  1475. conv[3] = '.';
  1476. }
  1477. else { // 1 or 0 decimal place
  1478. dig = (xx / 10) % 10;
  1479. if (dig) {
  1480. conv[4] = '0' + dig;
  1481. conv[3] = '.';
  1482. }
  1483. else {
  1484. conv[3] = conv[4] = ' ';
  1485. }
  1486. conv[5] = ' ';
  1487. }
  1488. conv[6] = '\0';
  1489. return conv;
  1490. }
  1491. char *itostr31(const int &xx)
  1492. {
  1493. conv[0]=(xx>=0)?'+':'-';
  1494. conv[1]=(xx/1000)%10+'0';
  1495. conv[2]=(xx/100)%10+'0';
  1496. conv[3]=(xx/10)%10+'0';
  1497. conv[4]='.';
  1498. conv[5]=(xx)%10+'0';
  1499. conv[6]=0;
  1500. return conv;
  1501. }
  1502. // Convert int to rj string with 123 or -12 format
  1503. char *itostr3(const int &x)
  1504. {
  1505. int xx = x;
  1506. if (xx < 0) {
  1507. conv[0]='-';
  1508. xx = -xx;
  1509. } else if (xx >= 100)
  1510. conv[0]=(xx/100)%10+'0';
  1511. else
  1512. conv[0]=' ';
  1513. if (xx >= 10)
  1514. conv[1]=(xx/10)%10+'0';
  1515. else
  1516. conv[1]=' ';
  1517. conv[2]=(xx)%10+'0';
  1518. conv[3]=0;
  1519. return conv;
  1520. }
  1521. // Convert int to lj string with 123 format
  1522. char *itostr3left(const int &xx)
  1523. {
  1524. if (xx >= 100)
  1525. {
  1526. conv[0]=(xx/100)%10+'0';
  1527. conv[1]=(xx/10)%10+'0';
  1528. conv[2]=(xx)%10+'0';
  1529. conv[3]=0;
  1530. }
  1531. else if (xx >= 10)
  1532. {
  1533. conv[0]=(xx/10)%10+'0';
  1534. conv[1]=(xx)%10+'0';
  1535. conv[2]=0;
  1536. }
  1537. else
  1538. {
  1539. conv[0]=(xx)%10+'0';
  1540. conv[1]=0;
  1541. }
  1542. return conv;
  1543. }
  1544. // Convert int to rj string with 1234 format
  1545. char *itostr4(const int &xx) {
  1546. conv[0] = xx >= 1000 ? (xx / 1000) % 10 + '0' : ' ';
  1547. conv[1] = xx >= 100 ? (xx / 100) % 10 + '0' : ' ';
  1548. conv[2] = xx >= 10 ? (xx / 10) % 10 + '0' : ' ';
  1549. conv[3] = xx % 10 + '0';
  1550. conv[4] = 0;
  1551. return conv;
  1552. }
  1553. // Convert float to rj string with 12345 format
  1554. char *ftostr5(const float &x) {
  1555. long xx = abs(x);
  1556. conv[0] = xx >= 10000 ? (xx / 10000) % 10 + '0' : ' ';
  1557. conv[1] = xx >= 1000 ? (xx / 1000) % 10 + '0' : ' ';
  1558. conv[2] = xx >= 100 ? (xx / 100) % 10 + '0' : ' ';
  1559. conv[3] = xx >= 10 ? (xx / 10) % 10 + '0' : ' ';
  1560. conv[4] = xx % 10 + '0';
  1561. conv[5] = 0;
  1562. return conv;
  1563. }
  1564. // Convert float to string with +1234.5 format
  1565. char *ftostr51(const float &x)
  1566. {
  1567. long xx=x*10;
  1568. conv[0]=(xx>=0)?'+':'-';
  1569. xx=abs(xx);
  1570. conv[1]=(xx/10000)%10+'0';
  1571. conv[2]=(xx/1000)%10+'0';
  1572. conv[3]=(xx/100)%10+'0';
  1573. conv[4]=(xx/10)%10+'0';
  1574. conv[5]='.';
  1575. conv[6]=(xx)%10+'0';
  1576. conv[7]=0;
  1577. return conv;
  1578. }
  1579. // Convert float to string with +123.45 format
  1580. char *ftostr52(const float &x)
  1581. {
  1582. long xx=x*100;
  1583. conv[0]=(xx>=0)?'+':'-';
  1584. xx=abs(xx);
  1585. conv[1]=(xx/10000)%10+'0';
  1586. conv[2]=(xx/1000)%10+'0';
  1587. conv[3]=(xx/100)%10+'0';
  1588. conv[4]='.';
  1589. conv[5]=(xx/10)%10+'0';
  1590. conv[6]=(xx)%10+'0';
  1591. conv[7]=0;
  1592. return conv;
  1593. }
  1594. #if defined(MANUAL_BED_LEVELING)
  1595. static int _lcd_level_bed_position;
  1596. static void _lcd_level_bed()
  1597. {
  1598. if (encoderPosition != 0) {
  1599. refresh_cmd_timeout();
  1600. current_position[Z_AXIS] += float((int)encoderPosition) * 0.05;
  1601. if (min_software_endstops && current_position[Z_AXIS] < Z_MIN_POS) current_position[Z_AXIS] = Z_MIN_POS;
  1602. if (max_software_endstops && current_position[Z_AXIS] > Z_MAX_POS) current_position[Z_AXIS] = Z_MAX_POS;
  1603. encoderPosition = 0;
  1604. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], manual_feedrate[Z_AXIS]/60, active_extruder);
  1605. lcdDrawUpdate = 1;
  1606. }
  1607. if (lcdDrawUpdate) lcd_implementation_drawedit(PSTR("Z"), ftostr32(current_position[Z_AXIS]));
  1608. static bool debounce_click = false;
  1609. if (LCD_CLICKED) {
  1610. if (!debounce_click) {
  1611. debounce_click = true;
  1612. int ix = _lcd_level_bed_position % MESH_NUM_X_POINTS;
  1613. int iy = _lcd_level_bed_position / MESH_NUM_X_POINTS;
  1614. mbl.set_z(ix, iy, current_position[Z_AXIS]);
  1615. _lcd_level_bed_position++;
  1616. if (_lcd_level_bed_position == MESH_NUM_X_POINTS*MESH_NUM_Y_POINTS) {
  1617. current_position[Z_AXIS] = MESH_HOME_SEARCH_Z;
  1618. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], manual_feedrate[X_AXIS]/60, active_extruder);
  1619. mbl.active = 1;
  1620. enquecommands_P(PSTR("G28"));
  1621. lcd_return_to_status();
  1622. } else {
  1623. current_position[Z_AXIS] = MESH_HOME_SEARCH_Z;
  1624. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], manual_feedrate[X_AXIS]/60, active_extruder);
  1625. ix = _lcd_level_bed_position % MESH_NUM_X_POINTS;
  1626. iy = _lcd_level_bed_position / MESH_NUM_X_POINTS;
  1627. if (iy&1) { // Zig zag
  1628. ix = (MESH_NUM_X_POINTS - 1) - ix;
  1629. }
  1630. current_position[X_AXIS] = mbl.get_x(ix);
  1631. current_position[Y_AXIS] = mbl.get_y(iy);
  1632. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], manual_feedrate[X_AXIS]/60, active_extruder);
  1633. lcdDrawUpdate = 1;
  1634. }
  1635. }
  1636. } else {
  1637. debounce_click = false;
  1638. }
  1639. }
  1640. static void _lcd_level_bed_homing()
  1641. {
  1642. if (axis_known_position[X_AXIS] &&
  1643. axis_known_position[Y_AXIS] &&
  1644. axis_known_position[Z_AXIS]) {
  1645. current_position[Z_AXIS] = MESH_HOME_SEARCH_Z;
  1646. plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
  1647. current_position[X_AXIS] = MESH_MIN_X;
  1648. current_position[Y_AXIS] = MESH_MIN_Y;
  1649. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], manual_feedrate[X_AXIS]/60, active_extruder);
  1650. _lcd_level_bed_position = 0;
  1651. lcd_goto_menu(_lcd_level_bed);
  1652. }
  1653. }
  1654. static void lcd_level_bed()
  1655. {
  1656. axis_known_position[X_AXIS] = false;
  1657. axis_known_position[Y_AXIS] = false;
  1658. axis_known_position[Z_AXIS] = false;
  1659. mbl.reset();
  1660. enquecommands_P(PSTR("G28"));
  1661. lcd_goto_menu(_lcd_level_bed_homing);
  1662. }
  1663. #endif // MANUAL_BED_LEVELING
  1664. #endif //ULTRA_LCD