1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240 |
- #include "temperature.h"
- #include "ultralcd.h"
- #ifdef ULTRA_LCD
- #include "Marlin.h"
- #include "language.h"
- #include "cardreader.h"
- #include "temperature.h"
- #include "stepper.h"
- #include "ConfigurationStore.h"
-
- /* Configuration settings */
- int plaPreheatHotendTemp;
- int plaPreheatHPBTemp;
- int plaPreheatFanSpeed;
-
- int absPreheatHotendTemp;
- int absPreheatHPBTemp;
- int absPreheatFanSpeed;
- /* !Configuration settings */
-
- //Function pointer to menu functions.
- typedef void (*menuFunc_t)();
-
- uint8_t lcd_status_message_level;
- char lcd_status_message[LCD_WIDTH+1] = WELCOME_MSG;
-
- #ifdef DOGLCD
- #include "dogm_lcd_implementation.h"
- #else
- #include "ultralcd_implementation_hitachi_HD44780.h"
- #endif
-
- /** forward declerations **/
-
- void copy_and_scalePID_i();
- void copy_and_scalePID_d();
-
- /* Different menus */
- static void lcd_status_screen();
- #ifdef ULTIPANEL
- static void lcd_main_menu();
- static void lcd_tune_menu();
- static void lcd_prepare_menu();
- static void lcd_move_menu();
- static void lcd_control_menu();
- static void lcd_control_temperature_menu();
- static void lcd_control_temperature_preheat_pla_settings_menu();
- static void lcd_control_temperature_preheat_abs_settings_menu();
- static void lcd_control_motion_menu();
- static void lcd_control_retract_menu();
- static void lcd_sdcard_menu();
-
- static void lcd_quick_feedback();//Cause an LCD refresh, and give the user visual or audiable feedback that something has happend
-
- /* Different types of actions that can be used in menuitems. */
- static void menu_action_back(menuFunc_t data);
- static void menu_action_submenu(menuFunc_t data);
- static void menu_action_gcode(const char* pgcode);
- static void menu_action_function(menuFunc_t data);
- static void menu_action_sdfile(const char* filename, char* longFilename);
- static void menu_action_sddirectory(const char* filename, char* longFilename);
- static void menu_action_setting_edit_bool(const char* pstr, bool* ptr);
- static void menu_action_setting_edit_int3(const char* pstr, int* ptr, int minValue, int maxValue);
- static void menu_action_setting_edit_float3(const char* pstr, float* ptr, float minValue, float maxValue);
- static void menu_action_setting_edit_float32(const char* pstr, float* ptr, float minValue, float maxValue);
- static void menu_action_setting_edit_float5(const char* pstr, float* ptr, float minValue, float maxValue);
- static void menu_action_setting_edit_float51(const char* pstr, float* ptr, float minValue, float maxValue);
- static void menu_action_setting_edit_float52(const char* pstr, float* ptr, float minValue, float maxValue);
- static void menu_action_setting_edit_long5(const char* pstr, unsigned long* ptr, unsigned long minValue, unsigned long maxValue);
- static void menu_action_setting_edit_callback_bool(const char* pstr, bool* ptr, menuFunc_t callbackFunc);
- static void menu_action_setting_edit_callback_int3(const char* pstr, int* ptr, int minValue, int maxValue, menuFunc_t callbackFunc);
- static void menu_action_setting_edit_callback_float3(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
- static void menu_action_setting_edit_callback_float32(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
- static void menu_action_setting_edit_callback_float5(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
- static void menu_action_setting_edit_callback_float51(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
- static void menu_action_setting_edit_callback_float52(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
- static void menu_action_setting_edit_callback_long5(const char* pstr, unsigned long* ptr, unsigned long minValue, unsigned long maxValue, menuFunc_t callbackFunc);
-
- #if !defined(LCD_I2C_VIKI)
- #define ENCODER_STEPS_PER_MENU_ITEM 5
- #else
- #define ENCODER_STEPS_PER_MENU_ITEM 2 // VIKI LCD rotary encoder uses a different number of steps per rotation
- #endif
-
- /* Helper macros for menus */
- #define START_MENU() do { \
- if (encoderPosition > 0x8000) encoderPosition = 0; \
- if (encoderPosition / ENCODER_STEPS_PER_MENU_ITEM < currentMenuViewOffset) currentMenuViewOffset = encoderPosition / ENCODER_STEPS_PER_MENU_ITEM;\
- uint8_t _lineNr = currentMenuViewOffset, _menuItemNr; \
- for(uint8_t _drawLineNr = 0; _drawLineNr < LCD_HEIGHT; _drawLineNr++, _lineNr++) { \
- _menuItemNr = 0;
- #define MENU_ITEM(type, label, args...) do { \
- if (_menuItemNr == _lineNr) { \
- if (lcdDrawUpdate) { \
- const char* _label_pstr = PSTR(label); \
- if ((encoderPosition / ENCODER_STEPS_PER_MENU_ITEM) == _menuItemNr) { \
- lcd_implementation_drawmenu_ ## type ## _selected (_drawLineNr, _label_pstr , ## args ); \
- }else{\
- lcd_implementation_drawmenu_ ## type (_drawLineNr, _label_pstr , ## args ); \
- }\
- }\
- if (LCD_CLICKED && (encoderPosition / ENCODER_STEPS_PER_MENU_ITEM) == _menuItemNr) {\
- lcd_quick_feedback(); \
- menu_action_ ## type ( args ); \
- return;\
- }\
- }\
- _menuItemNr++;\
- } while(0)
- #define MENU_ITEM_DUMMY() do { _menuItemNr++; } while(0)
- #define MENU_ITEM_EDIT(type, label, args...) MENU_ITEM(setting_edit_ ## type, label, PSTR(label) , ## args )
- #define MENU_ITEM_EDIT_CALLBACK(type, label, args...) MENU_ITEM(setting_edit_callback_ ## type, label, PSTR(label) , ## args )
- #define END_MENU() \
- if (encoderPosition / ENCODER_STEPS_PER_MENU_ITEM >= _menuItemNr) encoderPosition = _menuItemNr * ENCODER_STEPS_PER_MENU_ITEM - 1; \
- 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; } \
- } } while(0)
-
- /** Used variables to keep track of the menu */
- #ifndef REPRAPWORLD_KEYPAD
- volatile uint8_t buttons;//Contains the bits of the currently pressed buttons.
- #else
- volatile uint16_t buttons;//Contains the bits of the currently pressed buttons (extended).
- #endif
-
- uint8_t currentMenuViewOffset; /* scroll offset in the current menu */
- uint32_t blocking_enc;
- uint8_t lastEncoderBits;
- int8_t encoderDiff; /* encoderDiff is updated from interrupt context and added to encoderPosition every LCD update */
- uint32_t encoderPosition;
- #if (SDCARDDETECT > 0)
- bool lcd_oldcardstatus;
- #endif
- #endif//ULTIPANEL
-
- menuFunc_t currentMenu = lcd_status_screen; /* function pointer to the currently active menu */
- uint32_t lcd_next_update_millis;
- uint8_t lcd_status_update_delay;
- 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 atleast 1 full redraw (first redraw is partial) */
-
- //prevMenu and prevEncoderPosition are used to store the previous menu location when editing settings.
- menuFunc_t prevMenu = NULL;
- uint16_t prevEncoderPosition;
- //Variables used when editing values.
- const char* editLabel;
- void* editValue;
- int32_t minEditValue, maxEditValue;
- menuFunc_t callbackFunc;
-
- // placeholders for Ki and Kd edits
- float raw_Ki, raw_Kd;
-
- /* Main status screen. It's up to the implementation specific part to show what is needed. As this is very display dependend */
- static void lcd_status_screen()
- {
- if (lcd_status_update_delay)
- lcd_status_update_delay--;
- else
- lcdDrawUpdate = 1;
- if (lcdDrawUpdate)
- {
- lcd_implementation_status_screen();
- 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 */
- }
- #ifdef ULTIPANEL
- if (LCD_CLICKED)
- {
- currentMenu = lcd_main_menu;
- lcd_quick_feedback();
- }
- feedmultiply += int(encoderPosition);
- encoderPosition = 0;
- if (feedmultiply < 10)
- feedmultiply = 10;
- if (feedmultiply > 999)
- feedmultiply = 999;
- #endif//ULTIPANEL
- }
-
- #ifdef ULTIPANEL
- static void lcd_return_to_status()
- {
- encoderPosition = 0;
- currentMenu = lcd_status_screen;
- }
-
- static void lcd_sdcard_pause()
- {
- card.pauseSDPrint();
- }
- static void lcd_sdcard_resume()
- {
- card.startFileprint();
- }
-
- static void lcd_sdcard_stop()
- {
- card.sdprinting = false;
- card.closefile();
- quickStop();
- if(SD_FINISHED_STEPPERRELEASE)
- {
- enquecommand_P(PSTR(SD_FINISHED_RELEASECOMMAND));
- }
- autotempShutdown();
- }
-
- /* Menu implementation */
- static void lcd_main_menu()
- {
- START_MENU();
- MENU_ITEM(back, MSG_WATCH, lcd_status_screen);
- if (movesplanned() || IS_SD_PRINTING)
- {
- MENU_ITEM(submenu, MSG_TUNE, lcd_tune_menu);
- }else{
- MENU_ITEM(submenu, MSG_PREPARE, lcd_prepare_menu);
- }
- MENU_ITEM(submenu, MSG_CONTROL, lcd_control_menu);
- #ifdef SDSUPPORT
- if (card.cardOK)
- {
- if (card.isFileOpen())
- {
- if (card.sdprinting)
- MENU_ITEM(function, MSG_PAUSE_PRINT, lcd_sdcard_pause);
- else
- MENU_ITEM(function, MSG_RESUME_PRINT, lcd_sdcard_resume);
- MENU_ITEM(function, MSG_STOP_PRINT, lcd_sdcard_stop);
- }else{
- MENU_ITEM(submenu, MSG_CARD_MENU, lcd_sdcard_menu);
- #if SDCARDDETECT < 1
- MENU_ITEM(gcode, MSG_CNG_SDCARD, PSTR("M21")); // SD-card changed by user
- #endif
- }
- }else{
- MENU_ITEM(submenu, MSG_NO_CARD, lcd_sdcard_menu);
- #if SDCARDDETECT < 1
- MENU_ITEM(gcode, MSG_INIT_SDCARD, PSTR("M21")); // Manually initialize the SD-card via user interface
- #endif
- }
- #endif
- END_MENU();
- }
-
- #ifdef SDSUPPORT
- static void lcd_autostart_sd()
- {
- card.lastnr=0;
- card.setroot();
- card.checkautostart(true);
- }
- #endif
-
- void lcd_preheat_pla()
- {
- setTargetHotend0(plaPreheatHotendTemp);
- setTargetHotend1(plaPreheatHotendTemp);
- setTargetHotend2(plaPreheatHotendTemp);
- setTargetBed(plaPreheatHPBTemp);
- fanSpeed = plaPreheatFanSpeed;
- lcd_return_to_status();
- setWatch(); // heater sanity check timer
- }
-
- void lcd_preheat_abs()
- {
- setTargetHotend0(absPreheatHotendTemp);
- setTargetHotend1(absPreheatHotendTemp);
- setTargetHotend2(absPreheatHotendTemp);
- setTargetBed(absPreheatHPBTemp);
- fanSpeed = absPreheatFanSpeed;
- lcd_return_to_status();
- setWatch(); // heater sanity check timer
- }
-
- static void lcd_cooldown()
- {
- setTargetHotend0(0);
- setTargetHotend1(0);
- setTargetHotend2(0);
- setTargetBed(0);
- lcd_return_to_status();
- }
-
- static void lcd_tune_menu()
- {
- START_MENU();
- MENU_ITEM(back, MSG_MAIN, lcd_main_menu);
- MENU_ITEM_EDIT(int3, MSG_SPEED, &feedmultiply, 10, 999);
- MENU_ITEM_EDIT(int3, MSG_NOZZLE, &target_temperature[0], 0, HEATER_0_MAXTEMP - 15);
- #if TEMP_SENSOR_1 != 0
- MENU_ITEM_EDIT(int3, MSG_NOZZLE1, &target_temperature[1], 0, HEATER_1_MAXTEMP - 15);
- #endif
- #if TEMP_SENSOR_2 != 0
- MENU_ITEM_EDIT(int3, MSG_NOZZLE2, &target_temperature[2], 0, HEATER_2_MAXTEMP - 15);
- #endif
- #if TEMP_SENSOR_BED != 0
- MENU_ITEM_EDIT(int3, MSG_BED, &target_temperature_bed, 0, BED_MAXTEMP - 15);
- #endif
- MENU_ITEM_EDIT(int3, MSG_FAN_SPEED, &fanSpeed, 0, 255);
- MENU_ITEM_EDIT(int3, MSG_FLOW, &extrudemultiply, 10, 999);
- #ifdef FILAMENTCHANGEENABLE
- MENU_ITEM(gcode, MSG_FILAMENTCHANGE, PSTR("M600"));
- #endif
- END_MENU();
- }
-
- static void lcd_prepare_menu()
- {
- START_MENU();
- MENU_ITEM(back, MSG_MAIN, lcd_main_menu);
- #ifdef SDSUPPORT
- //MENU_ITEM(function, MSG_AUTOSTART, lcd_autostart_sd);
- #endif
- MENU_ITEM(gcode, MSG_DISABLE_STEPPERS, PSTR("M84"));
- MENU_ITEM(gcode, MSG_AUTO_HOME, PSTR("G28"));
- //MENU_ITEM(gcode, MSG_SET_ORIGIN, PSTR("G92 X0 Y0 Z0"));
- MENU_ITEM(function, MSG_PREHEAT_PLA, lcd_preheat_pla);
- MENU_ITEM(function, MSG_PREHEAT_ABS, lcd_preheat_abs);
- MENU_ITEM(function, MSG_COOLDOWN, lcd_cooldown);
- MENU_ITEM(submenu, MSG_MOVE_AXIS, lcd_move_menu);
- END_MENU();
- }
-
- float move_menu_scale;
- static void lcd_move_menu_axis();
-
- static void lcd_move_x()
- {
- if (encoderPosition != 0)
- {
- current_position[X_AXIS] += float((int)encoderPosition) * move_menu_scale;
- if (current_position[X_AXIS] < X_MIN_POS)
- current_position[X_AXIS] = X_MIN_POS;
- if (current_position[X_AXIS] > X_MAX_POS)
- current_position[X_AXIS] = X_MAX_POS;
- encoderPosition = 0;
- plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 600, active_extruder);
- lcdDrawUpdate = 1;
- }
- if (lcdDrawUpdate)
- {
- lcd_implementation_drawedit(PSTR("X"), ftostr31(current_position[X_AXIS]));
- }
- if (LCD_CLICKED)
- {
- lcd_quick_feedback();
- currentMenu = lcd_move_menu_axis;
- encoderPosition = 0;
- }
- }
- static void lcd_move_y()
- {
- if (encoderPosition != 0)
- {
- current_position[Y_AXIS] += float((int)encoderPosition) * move_menu_scale;
- if (current_position[Y_AXIS] < Y_MIN_POS)
- current_position[Y_AXIS] = Y_MIN_POS;
- if (current_position[Y_AXIS] > Y_MAX_POS)
- current_position[Y_AXIS] = Y_MAX_POS;
- encoderPosition = 0;
- plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 600, active_extruder);
- lcdDrawUpdate = 1;
- }
- if (lcdDrawUpdate)
- {
- lcd_implementation_drawedit(PSTR("Y"), ftostr31(current_position[Y_AXIS]));
- }
- if (LCD_CLICKED)
- {
- lcd_quick_feedback();
- currentMenu = lcd_move_menu_axis;
- encoderPosition = 0;
- }
- }
- static void lcd_move_z()
- {
- if (encoderPosition != 0)
- {
- current_position[Z_AXIS] += float((int)encoderPosition) * move_menu_scale;
- if (current_position[Z_AXIS] < Z_MIN_POS)
- current_position[Z_AXIS] = Z_MIN_POS;
- if (current_position[Z_AXIS] > Z_MAX_POS)
- current_position[Z_AXIS] = Z_MAX_POS;
- encoderPosition = 0;
- plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 60, active_extruder);
- lcdDrawUpdate = 1;
- }
- if (lcdDrawUpdate)
- {
- lcd_implementation_drawedit(PSTR("Z"), ftostr31(current_position[Z_AXIS]));
- }
- if (LCD_CLICKED)
- {
- lcd_quick_feedback();
- currentMenu = lcd_move_menu_axis;
- encoderPosition = 0;
- }
- }
- static void lcd_move_e()
- {
- if (encoderPosition != 0)
- {
- current_position[E_AXIS] += float((int)encoderPosition) * move_menu_scale;
- encoderPosition = 0;
- plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 20, active_extruder);
- lcdDrawUpdate = 1;
- }
- if (lcdDrawUpdate)
- {
- lcd_implementation_drawedit(PSTR("Extruder"), ftostr31(current_position[E_AXIS]));
- }
- if (LCD_CLICKED)
- {
- lcd_quick_feedback();
- currentMenu = lcd_move_menu_axis;
- encoderPosition = 0;
- }
- }
-
- static void lcd_move_menu_axis()
- {
- START_MENU();
- MENU_ITEM(back, MSG_MOVE_AXIS, lcd_move_menu);
- MENU_ITEM(submenu, "Move X", lcd_move_x);
- MENU_ITEM(submenu, "Move Y", lcd_move_y);
- if (move_menu_scale < 10.0)
- {
- MENU_ITEM(submenu, "Move Z", lcd_move_z);
- MENU_ITEM(submenu, "Extruder", lcd_move_e);
- }
- END_MENU();
- }
-
- static void lcd_move_menu_10mm()
- {
- move_menu_scale = 10.0;
- lcd_move_menu_axis();
- }
- static void lcd_move_menu_1mm()
- {
- move_menu_scale = 1.0;
- lcd_move_menu_axis();
- }
- static void lcd_move_menu_01mm()
- {
- move_menu_scale = 0.1;
- lcd_move_menu_axis();
- }
-
- static void lcd_move_menu()
- {
- START_MENU();
- MENU_ITEM(back, MSG_PREPARE, lcd_prepare_menu);
- MENU_ITEM(submenu, "Move 10mm", lcd_move_menu_10mm);
- MENU_ITEM(submenu, "Move 1mm", lcd_move_menu_1mm);
- MENU_ITEM(submenu, "Move 0.1mm", lcd_move_menu_01mm);
- //TODO:X,Y,Z,E
- END_MENU();
- }
-
- static void lcd_control_menu()
- {
- START_MENU();
- MENU_ITEM(back, MSG_MAIN, lcd_main_menu);
- MENU_ITEM(submenu, MSG_TEMPERATURE, lcd_control_temperature_menu);
- MENU_ITEM(submenu, MSG_MOTION, lcd_control_motion_menu);
- #ifdef FWRETRACT
- MENU_ITEM(submenu, MSG_RETRACT, lcd_control_retract_menu);
- #endif
- #ifdef EEPROM_SETTINGS
- MENU_ITEM(function, MSG_STORE_EPROM, Config_StoreSettings);
- MENU_ITEM(function, MSG_LOAD_EPROM, Config_RetrieveSettings);
- #endif
- MENU_ITEM(function, MSG_RESTORE_FAILSAFE, Config_ResetDefault);
- END_MENU();
- }
-
- static void lcd_control_temperature_menu()
- {
- // set up temp variables - undo the default scaling
- raw_Ki = unscalePID_i(Ki);
- raw_Kd = unscalePID_d(Kd);
-
- START_MENU();
- MENU_ITEM(back, MSG_CONTROL, lcd_control_menu);
- MENU_ITEM_EDIT(int3, MSG_NOZZLE, &target_temperature[0], 0, HEATER_0_MAXTEMP - 15);
- #if TEMP_SENSOR_1 != 0
- MENU_ITEM_EDIT(int3, MSG_NOZZLE1, &target_temperature[1], 0, HEATER_1_MAXTEMP - 15);
- #endif
- #if TEMP_SENSOR_2 != 0
- MENU_ITEM_EDIT(int3, MSG_NOZZLE2, &target_temperature[2], 0, HEATER_2_MAXTEMP - 15);
- #endif
- #if TEMP_SENSOR_BED != 0
- MENU_ITEM_EDIT(int3, MSG_BED, &target_temperature_bed, 0, BED_MAXTEMP - 15);
- #endif
- MENU_ITEM_EDIT(int3, MSG_FAN_SPEED, &fanSpeed, 0, 255);
- #ifdef AUTOTEMP
- MENU_ITEM_EDIT(bool, MSG_AUTOTEMP, &autotemp_enabled);
- MENU_ITEM_EDIT(float3, MSG_MIN, &autotemp_min, 0, HEATER_0_MAXTEMP - 15);
- MENU_ITEM_EDIT(float3, MSG_MAX, &autotemp_max, 0, HEATER_0_MAXTEMP - 15);
- MENU_ITEM_EDIT(float32, MSG_FACTOR, &autotemp_factor, 0.0, 1.0);
- #endif
- #ifdef PIDTEMP
- MENU_ITEM_EDIT(float52, MSG_PID_P, &Kp, 1, 9990);
- // i is typically a small value so allows values below 1
- MENU_ITEM_EDIT_CALLBACK(float52, MSG_PID_I, &raw_Ki, 0.01, 9990, copy_and_scalePID_i);
- MENU_ITEM_EDIT_CALLBACK(float52, MSG_PID_D, &raw_Kd, 1, 9990, copy_and_scalePID_d);
- # ifdef PID_ADD_EXTRUSION_RATE
- MENU_ITEM_EDIT(float3, MSG_PID_C, &Kc, 1, 9990);
- # endif//PID_ADD_EXTRUSION_RATE
- #endif//PIDTEMP
- MENU_ITEM(submenu, MSG_PREHEAT_PLA_SETTINGS, lcd_control_temperature_preheat_pla_settings_menu);
- MENU_ITEM(submenu, MSG_PREHEAT_ABS_SETTINGS, lcd_control_temperature_preheat_abs_settings_menu);
- END_MENU();
- }
-
- static void lcd_control_temperature_preheat_pla_settings_menu()
- {
- START_MENU();
- MENU_ITEM(back, MSG_TEMPERATURE, lcd_control_temperature_menu);
- MENU_ITEM_EDIT(int3, MSG_FAN_SPEED, &plaPreheatFanSpeed, 0, 255);
- MENU_ITEM_EDIT(int3, MSG_NOZZLE, &plaPreheatHotendTemp, 0, HEATER_0_MAXTEMP - 15);
- #if TEMP_SENSOR_BED != 0
- MENU_ITEM_EDIT(int3, MSG_BED, &plaPreheatHPBTemp, 0, BED_MAXTEMP - 15);
- #endif
- #ifdef EEPROM_SETTINGS
- MENU_ITEM(function, MSG_STORE_EPROM, Config_StoreSettings);
- #endif
- END_MENU();
- }
-
- static void lcd_control_temperature_preheat_abs_settings_menu()
- {
- START_MENU();
- MENU_ITEM(back, MSG_TEMPERATURE, lcd_control_temperature_menu);
- MENU_ITEM_EDIT(int3, MSG_FAN_SPEED, &absPreheatFanSpeed, 0, 255);
- MENU_ITEM_EDIT(int3, MSG_NOZZLE, &absPreheatHotendTemp, 0, HEATER_0_MAXTEMP - 15);
- #if TEMP_SENSOR_BED != 0
- MENU_ITEM_EDIT(int3, MSG_BED, &absPreheatHPBTemp, 0, BED_MAXTEMP - 15);
- #endif
- #ifdef EEPROM_SETTINGS
- MENU_ITEM(function, MSG_STORE_EPROM, Config_StoreSettings);
- #endif
- END_MENU();
- }
-
- static void lcd_control_motion_menu()
- {
- START_MENU();
- MENU_ITEM(back, MSG_CONTROL, lcd_control_menu);
- MENU_ITEM_EDIT(float5, MSG_ACC, &acceleration, 500, 99000);
- MENU_ITEM_EDIT(float3, MSG_VXY_JERK, &max_xy_jerk, 1, 990);
- MENU_ITEM_EDIT(float52, MSG_VZ_JERK, &max_z_jerk, 0.1, 990);
- MENU_ITEM_EDIT(float3, MSG_VE_JERK, &max_e_jerk, 1, 990);
- MENU_ITEM_EDIT(float3, MSG_VMAX MSG_X, &max_feedrate[X_AXIS], 1, 999);
- MENU_ITEM_EDIT(float3, MSG_VMAX MSG_Y, &max_feedrate[Y_AXIS], 1, 999);
- MENU_ITEM_EDIT(float3, MSG_VMAX MSG_Z, &max_feedrate[Z_AXIS], 1, 999);
- MENU_ITEM_EDIT(float3, MSG_VMAX MSG_E, &max_feedrate[E_AXIS], 1, 999);
- MENU_ITEM_EDIT(float3, MSG_VMIN, &minimumfeedrate, 0, 999);
- MENU_ITEM_EDIT(float3, MSG_VTRAV_MIN, &mintravelfeedrate, 0, 999);
- MENU_ITEM_EDIT_CALLBACK(long5, MSG_AMAX MSG_X, &max_acceleration_units_per_sq_second[X_AXIS], 100, 99000, reset_acceleration_rates);
- MENU_ITEM_EDIT_CALLBACK(long5, MSG_AMAX MSG_Y, &max_acceleration_units_per_sq_second[Y_AXIS], 100, 99000, reset_acceleration_rates);
- MENU_ITEM_EDIT_CALLBACK(long5, MSG_AMAX MSG_Z, &max_acceleration_units_per_sq_second[Z_AXIS], 100, 99000, reset_acceleration_rates);
- MENU_ITEM_EDIT_CALLBACK(long5, MSG_AMAX MSG_E, &max_acceleration_units_per_sq_second[E_AXIS], 100, 99000, reset_acceleration_rates);
- MENU_ITEM_EDIT(float5, MSG_A_RETRACT, &retract_acceleration, 100, 99000);
- MENU_ITEM_EDIT(float52, MSG_XSTEPS, &axis_steps_per_unit[X_AXIS], 5, 9999);
- MENU_ITEM_EDIT(float52, MSG_YSTEPS, &axis_steps_per_unit[Y_AXIS], 5, 9999);
- MENU_ITEM_EDIT(float51, MSG_ZSTEPS, &axis_steps_per_unit[Z_AXIS], 5, 9999);
- MENU_ITEM_EDIT(float51, MSG_ESTEPS, &axis_steps_per_unit[E_AXIS], 5, 9999);
- #ifdef ABORT_ON_ENDSTOP_HIT_FEATURE_ENABLED
- MENU_ITEM_EDIT(bool, "Endstop abort", &abort_on_endstop_hit);
- #endif
- END_MENU();
- }
-
- #ifdef FWRETRACT
- static void lcd_control_retract_menu()
- {
- START_MENU();
- MENU_ITEM(back, MSG_CONTROL, lcd_control_menu);
- MENU_ITEM_EDIT(bool, MSG_AUTORETRACT, &autoretract_enabled);
- MENU_ITEM_EDIT(float52, MSG_CONTROL_RETRACT, &retract_length, 0, 100);
- MENU_ITEM_EDIT(float3, MSG_CONTROL_RETRACTF, &retract_feedrate, 1, 999);
- MENU_ITEM_EDIT(float52, MSG_CONTROL_RETRACT_ZLIFT, &retract_zlift, 0, 999);
- MENU_ITEM_EDIT(float52, MSG_CONTROL_RETRACT_RECOVER, &retract_recover_length, 0, 100);
- MENU_ITEM_EDIT(float3, MSG_CONTROL_RETRACT_RECOVERF, &retract_recover_feedrate, 1, 999);
- END_MENU();
- }
- #endif
-
- #if SDCARDDETECT == -1
- static void lcd_sd_refresh()
- {
- card.initsd();
- currentMenuViewOffset = 0;
- }
- #endif
- static void lcd_sd_updir()
- {
- card.updir();
- currentMenuViewOffset = 0;
- }
-
- void lcd_sdcard_menu()
- {
- uint16_t fileCnt = card.getnrfilenames();
- START_MENU();
- MENU_ITEM(back, MSG_MAIN, lcd_main_menu);
- card.getWorkDirName();
- if(card.filename[0]=='/')
- {
- #if SDCARDDETECT == -1
- MENU_ITEM(function, LCD_STR_REFRESH MSG_REFRESH, lcd_sd_refresh);
- #endif
- }else{
- MENU_ITEM(function, LCD_STR_FOLDER "..", lcd_sd_updir);
- }
-
- for(uint16_t i=0;i<fileCnt;i++)
- {
- if (_menuItemNr == _lineNr)
- {
- card.getfilename(i);
- if (card.filenameIsDir)
- {
- MENU_ITEM(sddirectory, MSG_CARD_MENU, card.filename, card.longFilename);
- }else{
- MENU_ITEM(sdfile, MSG_CARD_MENU, card.filename, card.longFilename);
- }
- }else{
- MENU_ITEM_DUMMY();
- }
- }
- END_MENU();
- }
-
- #define menu_edit_type(_type, _name, _strFunc, scale) \
- void menu_edit_ ## _name () \
- { \
- if ((int32_t)encoderPosition < minEditValue) \
- encoderPosition = minEditValue; \
- if ((int32_t)encoderPosition > maxEditValue) \
- encoderPosition = maxEditValue; \
- if (lcdDrawUpdate) \
- lcd_implementation_drawedit(editLabel, _strFunc(((_type)encoderPosition) / scale)); \
- if (LCD_CLICKED) \
- { \
- *((_type*)editValue) = ((_type)encoderPosition) / scale; \
- lcd_quick_feedback(); \
- currentMenu = prevMenu; \
- encoderPosition = prevEncoderPosition; \
- } \
- } \
- void menu_edit_callback_ ## _name () \
- { \
- if ((int32_t)encoderPosition < minEditValue) \
- encoderPosition = minEditValue; \
- if ((int32_t)encoderPosition > maxEditValue) \
- encoderPosition = maxEditValue; \
- if (lcdDrawUpdate) \
- lcd_implementation_drawedit(editLabel, _strFunc(((_type)encoderPosition) / scale)); \
- if (LCD_CLICKED) \
- { \
- *((_type*)editValue) = ((_type)encoderPosition) / scale; \
- lcd_quick_feedback(); \
- currentMenu = prevMenu; \
- encoderPosition = prevEncoderPosition; \
- (*callbackFunc)();\
- } \
- } \
- static void menu_action_setting_edit_ ## _name (const char* pstr, _type* ptr, _type minValue, _type maxValue) \
- { \
- prevMenu = currentMenu; \
- prevEncoderPosition = encoderPosition; \
- \
- lcdDrawUpdate = 2; \
- currentMenu = menu_edit_ ## _name; \
- \
- editLabel = pstr; \
- editValue = ptr; \
- minEditValue = minValue * scale; \
- maxEditValue = maxValue * scale; \
- encoderPosition = (*ptr) * scale; \
- }\
- static void menu_action_setting_edit_callback_ ## _name (const char* pstr, _type* ptr, _type minValue, _type maxValue, menuFunc_t callback) \
- { \
- prevMenu = currentMenu; \
- prevEncoderPosition = encoderPosition; \
- \
- lcdDrawUpdate = 2; \
- currentMenu = menu_edit_callback_ ## _name; \
- \
- editLabel = pstr; \
- editValue = ptr; \
- minEditValue = minValue * scale; \
- maxEditValue = maxValue * scale; \
- encoderPosition = (*ptr) * scale; \
- callbackFunc = callback;\
- }
- menu_edit_type(int, int3, itostr3, 1)
- menu_edit_type(float, float3, ftostr3, 1)
- menu_edit_type(float, float32, ftostr32, 100)
- menu_edit_type(float, float5, ftostr5, 0.01)
- menu_edit_type(float, float51, ftostr51, 10)
- menu_edit_type(float, float52, ftostr52, 100)
- menu_edit_type(unsigned long, long5, ftostr5, 0.01)
-
- #ifdef REPRAPWORLD_KEYPAD
- static void reprapworld_keypad_move_y_down() {
- encoderPosition = 1;
- move_menu_scale = REPRAPWORLD_KEYPAD_MOVE_STEP;
- lcd_move_y();
- }
- static void reprapworld_keypad_move_y_up() {
- encoderPosition = -1;
- move_menu_scale = REPRAPWORLD_KEYPAD_MOVE_STEP;
- lcd_move_y();
- }
- static void reprapworld_keypad_move_home() {
- //enquecommand_P((PSTR("G28"))); // move all axis home
- // TODO gregor: move all axis home, i have currently only one axis on my prusa i3
- enquecommand_P((PSTR("G28 Y")));
- }
- #endif
-
- /** End of menus **/
-
- static void lcd_quick_feedback()
- {
- lcdDrawUpdate = 2;
- blocking_enc = millis() + 500;
- lcd_implementation_quick_feedback();
- }
-
- /** Menu action functions **/
- static void menu_action_back(menuFunc_t data)
- {
- currentMenu = data;
- encoderPosition = 0;
- }
- static void menu_action_submenu(menuFunc_t data)
- {
- currentMenu = data;
- encoderPosition = 0;
- }
- static void menu_action_gcode(const char* pgcode)
- {
- enquecommand_P(pgcode);
- }
- static void menu_action_function(menuFunc_t data)
- {
- (*data)();
- }
- static void menu_action_sdfile(const char* filename, char* longFilename)
- {
- char cmd[30];
- char* c;
- sprintf_P(cmd, PSTR("M23 %s"), filename);
- for(c = &cmd[4]; *c; c++)
- *c = tolower(*c);
- enquecommand(cmd);
- enquecommand_P(PSTR("M24"));
- lcd_return_to_status();
- }
- static void menu_action_sddirectory(const char* filename, char* longFilename)
- {
- card.chdir(filename);
- encoderPosition = 0;
- }
- static void menu_action_setting_edit_bool(const char* pstr, bool* ptr)
- {
- *ptr = !(*ptr);
- }
- #endif//ULTIPANEL
-
- /** LCD API **/
- void lcd_init()
- {
- lcd_implementation_init();
-
- #ifdef NEWPANEL
- pinMode(BTN_EN1,INPUT);
- pinMode(BTN_EN2,INPUT);
- pinMode(SDCARDDETECT,INPUT);
- WRITE(BTN_EN1,HIGH);
- WRITE(BTN_EN2,HIGH);
- #if BTN_ENC > 0
- pinMode(BTN_ENC,INPUT);
- WRITE(BTN_ENC,HIGH);
- #endif
- #ifdef REPRAPWORLD_KEYPAD
- pinMode(SHIFT_CLK,OUTPUT);
- pinMode(SHIFT_LD,OUTPUT);
- pinMode(SHIFT_OUT,INPUT);
- WRITE(SHIFT_OUT,HIGH);
- WRITE(SHIFT_LD,HIGH);
- #endif
- #else
- pinMode(SHIFT_CLK,OUTPUT);
- pinMode(SHIFT_LD,OUTPUT);
- pinMode(SHIFT_EN,OUTPUT);
- pinMode(SHIFT_OUT,INPUT);
- WRITE(SHIFT_OUT,HIGH);
- WRITE(SHIFT_LD,HIGH);
- WRITE(SHIFT_EN,LOW);
- #endif//!NEWPANEL
- #if (SDCARDDETECT > 0)
- WRITE(SDCARDDETECT, HIGH);
- lcd_oldcardstatus = IS_SD_INSERTED;
- #endif//(SDCARDDETECT > 0)
- lcd_buttons_update();
- #ifdef ULTIPANEL
- encoderDiff = 0;
- #endif
- }
-
- void lcd_update()
- {
- static unsigned long timeoutToStatus = 0;
-
- lcd_buttons_update();
-
- #ifdef LCD_HAS_SLOW_BUTTONS
- buttons |= lcd_implementation_read_slow_buttons(); // buttons which take too long to read in interrupt context
- #endif
-
- #if (SDCARDDETECT > 0)
- if((IS_SD_INSERTED != lcd_oldcardstatus))
- {
- lcdDrawUpdate = 2;
- lcd_oldcardstatus = IS_SD_INSERTED;
- lcd_implementation_init(); // to maybe revive the lcd if static electricty killed it.
-
- if(lcd_oldcardstatus)
- {
- card.initsd();
- LCD_MESSAGEPGM(MSG_SD_INSERTED);
- }
- else
- {
- card.release();
- LCD_MESSAGEPGM(MSG_SD_REMOVED);
- }
- }
- #endif//CARDINSERTED
-
- if (lcd_next_update_millis < millis())
- {
- #ifdef ULTIPANEL
- #ifdef REPRAPWORLD_KEYPAD
- if (REPRAPWORLD_KEYPAD_MOVE_Y_DOWN) {
- reprapworld_keypad_move_y_down();
- }
- if (REPRAPWORLD_KEYPAD_MOVE_Y_UP) {
- reprapworld_keypad_move_y_up();
- }
- if (REPRAPWORLD_KEYPAD_MOVE_HOME) {
- reprapworld_keypad_move_home();
- }
- #endif
- if (encoderDiff)
- {
- lcdDrawUpdate = 1;
- encoderPosition += encoderDiff;
- encoderDiff = 0;
- timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
- }
- if (LCD_CLICKED)
- timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
- #endif//ULTIPANEL
-
- #ifdef DOGLCD // Changes due to different driver architecture of the DOGM display
- blink++; // Variable for fan animation and alive dot
- u8g.firstPage();
- do
- {
- u8g.setFont(u8g_font_6x10_marlin);
- u8g.setPrintPos(125,0);
- if (blink % 2) u8g.setColorIndex(1); else u8g.setColorIndex(0); // Set color for the alive dot
- u8g.drawPixel(127,63); // draw alive dot
- u8g.setColorIndex(1); // black on white
- (*currentMenu)();
- if (!lcdDrawUpdate) break; // Terminate display update, when nothing new to draw. This must be done before the last dogm.next()
- } while( u8g.nextPage() );
- #else
- (*currentMenu)();
- #endif
-
- #ifdef LCD_HAS_STATUS_INDICATORS
- lcd_implementation_update_indicators();
- #endif
-
- #ifdef ULTIPANEL
- if(timeoutToStatus < millis() && currentMenu != lcd_status_screen)
- {
- lcd_return_to_status();
- lcdDrawUpdate = 2;
- }
- #endif//ULTIPANEL
- if (lcdDrawUpdate == 2)
- lcd_implementation_clear();
- if (lcdDrawUpdate)
- lcdDrawUpdate--;
- lcd_next_update_millis = millis() + 100;
- }
- }
-
- void lcd_setstatus(const char* message)
- {
- if (lcd_status_message_level > 0)
- return;
- strncpy(lcd_status_message, message, LCD_WIDTH);
- lcdDrawUpdate = 2;
- }
- void lcd_setstatuspgm(const char* message)
- {
- if (lcd_status_message_level > 0)
- return;
- strncpy_P(lcd_status_message, message, LCD_WIDTH);
- lcdDrawUpdate = 2;
- }
- void lcd_setalertstatuspgm(const char* message)
- {
- lcd_setstatuspgm(message);
- lcd_status_message_level = 1;
- #ifdef ULTIPANEL
- lcd_return_to_status();
- #endif//ULTIPANEL
- }
- void lcd_reset_alert_level()
- {
- lcd_status_message_level = 0;
- }
-
- #ifdef ULTIPANEL
- /* Warning: This function is called from interrupt context */
- void lcd_buttons_update()
- {
- #ifdef NEWPANEL
- uint8_t newbutton=0;
- if(READ(BTN_EN1)==0) newbutton|=EN_A;
- if(READ(BTN_EN2)==0) newbutton|=EN_B;
- #if BTN_ENC > 0
- if((blocking_enc<millis()) && (READ(BTN_ENC)==0))
- newbutton |= EN_C;
- #endif
- #ifdef REPRAPWORLD_KEYPAD
- // for the reprapworld_keypad
- uint8_t newbutton_reprapworld_keypad=0;
- WRITE(SHIFT_LD,LOW);
- WRITE(SHIFT_LD,HIGH);
- for(int8_t i=0;i<8;i++) {
- newbutton_reprapworld_keypad = newbutton_reprapworld_keypad>>1;
- if(READ(SHIFT_OUT))
- newbutton_reprapworld_keypad|=(1<<7);
- WRITE(SHIFT_CLK,HIGH);
- WRITE(SHIFT_CLK,LOW);
- }
- newbutton |= ((~newbutton_reprapworld_keypad) << REPRAPWORLD_BTN_OFFSET); //invert it, because a pressed switch produces a logical 0
- #endif
- buttons = newbutton;
- #else //read it from the shift register
- uint8_t newbutton=0;
- WRITE(SHIFT_LD,LOW);
- WRITE(SHIFT_LD,HIGH);
- unsigned char tmp_buttons=0;
- for(int8_t i=0;i<8;i++)
- {
- newbutton = newbutton>>1;
- if(READ(SHIFT_OUT))
- newbutton|=(1<<7);
- WRITE(SHIFT_CLK,HIGH);
- WRITE(SHIFT_CLK,LOW);
- }
- buttons=~newbutton; //invert it, because a pressed switch produces a logical 0
- #endif//!NEWPANEL
-
- //manage encoder rotation
- uint8_t enc=0;
- if(buttons&EN_A)
- enc|=(1<<0);
- if(buttons&EN_B)
- enc|=(1<<1);
- if(enc != lastEncoderBits)
- {
- switch(enc)
- {
- case encrot0:
- if(lastEncoderBits==encrot3)
- encoderDiff++;
- else if(lastEncoderBits==encrot1)
- encoderDiff--;
- break;
- case encrot1:
- if(lastEncoderBits==encrot0)
- encoderDiff++;
- else if(lastEncoderBits==encrot2)
- encoderDiff--;
- break;
- case encrot2:
- if(lastEncoderBits==encrot1)
- encoderDiff++;
- else if(lastEncoderBits==encrot3)
- encoderDiff--;
- break;
- case encrot3:
- if(lastEncoderBits==encrot2)
- encoderDiff++;
- else if(lastEncoderBits==encrot0)
- encoderDiff--;
- break;
- }
- }
- lastEncoderBits = enc;
- }
-
- void lcd_buzz(long duration, uint16_t freq)
- {
- #ifdef LCD_USE_I2C_BUZZER
- lcd.buzz(duration,freq);
- #endif
- }
-
- bool lcd_clicked()
- {
- return LCD_CLICKED;
- }
- #endif//ULTIPANEL
-
- /********************************/
- /** Float conversion utilities **/
- /********************************/
- // convert float to string with +123.4 format
- char conv[8];
- char *ftostr3(const float &x)
- {
- return itostr3((int)x);
- }
-
- char *itostr2(const uint8_t &x)
- {
- //sprintf(conv,"%5.1f",x);
- int xx=x;
- conv[0]=(xx/10)%10+'0';
- conv[1]=(xx)%10+'0';
- conv[2]=0;
- return conv;
- }
-
- // convert float to string with +123.4 format
- char *ftostr31(const float &x)
- {
- int xx=x*10;
- conv[0]=(xx>=0)?'+':'-';
- xx=abs(xx);
- conv[1]=(xx/1000)%10+'0';
- conv[2]=(xx/100)%10+'0';
- conv[3]=(xx/10)%10+'0';
- conv[4]='.';
- conv[5]=(xx)%10+'0';
- conv[6]=0;
- return conv;
- }
-
- // convert float to string with 123.4 format
- char *ftostr31ns(const float &x)
- {
- int xx=x*10;
- //conv[0]=(xx>=0)?'+':'-';
- xx=abs(xx);
- conv[0]=(xx/1000)%10+'0';
- conv[1]=(xx/100)%10+'0';
- conv[2]=(xx/10)%10+'0';
- conv[3]='.';
- conv[4]=(xx)%10+'0';
- conv[5]=0;
- return conv;
- }
-
- char *ftostr32(const float &x)
- {
- long xx=x*100;
- if (xx >= 0)
- conv[0]=(xx/10000)%10+'0';
- else
- conv[0]='-';
- xx=abs(xx);
- conv[1]=(xx/1000)%10+'0';
- conv[2]=(xx/100)%10+'0';
- conv[3]='.';
- conv[4]=(xx/10)%10+'0';
- conv[5]=(xx)%10+'0';
- conv[6]=0;
- return conv;
- }
-
- char *itostr31(const int &xx)
- {
- conv[0]=(xx>=0)?'+':'-';
- conv[1]=(xx/1000)%10+'0';
- conv[2]=(xx/100)%10+'0';
- conv[3]=(xx/10)%10+'0';
- conv[4]='.';
- conv[5]=(xx)%10+'0';
- conv[6]=0;
- return conv;
- }
-
- char *itostr3(const int &xx)
- {
- if (xx >= 100)
- conv[0]=(xx/100)%10+'0';
- else
- conv[0]=' ';
- if (xx >= 10)
- conv[1]=(xx/10)%10+'0';
- else
- conv[1]=' ';
- conv[2]=(xx)%10+'0';
- conv[3]=0;
- return conv;
- }
-
- char *itostr3left(const int &xx)
- {
- if (xx >= 100)
- {
- conv[0]=(xx/100)%10+'0';
- conv[1]=(xx/10)%10+'0';
- conv[2]=(xx)%10+'0';
- conv[3]=0;
- }
- else if (xx >= 10)
- {
- conv[0]=(xx/10)%10+'0';
- conv[1]=(xx)%10+'0';
- conv[2]=0;
- }
- else
- {
- conv[0]=(xx)%10+'0';
- conv[1]=0;
- }
- return conv;
- }
-
- char *itostr4(const int &xx)
- {
- if (xx >= 1000)
- conv[0]=(xx/1000)%10+'0';
- else
- conv[0]=' ';
- if (xx >= 100)
- conv[1]=(xx/100)%10+'0';
- else
- conv[1]=' ';
- if (xx >= 10)
- conv[2]=(xx/10)%10+'0';
- else
- conv[2]=' ';
- conv[3]=(xx)%10+'0';
- conv[4]=0;
- return conv;
- }
-
- // convert float to string with 12345 format
- char *ftostr5(const float &x)
- {
- long xx=abs(x);
- if (xx >= 10000)
- conv[0]=(xx/10000)%10+'0';
- else
- conv[0]=' ';
- if (xx >= 1000)
- conv[1]=(xx/1000)%10+'0';
- else
- conv[1]=' ';
- if (xx >= 100)
- conv[2]=(xx/100)%10+'0';
- else
- conv[2]=' ';
- if (xx >= 10)
- conv[3]=(xx/10)%10+'0';
- else
- conv[3]=' ';
- conv[4]=(xx)%10+'0';
- conv[5]=0;
- return conv;
- }
-
- // convert float to string with +1234.5 format
- char *ftostr51(const float &x)
- {
- long xx=x*10;
- conv[0]=(xx>=0)?'+':'-';
- xx=abs(xx);
- conv[1]=(xx/10000)%10+'0';
- conv[2]=(xx/1000)%10+'0';
- conv[3]=(xx/100)%10+'0';
- conv[4]=(xx/10)%10+'0';
- conv[5]='.';
- conv[6]=(xx)%10+'0';
- conv[7]=0;
- return conv;
- }
-
- // convert float to string with +123.45 format
- char *ftostr52(const float &x)
- {
- long xx=x*100;
- conv[0]=(xx>=0)?'+':'-';
- xx=abs(xx);
- conv[1]=(xx/10000)%10+'0';
- conv[2]=(xx/1000)%10+'0';
- conv[3]=(xx/100)%10+'0';
- conv[4]='.';
- conv[5]=(xx/10)%10+'0';
- conv[6]=(xx)%10+'0';
- conv[7]=0;
- return conv;
- }
-
- // Callback for after editing PID i value
- // grab the pid i value out of the temp variable; scale it; then update the PID driver
- void copy_and_scalePID_i()
- {
- Ki = scalePID_i(raw_Ki);
- updatePID();
- }
-
- // Callback for after editing PID d value
- // grab the pid d value out of the temp variable; scale it; then update the PID driver
- void copy_and_scalePID_d()
- {
- Kd = scalePID_d(raw_Kd);
- updatePID();
- }
-
- #endif //ULTRA_LCD
|