ultralcd.cpp 226 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862386338643865386638673868386938703871387238733874387538763877387838793880388138823883388438853886388738883889389038913892389338943895389638973898389939003901390239033904390539063907390839093910391139123913391439153916391739183919392039213922392339243925392639273928392939303931393239333934393539363937393839393940394139423943394439453946394739483949395039513952395339543955395639573958395939603961396239633964396539663967396839693970397139723973397439753976397739783979398039813982398339843985398639873988398939903991399239933994399539963997399839994000400140024003400440054006400740084009401040114012401340144015401640174018401940204021402240234024402540264027402840294030403140324033403440354036403740384039404040414042404340444045404640474048404940504051405240534054405540564057405840594060406140624063406440654066406740684069407040714072407340744075407640774078407940804081408240834084408540864087408840894090409140924093409440954096409740984099410041014102410341044105410641074108410941104111411241134114411541164117411841194120412141224123412441254126412741284129413041314132413341344135413641374138413941404141414241434144414541464147414841494150415141524153415441554156415741584159416041614162416341644165416641674168416941704171417241734174417541764177417841794180418141824183418441854186418741884189419041914192419341944195419641974198419942004201420242034204420542064207420842094210421142124213421442154216421742184219422042214222422342244225422642274228422942304231423242334234423542364237423842394240424142424243424442454246424742484249425042514252425342544255425642574258425942604261426242634264426542664267426842694270427142724273427442754276427742784279428042814282428342844285428642874288428942904291429242934294429542964297429842994300430143024303430443054306430743084309431043114312431343144315431643174318431943204321432243234324432543264327432843294330433143324333433443354336433743384339434043414342434343444345434643474348434943504351435243534354435543564357435843594360436143624363436443654366436743684369437043714372437343744375437643774378437943804381438243834384438543864387438843894390439143924393439443954396439743984399440044014402440344044405440644074408440944104411441244134414441544164417441844194420442144224423442444254426442744284429443044314432443344344435443644374438443944404441444244434444444544464447444844494450445144524453445444554456445744584459446044614462446344644465446644674468446944704471447244734474447544764477447844794480448144824483448444854486448744884489449044914492449344944495449644974498449945004501450245034504450545064507450845094510451145124513451445154516451745184519452045214522452345244525452645274528452945304531453245334534453545364537453845394540454145424543454445454546454745484549455045514552455345544555455645574558455945604561456245634564456545664567456845694570457145724573457445754576457745784579458045814582458345844585458645874588458945904591459245934594459545964597459845994600460146024603460446054606460746084609461046114612461346144615461646174618461946204621462246234624462546264627462846294630463146324633463446354636463746384639464046414642464346444645464646474648464946504651465246534654465546564657465846594660466146624663466446654666466746684669467046714672467346744675467646774678467946804681468246834684468546864687468846894690469146924693469446954696469746984699470047014702470347044705470647074708470947104711471247134714471547164717471847194720472147224723472447254726472747284729473047314732473347344735473647374738473947404741474247434744474547464747474847494750475147524753475447554756475747584759476047614762476347644765476647674768476947704771477247734774477547764777477847794780478147824783478447854786478747884789479047914792479347944795479647974798479948004801480248034804480548064807480848094810481148124813481448154816481748184819482048214822482348244825482648274828482948304831483248334834483548364837483848394840484148424843484448454846484748484849485048514852485348544855485648574858485948604861486248634864486548664867486848694870487148724873487448754876487748784879488048814882488348844885488648874888488948904891489248934894489548964897489848994900490149024903490449054906490749084909491049114912491349144915491649174918491949204921492249234924492549264927492849294930493149324933493449354936493749384939494049414942494349444945494649474948494949504951495249534954495549564957495849594960496149624963496449654966496749684969497049714972497349744975497649774978497949804981498249834984498549864987498849894990499149924993499449954996499749984999500050015002500350045005500650075008500950105011501250135014501550165017501850195020502150225023502450255026502750285029503050315032503350345035503650375038503950405041504250435044504550465047504850495050505150525053505450555056505750585059506050615062506350645065506650675068506950705071507250735074507550765077507850795080508150825083508450855086508750885089509050915092509350945095509650975098509951005101510251035104510551065107510851095110511151125113511451155116511751185119512051215122512351245125512651275128512951305131513251335134513551365137513851395140514151425143514451455146514751485149515051515152515351545155515651575158515951605161516251635164516551665167516851695170517151725173517451755176517751785179518051815182518351845185518651875188518951905191519251935194519551965197519851995200520152025203520452055206520752085209521052115212521352145215521652175218521952205221522252235224522552265227522852295230523152325233523452355236523752385239524052415242524352445245524652475248524952505251525252535254525552565257525852595260526152625263526452655266526752685269527052715272527352745275527652775278527952805281528252835284528552865287528852895290529152925293529452955296529752985299530053015302530353045305530653075308530953105311531253135314531553165317531853195320532153225323532453255326532753285329533053315332533353345335533653375338533953405341534253435344534553465347534853495350535153525353535453555356535753585359536053615362536353645365536653675368536953705371537253735374537553765377537853795380538153825383538453855386538753885389539053915392539353945395539653975398539954005401540254035404540554065407540854095410541154125413541454155416541754185419542054215422542354245425542654275428542954305431543254335434543554365437543854395440544154425443544454455446544754485449545054515452545354545455545654575458545954605461546254635464546554665467546854695470547154725473547454755476547754785479548054815482548354845485548654875488548954905491549254935494549554965497549854995500550155025503550455055506550755085509551055115512551355145515551655175518551955205521552255235524552555265527552855295530553155325533553455355536553755385539554055415542554355445545554655475548554955505551555255535554555555565557555855595560556155625563556455655566556755685569557055715572557355745575557655775578557955805581558255835584558555865587558855895590559155925593559455955596559755985599560056015602560356045605560656075608560956105611561256135614561556165617561856195620562156225623562456255626562756285629563056315632563356345635563656375638563956405641564256435644564556465647564856495650565156525653565456555656565756585659566056615662566356645665566656675668566956705671567256735674567556765677567856795680568156825683568456855686568756885689569056915692569356945695569656975698569957005701570257035704570557065707570857095710571157125713571457155716571757185719572057215722572357245725572657275728572957305731573257335734573557365737573857395740574157425743574457455746574757485749575057515752575357545755575657575758575957605761576257635764576557665767576857695770577157725773577457755776577757785779578057815782578357845785578657875788578957905791579257935794579557965797579857995800580158025803580458055806580758085809581058115812581358145815581658175818581958205821582258235824582558265827582858295830583158325833583458355836583758385839584058415842584358445845584658475848584958505851585258535854585558565857585858595860586158625863586458655866586758685869587058715872587358745875587658775878587958805881588258835884588558865887588858895890589158925893589458955896589758985899590059015902590359045905590659075908590959105911591259135914591559165917591859195920592159225923592459255926592759285929593059315932593359345935593659375938593959405941594259435944594559465947594859495950595159525953595459555956595759585959596059615962596359645965596659675968596959705971597259735974597559765977597859795980598159825983598459855986598759885989599059915992599359945995599659975998599960006001600260036004600560066007600860096010601160126013601460156016601760186019602060216022602360246025602660276028602960306031603260336034603560366037603860396040604160426043604460456046604760486049605060516052605360546055605660576058605960606061606260636064606560666067606860696070607160726073607460756076607760786079608060816082608360846085608660876088608960906091609260936094609560966097609860996100610161026103610461056106610761086109611061116112611361146115611661176118611961206121612261236124612561266127612861296130613161326133613461356136613761386139614061416142614361446145614661476148614961506151615261536154615561566157615861596160616161626163616461656166616761686169617061716172617361746175617661776178617961806181618261836184618561866187618861896190619161926193619461956196619761986199620062016202620362046205620662076208620962106211621262136214621562166217621862196220622162226223622462256226622762286229623062316232623362346235623662376238623962406241624262436244624562466247624862496250625162526253625462556256625762586259626062616262626362646265626662676268626962706271627262736274627562766277627862796280628162826283628462856286628762886289629062916292629362946295629662976298629963006301630263036304630563066307630863096310631163126313631463156316631763186319632063216322632363246325632663276328632963306331633263336334633563366337633863396340634163426343634463456346634763486349635063516352635363546355635663576358635963606361636263636364636563666367636863696370637163726373637463756376637763786379638063816382638363846385638663876388638963906391639263936394639563966397639863996400640164026403640464056406640764086409641064116412641364146415641664176418641964206421642264236424642564266427642864296430643164326433643464356436643764386439644064416442644364446445644664476448644964506451645264536454645564566457645864596460646164626463646464656466646764686469647064716472647364746475647664776478647964806481648264836484648564866487648864896490649164926493649464956496649764986499650065016502650365046505650665076508650965106511651265136514651565166517651865196520652165226523652465256526652765286529653065316532653365346535653665376538653965406541654265436544654565466547654865496550655165526553655465556556655765586559656065616562656365646565656665676568656965706571657265736574657565766577657865796580658165826583658465856586658765886589659065916592659365946595659665976598659966006601660266036604660566066607660866096610661166126613661466156616661766186619662066216622662366246625662666276628662966306631663266336634663566366637663866396640664166426643664466456646664766486649665066516652665366546655665666576658665966606661666266636664666566666667666866696670667166726673667466756676667766786679668066816682668366846685668666876688668966906691669266936694669566966697669866996700670167026703670467056706670767086709671067116712671367146715671667176718671967206721672267236724672567266727672867296730673167326733673467356736673767386739674067416742674367446745674667476748674967506751675267536754675567566757675867596760676167626763676467656766676767686769677067716772677367746775677667776778677967806781678267836784678567866787678867896790679167926793679467956796679767986799680068016802680368046805680668076808680968106811681268136814681568166817681868196820682168226823682468256826682768286829683068316832683368346835683668376838683968406841684268436844684568466847684868496850685168526853685468556856685768586859686068616862686368646865686668676868686968706871687268736874687568766877687868796880688168826883688468856886688768886889689068916892689368946895689668976898689969006901690269036904690569066907690869096910691169126913691469156916691769186919692069216922692369246925692669276928692969306931693269336934693569366937693869396940694169426943694469456946694769486949695069516952695369546955695669576958695969606961696269636964696569666967696869696970697169726973697469756976697769786979698069816982698369846985698669876988698969906991699269936994699569966997699869997000700170027003700470057006700770087009701070117012701370147015701670177018701970207021702270237024702570267027702870297030703170327033703470357036703770387039704070417042704370447045704670477048704970507051705270537054705570567057705870597060706170627063706470657066706770687069707070717072707370747075707670777078707970807081708270837084708570867087708870897090709170927093709470957096709770987099710071017102710371047105710671077108710971107111711271137114711571167117711871197120712171227123712471257126712771287129713071317132713371347135713671377138713971407141714271437144714571467147714871497150715171527153715471557156715771587159716071617162716371647165716671677168716971707171717271737174717571767177717871797180718171827183718471857186718771887189719071917192719371947195719671977198719972007201720272037204720572067207720872097210721172127213721472157216721772187219722072217222722372247225722672277228722972307231723272337234723572367237723872397240724172427243724472457246724772487249725072517252725372547255725672577258725972607261726272637264726572667267726872697270727172727273727472757276727772787279728072817282728372847285728672877288728972907291729272937294729572967297729872997300730173027303730473057306730773087309731073117312731373147315731673177318731973207321732273237324732573267327732873297330733173327333733473357336733773387339734073417342734373447345734673477348734973507351735273537354735573567357735873597360736173627363736473657366736773687369737073717372737373747375737673777378737973807381738273837384738573867387738873897390739173927393739473957396739773987399740074017402740374047405740674077408740974107411741274137414741574167417741874197420742174227423742474257426742774287429743074317432743374347435743674377438743974407441744274437444744574467447744874497450745174527453745474557456745774587459746074617462746374647465746674677468746974707471747274737474747574767477747874797480748174827483748474857486748774887489749074917492749374947495749674977498749975007501750275037504750575067507750875097510751175127513751475157516751775187519752075217522752375247525752675277528752975307531753275337534753575367537753875397540754175427543754475457546754775487549755075517552755375547555755675577558755975607561756275637564756575667567756875697570757175727573757475757576757775787579758075817582758375847585758675877588758975907591759275937594759575967597759875997600760176027603760476057606760776087609761076117612761376147615761676177618761976207621762276237624762576267627762876297630763176327633763476357636763776387639764076417642764376447645764676477648764976507651765276537654765576567657765876597660766176627663766476657666766776687669767076717672767376747675767676777678767976807681768276837684768576867687768876897690769176927693769476957696769776987699770077017702770377047705770677077708770977107711771277137714771577167717771877197720772177227723772477257726772777287729773077317732773377347735773677377738773977407741774277437744774577467747774877497750775177527753775477557756775777587759776077617762776377647765776677677768776977707771777277737774777577767777777877797780778177827783778477857786778777887789779077917792779377947795779677977798779978007801780278037804780578067807780878097810781178127813781478157816781778187819782078217822782378247825782678277828782978307831783278337834783578367837783878397840784178427843784478457846784778487849785078517852785378547855785678577858785978607861786278637864786578667867786878697870787178727873787478757876787778787879788078817882788378847885788678877888788978907891789278937894789578967897789878997900790179027903790479057906790779087909791079117912791379147915791679177918791979207921792279237924792579267927792879297930793179327933793479357936793779387939794079417942794379447945794679477948794979507951795279537954795579567957795879597960796179627963796479657966796779687969797079717972797379747975797679777978797979807981798279837984798579867987798879897990799179927993799479957996799779987999800080018002800380048005800680078008800980108011801280138014801580168017801880198020802180228023802480258026802780288029803080318032803380348035803680378038803980408041804280438044804580468047804880498050805180528053805480558056805780588059806080618062806380648065806680678068806980708071807280738074807580768077807880798080808180828083808480858086808780888089809080918092809380948095809680978098809981008101810281038104810581068107810881098110811181128113811481158116811781188119812081218122812381248125812681278128812981308131813281338134813581368137813881398140814181428143814481458146814781488149815081518152815381548155815681578158815981608161816281638164816581668167816881698170817181728173817481758176817781788179818081818182818381848185818681878188818981908191
  1. #include "temperature.h"
  2. #include "ultralcd.h"
  3. #ifdef ULTRA_LCD
  4. #include "MenuStack.h"
  5. #include "Marlin.h"
  6. #include "language.h"
  7. #include "cardreader.h"
  8. #include "temperature.h"
  9. #include "stepper.h"
  10. #include "ConfigurationStore.h"
  11. #include <string.h>
  12. #include "Timer.h"
  13. #include "util.h"
  14. #include "mesh_bed_leveling.h"
  15. //#include "Configuration.h"
  16. #include "cmdqueue.h"
  17. #include "SdFatUtil.h"
  18. #ifdef PAT9125
  19. #include "pat9125.h"
  20. #endif //PAT9125
  21. #ifdef TMC2130
  22. #include "tmc2130.h"
  23. #endif //TMC2130
  24. #define _STRINGIFY(s) #s
  25. int8_t encoderDiff; /* encoderDiff is updated from interrupt context and added to encoderPosition every LCD update */
  26. extern int lcd_change_fil_state;
  27. extern bool fans_check_enabled;
  28. extern bool filament_autoload_enabled;
  29. #ifdef PAT9125
  30. extern bool fsensor_not_responding;
  31. extern bool fsensor_enabled;
  32. #endif //PAT9125
  33. //Function pointer to menu functions.
  34. static void lcd_sd_updir();
  35. struct EditMenuParentState
  36. {
  37. //prevMenu and prevEncoderPosition are used to store the previous menu location when editing settings.
  38. menuFunc_t prevMenu;
  39. uint16_t prevEncoderPosition;
  40. //Variables used when editing values.
  41. const char* editLabel;
  42. void* editValue;
  43. int32_t minEditValue, maxEditValue;
  44. // menuFunc_t callbackFunc;
  45. };
  46. union MenuData
  47. {
  48. struct BabyStep
  49. {
  50. // 29B total
  51. int8_t status;
  52. int babystepMem[3];
  53. float babystepMemMM[3];
  54. } babyStep;
  55. struct SupportMenu
  56. {
  57. // 6B+16B=22B total
  58. int8_t status;
  59. bool is_flash_air;
  60. uint8_t ip[4];
  61. char ip_str[3*4+3+1];
  62. } supportMenu;
  63. struct AdjustBed
  64. {
  65. // 6+13+16=35B
  66. // editMenuParentState is used when an edit menu is entered, so it knows
  67. // the return menu and encoder state.
  68. struct EditMenuParentState editMenuParentState;
  69. int8_t status;
  70. int8_t left;
  71. int8_t right;
  72. int8_t front;
  73. int8_t rear;
  74. int left2;
  75. int right2;
  76. int front2;
  77. int rear2;
  78. } adjustBed;
  79. struct TuneMenu
  80. {
  81. // editMenuParentState is used when an edit menu is entered, so it knows
  82. // the return menu and encoder state.
  83. struct EditMenuParentState editMenuParentState;
  84. // To recognize, whether the menu has been just initialized.
  85. int8_t status;
  86. // Backup of extrudemultiply, to recognize, that the value has been changed and
  87. // it needs to be applied.
  88. int16_t extrudemultiply;
  89. } tuneMenu;
  90. // editMenuParentState is used when an edit menu is entered, so it knows
  91. // the return menu and encoder state.
  92. struct EditMenuParentState editMenuParentState;
  93. struct AutoLoadFilamentMenu
  94. {
  95. //Timer timer;
  96. char dummy;
  97. } autoLoadFilamentMenu;
  98. struct _Lcd_moveMenu
  99. {
  100. bool initialized;
  101. bool endstopsEnabledPrevious;
  102. } _lcd_moveMenu;
  103. };
  104. // State of the currently active menu.
  105. // C Union manages sharing of the static memory by all the menus.
  106. union MenuData menuData = { 0 };
  107. union Data
  108. {
  109. byte b[2];
  110. int value;
  111. };
  112. static MenuStack menuStack;
  113. int8_t ReInitLCD = 0;
  114. int8_t SDscrool = 0;
  115. int8_t SilentModeMenu = SILENT_MODE_OFF;
  116. int8_t FSensorStateMenu = 1;
  117. int8_t CrashDetectMenu = 1;
  118. extern void fsensor_block();
  119. extern void fsensor_unblock();
  120. extern bool fsensor_enable();
  121. extern void fsensor_disable();
  122. #ifdef TMC2130
  123. extern void crashdet_enable();
  124. extern void crashdet_disable();
  125. #endif //TMC2130
  126. #ifdef SNMM
  127. uint8_t snmm_extruder = 0;
  128. #endif
  129. #ifdef SDCARD_SORT_ALPHA
  130. bool presort_flag = false;
  131. #endif
  132. int lcd_commands_type=LCD_COMMAND_IDLE;
  133. int lcd_commands_step=0;
  134. bool isPrintPaused = false;
  135. uint8_t farm_mode = 0;
  136. int farm_no = 0;
  137. int farm_timer = 8;
  138. int farm_status = 0;
  139. unsigned long allert_timer = millis();
  140. bool printer_connected = true;
  141. unsigned long display_time; //just timer for showing pid finished message on lcd;
  142. float pid_temp = DEFAULT_PID_TEMP;
  143. bool long_press_active = false;
  144. long long_press_timer = millis();
  145. unsigned long button_blanking_time = millis();
  146. bool button_pressed = false;
  147. bool menuExiting = false;
  148. #ifdef FILAMENT_LCD_DISPLAY
  149. unsigned long message_millis = 0;
  150. #endif
  151. #ifdef ULTIPANEL
  152. static float manual_feedrate[] = MANUAL_FEEDRATE;
  153. #endif // ULTIPANEL
  154. /* !Configuration settings */
  155. uint8_t lcd_status_message_level;
  156. char lcd_status_message[LCD_WIDTH + 1] = ""; //////WELCOME!
  157. unsigned char firstrun = 1;
  158. #include "ultralcd_implementation_hitachi_HD44780.h"
  159. static const char separator[] PROGMEM = "--------------------";
  160. /** forward declarations **/
  161. static const char* lcd_display_message_fullscreen_nonBlocking_P(const char *msg, uint8_t &nlines);
  162. // void copy_and_scalePID_i();
  163. // void copy_and_scalePID_d();
  164. /* Different menus */
  165. static void lcd_status_screen();
  166. #ifdef ULTIPANEL
  167. extern bool powersupply;
  168. static void lcd_main_menu();
  169. static void lcd_tune_menu();
  170. static void lcd_prepare_menu();
  171. //static void lcd_move_menu();
  172. static void lcd_settings_menu();
  173. static void lcd_calibration_menu();
  174. static void lcd_language_menu();
  175. static void lcd_control_temperature_menu();
  176. static void lcd_control_temperature_preheat_pla_settings_menu();
  177. static void lcd_control_temperature_preheat_abs_settings_menu();
  178. static void lcd_control_motion_menu();
  179. static void lcd_control_volumetric_menu();
  180. static void lcd_settings_menu_back();
  181. static void prusa_stat_printerstatus(int _status);
  182. static void prusa_stat_farm_number();
  183. static void prusa_stat_temperatures();
  184. static void prusa_stat_printinfo();
  185. static void lcd_farm_no();
  186. static void lcd_menu_extruder_info();
  187. static void lcd_menu_xyz_y_min();
  188. static void lcd_menu_xyz_skew();
  189. static void lcd_menu_xyz_offset();
  190. #if defined(TMC2130) || defined(PAT9125)
  191. static void lcd_menu_fails_stats();
  192. #endif //TMC2130 or PAT9125
  193. void lcd_finishstatus();
  194. #ifdef DOGLCD
  195. static void lcd_set_contrast();
  196. #endif
  197. static void lcd_control_retract_menu();
  198. static void lcd_sdcard_menu();
  199. #ifdef DELTA_CALIBRATION_MENU
  200. static void lcd_delta_calibrate_menu();
  201. #endif // DELTA_CALIBRATION_MENU
  202. static void lcd_quick_feedback();//Cause an LCD refresh, and give the user visual or audible feedback that something has happened
  203. /* Different types of actions that can be used in menu items. */
  204. static void menu_action_back(menuFunc_t data = 0);
  205. #define menu_action_back_RAM menu_action_back
  206. static void menu_action_submenu(menuFunc_t data);
  207. static void menu_action_gcode(const char* pgcode);
  208. static void menu_action_function(menuFunc_t data);
  209. static void menu_action_setlang(unsigned char lang);
  210. static void menu_action_sdfile(const char* filename, char* longFilename);
  211. static void menu_action_sddirectory(const char* filename, char* longFilename);
  212. static void menu_action_setting_edit_bool(const char* pstr, bool* ptr);
  213. static void menu_action_setting_edit_wfac(const char* pstr, uint8_t* ptr, uint8_t minValue, uint8_t maxValue);
  214. static void menu_action_setting_edit_mres(const char* pstr, uint8_t* ptr, uint8_t minValue, uint8_t maxValue);
  215. static void menu_action_setting_edit_byte3(const char* pstr, uint8_t* ptr, uint8_t minValue, uint8_t maxValue);
  216. static void menu_action_setting_edit_int3(const char* pstr, int* ptr, int minValue, int maxValue);
  217. static void menu_action_setting_edit_float3(const char* pstr, float* ptr, float minValue, float maxValue);
  218. static void menu_action_setting_edit_float32(const char* pstr, float* ptr, float minValue, float maxValue);
  219. static void menu_action_setting_edit_float43(const char* pstr, float* ptr, float minValue, float maxValue);
  220. static void menu_action_setting_edit_float5(const char* pstr, float* ptr, float minValue, float maxValue);
  221. static void menu_action_setting_edit_float51(const char* pstr, float* ptr, float minValue, float maxValue);
  222. static void menu_action_setting_edit_float52(const char* pstr, float* ptr, float minValue, float maxValue);
  223. static void menu_action_setting_edit_long5(const char* pstr, unsigned long* ptr, unsigned long minValue, unsigned long maxValue);
  224. /*
  225. static void menu_action_setting_edit_callback_bool(const char* pstr, bool* ptr, menuFunc_t callbackFunc);
  226. static void menu_action_setting_edit_callback_int3(const char* pstr, int* ptr, int minValue, int maxValue, menuFunc_t callbackFunc);
  227. static void menu_action_setting_edit_callback_float3(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
  228. static void menu_action_setting_edit_callback_float32(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
  229. static void menu_action_setting_edit_callback_float43(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
  230. static void menu_action_setting_edit_callback_float5(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
  231. static void menu_action_setting_edit_callback_float51(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
  232. static void menu_action_setting_edit_callback_float52(const char* pstr, float* ptr, float minValue, float maxValue, menuFunc_t callbackFunc);
  233. static void menu_action_setting_edit_callback_long5(const char* pstr, unsigned long* ptr, unsigned long minValue, unsigned long maxValue, menuFunc_t callbackFunc);
  234. */
  235. #define ENCODER_FEEDRATE_DEADZONE 10
  236. #if !defined(LCD_I2C_VIKI)
  237. #ifndef ENCODER_STEPS_PER_MENU_ITEM
  238. #define ENCODER_STEPS_PER_MENU_ITEM 5
  239. #endif
  240. #ifndef ENCODER_PULSES_PER_STEP
  241. #define ENCODER_PULSES_PER_STEP 1
  242. #endif
  243. #else
  244. #ifndef ENCODER_STEPS_PER_MENU_ITEM
  245. #define ENCODER_STEPS_PER_MENU_ITEM 2 // VIKI LCD rotary encoder uses a different number of steps per rotation
  246. #endif
  247. #ifndef ENCODER_PULSES_PER_STEP
  248. #define ENCODER_PULSES_PER_STEP 1
  249. #endif
  250. #endif
  251. /* Helper macros for menus */
  252. #define START_MENU() do { \
  253. if (encoderPosition > 0x8000) encoderPosition = 0; \
  254. if (encoderPosition / ENCODER_STEPS_PER_MENU_ITEM < currentMenuViewOffset) currentMenuViewOffset = encoderPosition / ENCODER_STEPS_PER_MENU_ITEM;\
  255. uint8_t _lineNr = currentMenuViewOffset, _menuItemNr; \
  256. bool wasClicked = LCD_CLICKED;\
  257. for(uint8_t _drawLineNr = 0; _drawLineNr < LCD_HEIGHT; _drawLineNr++, _lineNr++) { \
  258. _menuItemNr = 0;
  259. #define MENU_ITEM(type, label, args...) do { \
  260. if (_menuItemNr == _lineNr) { \
  261. if (lcdDrawUpdate) { \
  262. const char* _label_pstr = (label); \
  263. if ((encoderPosition / ENCODER_STEPS_PER_MENU_ITEM) == _menuItemNr) { \
  264. lcd_implementation_drawmenu_ ## type ## _selected (_drawLineNr, _label_pstr , ## args ); \
  265. }else{\
  266. lcd_implementation_drawmenu_ ## type (_drawLineNr, _label_pstr , ## args ); \
  267. }\
  268. }\
  269. if (wasClicked && (encoderPosition / ENCODER_STEPS_PER_MENU_ITEM) == _menuItemNr) {\
  270. lcd_quick_feedback(); \
  271. menu_action_ ## type ( args ); \
  272. return;\
  273. }\
  274. }\
  275. _menuItemNr++;\
  276. } while(0)
  277. #define MENU_ITEM_DUMMY() do { _menuItemNr++; } while(0)
  278. #define MENU_ITEM_EDIT(type, label, args...) MENU_ITEM(setting_edit_ ## type, label, (label) , ## args )
  279. #define MENU_ITEM_EDIT_CALLBACK(type, label, args...) MENU_ITEM(setting_edit_callback_ ## type, label, (label) , ## args )
  280. #define END_MENU() \
  281. if (encoderPosition / ENCODER_STEPS_PER_MENU_ITEM >= _menuItemNr) encoderPosition = _menuItemNr * ENCODER_STEPS_PER_MENU_ITEM - 1; \
  282. 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; } \
  283. } } while(0)
  284. /** Used variables to keep track of the menu */
  285. #ifndef REPRAPWORLD_KEYPAD
  286. volatile uint8_t buttons;//Contains the bits of the currently pressed buttons.
  287. #else
  288. volatile uint8_t buttons_reprapworld_keypad; // to store the reprapworld_keypad shift register values
  289. #endif
  290. #ifdef LCD_HAS_SLOW_BUTTONS
  291. volatile uint8_t slow_buttons;//Contains the bits of the currently pressed buttons.
  292. #endif
  293. uint8_t currentMenuViewOffset; /* scroll offset in the current menu */
  294. uint8_t lastEncoderBits;
  295. uint32_t encoderPosition;
  296. #if (SDCARDDETECT > 0)
  297. bool lcd_oldcardstatus;
  298. #endif
  299. #endif //ULTIPANEL
  300. menuFunc_t currentMenu = lcd_status_screen; /* function pointer to the currently active menu */
  301. uint32_t lcd_next_update_millis;
  302. uint8_t lcd_status_update_delay;
  303. bool ignore_click = false;
  304. bool wait_for_unclick;
  305. 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) */
  306. // place-holders for Ki and Kd edits
  307. #ifdef PIDTEMP
  308. // float raw_Ki, raw_Kd;
  309. #endif
  310. /**
  311. * @brief Go to menu
  312. *
  313. * In MENU_ITEM(submenu,... ) use MENU_ITEM(back,...) or
  314. * menu_action_back() and menu_action_submenu() instead, otherwise menuStack will be broken.
  315. *
  316. * It is acceptable to call lcd_goto_menu(menu) directly from MENU_ITEM(function,...), if destination menu
  317. * is the same, from which function was called.
  318. *
  319. * @param menu target menu
  320. * @param encoder position in target menu
  321. * @param feedback
  322. * * true sound feedback (click)
  323. * * false no feedback
  324. * @param reset_menu_state
  325. * * true reset menu state global union
  326. * * false do not reset menu state global union
  327. */
  328. static void lcd_goto_menu(menuFunc_t menu, const uint32_t encoder = 0, const bool feedback = true, bool reset_menu_state = true)
  329. {
  330. asm("cli");
  331. if (currentMenu != menu)
  332. {
  333. currentMenu = menu;
  334. encoderPosition = encoder;
  335. asm("sei");
  336. if (reset_menu_state)
  337. {
  338. // Resets the global shared C union.
  339. // This ensures, that the menu entered will find out, that it shall initialize itself.
  340. memset(&menuData, 0, sizeof(menuData));
  341. }
  342. if (feedback) lcd_quick_feedback();
  343. // For LCD_PROGRESS_BAR re-initialize the custom characters
  344. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT)
  345. lcd_set_custom_characters(menu == lcd_status_screen);
  346. #endif
  347. }
  348. else
  349. asm("sei");
  350. }
  351. /* Main status screen. It's up to the implementation specific part to show what is needed. As this is very display dependent */
  352. // Language selection dialog not active.
  353. #define LANGSEL_OFF 0
  354. // Language selection dialog modal, entered from the info screen. This is the case on firmware boot up,
  355. // if the language index stored in the EEPROM is not valid.
  356. #define LANGSEL_MODAL 1
  357. // Language selection dialog entered from the Setup menu.
  358. #define LANGSEL_ACTIVE 2
  359. // Language selection dialog status
  360. unsigned char langsel = LANGSEL_OFF;
  361. void set_language_from_EEPROM() {
  362. unsigned char eep = eeprom_read_byte((unsigned char*)EEPROM_LANG);
  363. if (eep < LANG_NUM)
  364. {
  365. lang_selected = eep;
  366. // Language is valid, no need to enter the language selection screen.
  367. langsel = LANGSEL_OFF;
  368. }
  369. else
  370. {
  371. lang_selected = LANG_ID_DEFAULT;
  372. // Invalid language, enter the language selection screen in a modal mode.
  373. langsel = LANGSEL_MODAL;
  374. }
  375. }
  376. static void lcd_status_screen()
  377. {
  378. if (firstrun == 1)
  379. {
  380. firstrun = 0;
  381. set_language_from_EEPROM();
  382. if(lcd_status_message_level == 0){
  383. strncpy_P(lcd_status_message, WELCOME_MSG, LCD_WIDTH);
  384. lcd_finishstatus();
  385. }
  386. if (eeprom_read_byte((uint8_t *)EEPROM_TOTALTIME) == 255 && eeprom_read_byte((uint8_t *)EEPROM_TOTALTIME + 1) == 255 && eeprom_read_byte((uint8_t *)EEPROM_TOTALTIME + 2) == 255 && eeprom_read_byte((uint8_t *)EEPROM_TOTALTIME + 3) == 255)
  387. {
  388. eeprom_update_dword((uint32_t *)EEPROM_TOTALTIME, 0);
  389. eeprom_update_dword((uint32_t *)EEPROM_FILAMENTUSED, 0);
  390. }
  391. if (langsel) {
  392. //strncpy_P(lcd_status_message, PSTR(">>>>>>>>>>>> PRESS v"), LCD_WIDTH);
  393. // Entering the language selection screen in a modal mode.
  394. }
  395. }
  396. if (lcd_status_update_delay)
  397. lcd_status_update_delay--;
  398. else
  399. lcdDrawUpdate = 1;
  400. if (lcdDrawUpdate)
  401. {
  402. ReInitLCD++;
  403. if (ReInitLCD == 30) {
  404. lcd_implementation_init( // to maybe revive the LCD if static electricity killed it.
  405. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT)
  406. currentMenu == lcd_status_screen
  407. #endif
  408. );
  409. ReInitLCD = 0 ;
  410. } else {
  411. if ((ReInitLCD % 10) == 0) {
  412. //lcd_implementation_nodisplay();
  413. lcd_implementation_init_noclear( // to maybe revive the LCD if static electricity killed it.
  414. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT)
  415. currentMenu == lcd_status_screen
  416. #endif
  417. );
  418. }
  419. }
  420. //lcd_implementation_display();
  421. lcd_implementation_status_screen();
  422. //lcd_implementation_clear();
  423. if (farm_mode)
  424. {
  425. farm_timer--;
  426. if (farm_timer < 1)
  427. {
  428. farm_timer = 10;
  429. prusa_statistics(0);
  430. }
  431. switch (farm_timer)
  432. {
  433. case 8:
  434. prusa_statistics(21);
  435. break;
  436. case 5:
  437. if (IS_SD_PRINTING)
  438. {
  439. prusa_statistics(20);
  440. }
  441. break;
  442. }
  443. } // end of farm_mode
  444. 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 */
  445. if (lcd_commands_type != LCD_COMMAND_IDLE)
  446. {
  447. lcd_commands();
  448. }
  449. } // end of lcdDrawUpdate
  450. #ifdef ULTIPANEL
  451. bool current_click = LCD_CLICKED;
  452. if (ignore_click) {
  453. if (wait_for_unclick) {
  454. if (!current_click) {
  455. ignore_click = wait_for_unclick = false;
  456. }
  457. else {
  458. current_click = false;
  459. }
  460. }
  461. else if (current_click) {
  462. lcd_quick_feedback();
  463. wait_for_unclick = true;
  464. current_click = false;
  465. }
  466. }
  467. //if (--langsel ==0) {langsel=1;current_click=true;}
  468. if (current_click && (lcd_commands_type != LCD_COMMAND_STOP_PRINT)) //click is aborted unless stop print finishes
  469. {
  470. menuStack.reset(); //redundant, as already done in lcd_return_to_status(), just to be sure
  471. menu_action_submenu(lcd_main_menu);
  472. lcd_implementation_init( // to maybe revive the LCD if static electricity killed it.
  473. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT)
  474. currentMenu == lcd_status_screen
  475. #endif
  476. );
  477. #ifdef FILAMENT_LCD_DISPLAY
  478. message_millis = millis(); // get status message to show up for a while
  479. #endif
  480. }
  481. #ifdef ULTIPANEL_FEEDMULTIPLY
  482. // Dead zone at 100% feedrate
  483. if ((feedmultiply < 100 && (feedmultiply + int(encoderPosition)) > 100) ||
  484. (feedmultiply > 100 && (feedmultiply + int(encoderPosition)) < 100))
  485. {
  486. encoderPosition = 0;
  487. feedmultiply = 100;
  488. }
  489. if (feedmultiply == 100 && int(encoderPosition) > ENCODER_FEEDRATE_DEADZONE)
  490. {
  491. feedmultiply += int(encoderPosition) - ENCODER_FEEDRATE_DEADZONE;
  492. encoderPosition = 0;
  493. }
  494. else if (feedmultiply == 100 && int(encoderPosition) < -ENCODER_FEEDRATE_DEADZONE)
  495. {
  496. feedmultiply += int(encoderPosition) + ENCODER_FEEDRATE_DEADZONE;
  497. encoderPosition = 0;
  498. }
  499. else if (feedmultiply != 100)
  500. {
  501. feedmultiply += int(encoderPosition);
  502. encoderPosition = 0;
  503. }
  504. #endif //ULTIPANEL_FEEDMULTIPLY
  505. if (feedmultiply < 10)
  506. feedmultiply = 10;
  507. else if (feedmultiply > 999)
  508. feedmultiply = 999;
  509. #endif //ULTIPANEL
  510. /*if (farm_mode && !printer_connected) {
  511. lcd.setCursor(0, 3);
  512. lcd_printPGM(MSG_PRINTER_DISCONNECTED);
  513. }*/
  514. //#define FSENS_FACTOR (2580.8/50) //filament sensor factor [steps / encoder counts]
  515. //#define FSENS_FACTOR (2580.8/45.3) //filament sensor factor [steps / encoder counts]
  516. //lcd.setCursor(0, 3);
  517. //lcd_implementation_print(" ");
  518. //lcd.setCursor(0, 3);
  519. //lcd_implementation_print(pat9125_x);
  520. //lcd.setCursor(6, 3);
  521. //lcd_implementation_print(pat9125_y);
  522. //lcd.setCursor(12, 3);
  523. //lcd_implementation_print(pat9125_b);
  524. }
  525. #ifdef ULTIPANEL
  526. void lcd_commands()
  527. {
  528. if (lcd_commands_type == LCD_COMMAND_LONG_PAUSE)
  529. {
  530. if(lcd_commands_step == 0) {
  531. if (card.sdprinting) {
  532. card.pauseSDPrint();
  533. lcd_setstatuspgm(MSG_FINISHING_MOVEMENTS);
  534. lcdDrawUpdate = 3;
  535. lcd_commands_step = 1;
  536. }
  537. else {
  538. lcd_commands_type = 0;
  539. }
  540. }
  541. if (lcd_commands_step == 1 && !blocks_queued() && !homing_flag) {
  542. lcd_setstatuspgm(MSG_PRINT_PAUSED);
  543. isPrintPaused = true;
  544. long_pause();
  545. lcd_commands_type = 0;
  546. lcd_commands_step = 0;
  547. }
  548. }
  549. if (lcd_commands_type == LCD_COMMAND_LONG_PAUSE_RESUME) {
  550. char cmd1[30];
  551. if (lcd_commands_step == 0) {
  552. lcdDrawUpdate = 3;
  553. lcd_commands_step = 4;
  554. }
  555. if (lcd_commands_step == 1 && !blocks_queued() && cmd_buffer_empty()) { //recover feedmultiply; cmd_buffer_empty() ensures that card.sdprinting is synchronized with buffered commands and thus print cant be paused until resume is finished
  556. sprintf_P(cmd1, PSTR("M220 S%d"), saved_feedmultiply);
  557. enquecommand(cmd1);
  558. isPrintPaused = false;
  559. pause_time += (millis() - start_pause_print); //accumulate time when print is paused for correct statistics calculation
  560. card.startFileprint();
  561. lcd_commands_step = 0;
  562. lcd_commands_type = 0;
  563. }
  564. if (lcd_commands_step == 2 && !blocks_queued()) { //turn on fan, move Z and unretract
  565. sprintf_P(cmd1, PSTR("M106 S%d"), fanSpeedBckp);
  566. enquecommand(cmd1);
  567. strcpy(cmd1, "G1 Z");
  568. strcat(cmd1, ftostr32(pause_lastpos[Z_AXIS]));
  569. enquecommand(cmd1);
  570. if (axis_relative_modes[3] == false) {
  571. enquecommand_P(PSTR("M83")); // set extruder to relative mode
  572. enquecommand_P(PSTR("G1 E" STRINGIFY(DEFAULT_RETRACTION))); //unretract
  573. enquecommand_P(PSTR("M82")); // set extruder to absolute mode
  574. }
  575. else {
  576. enquecommand_P(PSTR("G1 E" STRINGIFY(DEFAULT_RETRACTION))); //unretract
  577. }
  578. lcd_commands_step = 1;
  579. }
  580. if (lcd_commands_step == 3 && !blocks_queued()) { //wait for nozzle to reach target temp
  581. strcpy(cmd1, "M109 S");
  582. strcat(cmd1, ftostr3(HotendTempBckp));
  583. enquecommand(cmd1);
  584. lcd_commands_step = 2;
  585. }
  586. if (lcd_commands_step == 4 && !blocks_queued()) { //set temperature back and move xy
  587. strcpy(cmd1, "M104 S");
  588. strcat(cmd1, ftostr3(HotendTempBckp));
  589. enquecommand(cmd1);
  590. enquecommand_P(PSTR("G90")); //absolute positioning
  591. strcpy(cmd1, "G1 X");
  592. strcat(cmd1, ftostr32(pause_lastpos[X_AXIS]));
  593. strcat(cmd1, " Y");
  594. strcat(cmd1, ftostr32(pause_lastpos[Y_AXIS]));
  595. enquecommand(cmd1);
  596. lcd_setstatuspgm(MSG_RESUMING_PRINT);
  597. lcd_commands_step = 3;
  598. }
  599. }
  600. #ifdef SNMM
  601. if (lcd_commands_type == LCD_COMMAND_V2_CAL)
  602. {
  603. char cmd1[30];
  604. float width = 0.4;
  605. float length = 20 - width;
  606. float extr = count_e(0.2, width, length);
  607. float extr_short_segment = count_e(0.2, width, width);
  608. if (lcd_commands_step>1) lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS; //if user dont confirm live adjust Z value by pressing the knob, we are saving last value by timeout to status screen
  609. if (lcd_commands_step == 0)
  610. {
  611. lcd_commands_step = 10;
  612. }
  613. if (lcd_commands_step == 10 && !blocks_queued() && cmd_buffer_empty())
  614. {
  615. enquecommand_P(PSTR("M107"));
  616. enquecommand_P(PSTR("M104 S" STRINGIFY(PLA_PREHEAT_HOTEND_TEMP)));
  617. enquecommand_P(PSTR("M140 S" STRINGIFY(PLA_PREHEAT_HPB_TEMP)));
  618. enquecommand_P(PSTR("M190 S" STRINGIFY(PLA_PREHEAT_HPB_TEMP)));
  619. enquecommand_P(PSTR("M109 S" STRINGIFY(PLA_PREHEAT_HOTEND_TEMP)));
  620. enquecommand_P(PSTR("T0"));
  621. enquecommand_P(MSG_M117_V2_CALIBRATION);
  622. enquecommand_P(PSTR("G87")); //sets calibration status
  623. enquecommand_P(PSTR("G28"));
  624. enquecommand_P(PSTR("G21")); //set units to millimeters
  625. enquecommand_P(PSTR("G90")); //use absolute coordinates
  626. enquecommand_P(PSTR("M83")); //use relative distances for extrusion
  627. enquecommand_P(PSTR("G92 E0"));
  628. enquecommand_P(PSTR("M203 E100"));
  629. enquecommand_P(PSTR("M92 E140"));
  630. lcd_commands_step = 9;
  631. }
  632. if (lcd_commands_step == 9 && !blocks_queued() && cmd_buffer_empty())
  633. {
  634. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  635. enquecommand_P(PSTR("G1 Z0.250 F7200.000"));
  636. enquecommand_P(PSTR("G1 X50.0 E80.0 F1000.0"));
  637. enquecommand_P(PSTR("G1 X160.0 E20.0 F1000.0"));
  638. enquecommand_P(PSTR("G1 Z0.200 F7200.000"));
  639. enquecommand_P(PSTR("G1 X220.0 E13 F1000.0"));
  640. enquecommand_P(PSTR("G1 X240.0 E0 F1000.0"));
  641. enquecommand_P(PSTR("G92 E0.0"));
  642. enquecommand_P(PSTR("G21"));
  643. enquecommand_P(PSTR("G90"));
  644. enquecommand_P(PSTR("M83"));
  645. enquecommand_P(PSTR("G1 E-4 F2100.00000"));
  646. enquecommand_P(PSTR("G1 Z0.150 F7200.000"));
  647. enquecommand_P(PSTR("M204 S1000"));
  648. enquecommand_P(PSTR("G1 F4000"));
  649. lcd_implementation_clear();
  650. lcd_goto_menu(lcd_babystep_z, 0, false);
  651. lcd_commands_step = 8;
  652. }
  653. if (lcd_commands_step == 8 && !blocks_queued() && cmd_buffer_empty()) //draw meander
  654. {
  655. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  656. enquecommand_P(PSTR("G1 X50 Y155"));
  657. enquecommand_P(PSTR("G1 X60 Y155 E4"));
  658. enquecommand_P(PSTR("G1 F1080"));
  659. enquecommand_P(PSTR("G1 X75 Y155 E2.5"));
  660. enquecommand_P(PSTR("G1 X100 Y155 E2"));
  661. enquecommand_P(PSTR("G1 X200 Y155 E2.62773"));
  662. enquecommand_P(PSTR("G1 X200 Y135 E0.66174"));
  663. enquecommand_P(PSTR("G1 X50 Y135 E3.62773"));
  664. enquecommand_P(PSTR("G1 X50 Y115 E0.49386"));
  665. enquecommand_P(PSTR("G1 X200 Y115 E3.62773"));
  666. enquecommand_P(PSTR("G1 X200 Y95 E0.49386"));
  667. enquecommand_P(PSTR("G1 X50 Y95 E3.62773"));
  668. enquecommand_P(PSTR("G1 X50 Y75 E0.49386"));
  669. enquecommand_P(PSTR("G1 X200 Y75 E3.62773"));
  670. enquecommand_P(PSTR("G1 X200 Y55 E0.49386"));
  671. enquecommand_P(PSTR("G1 X50 Y55 E3.62773"));
  672. lcd_commands_step = 7;
  673. }
  674. if (lcd_commands_step == 7 && !blocks_queued() && cmd_buffer_empty())
  675. {
  676. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  677. strcpy(cmd1, "G1 X50 Y35 E");
  678. strcat(cmd1, ftostr43(extr));
  679. enquecommand(cmd1);
  680. for (int i = 0; i < 4; i++) {
  681. strcpy(cmd1, "G1 X70 Y");
  682. strcat(cmd1, ftostr32(35 - i*width * 2));
  683. strcat(cmd1, " E");
  684. strcat(cmd1, ftostr43(extr));
  685. enquecommand(cmd1);
  686. strcpy(cmd1, "G1 Y");
  687. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  688. strcat(cmd1, " E");
  689. strcat(cmd1, ftostr43(extr_short_segment));
  690. enquecommand(cmd1);
  691. strcpy(cmd1, "G1 X50 Y");
  692. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  693. strcat(cmd1, " E");
  694. strcat(cmd1, ftostr43(extr));
  695. enquecommand(cmd1);
  696. strcpy(cmd1, "G1 Y");
  697. strcat(cmd1, ftostr32(35 - (i + 1)*width * 2));
  698. strcat(cmd1, " E");
  699. strcat(cmd1, ftostr43(extr_short_segment));
  700. enquecommand(cmd1);
  701. }
  702. lcd_commands_step = 6;
  703. }
  704. if (lcd_commands_step == 6 && !blocks_queued() && cmd_buffer_empty())
  705. {
  706. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  707. for (int i = 4; i < 8; i++) {
  708. strcpy(cmd1, "G1 X70 Y");
  709. strcat(cmd1, ftostr32(35 - i*width * 2));
  710. strcat(cmd1, " E");
  711. strcat(cmd1, ftostr43(extr));
  712. enquecommand(cmd1);
  713. strcpy(cmd1, "G1 Y");
  714. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  715. strcat(cmd1, " E");
  716. strcat(cmd1, ftostr43(extr_short_segment));
  717. enquecommand(cmd1);
  718. strcpy(cmd1, "G1 X50 Y");
  719. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  720. strcat(cmd1, " E");
  721. strcat(cmd1, ftostr43(extr));
  722. enquecommand(cmd1);
  723. strcpy(cmd1, "G1 Y");
  724. strcat(cmd1, ftostr32(35 - (i + 1)*width * 2));
  725. strcat(cmd1, " E");
  726. strcat(cmd1, ftostr43(extr_short_segment));
  727. enquecommand(cmd1);
  728. }
  729. lcd_commands_step = 5;
  730. }
  731. if (lcd_commands_step == 5 && !blocks_queued() && cmd_buffer_empty())
  732. {
  733. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  734. for (int i = 8; i < 12; i++) {
  735. strcpy(cmd1, "G1 X70 Y");
  736. strcat(cmd1, ftostr32(35 - i*width * 2));
  737. strcat(cmd1, " E");
  738. strcat(cmd1, ftostr43(extr));
  739. enquecommand(cmd1);
  740. strcpy(cmd1, "G1 Y");
  741. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  742. strcat(cmd1, " E");
  743. strcat(cmd1, ftostr43(extr_short_segment));
  744. enquecommand(cmd1);
  745. strcpy(cmd1, "G1 X50 Y");
  746. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  747. strcat(cmd1, " E");
  748. strcat(cmd1, ftostr43(extr));
  749. enquecommand(cmd1);
  750. strcpy(cmd1, "G1 Y");
  751. strcat(cmd1, ftostr32(35 - (i + 1)*width * 2));
  752. strcat(cmd1, " E");
  753. strcat(cmd1, ftostr43(extr_short_segment));
  754. enquecommand(cmd1);
  755. }
  756. lcd_commands_step = 4;
  757. }
  758. if (lcd_commands_step == 4 && !blocks_queued() && cmd_buffer_empty())
  759. {
  760. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  761. for (int i = 12; i < 16; i++) {
  762. strcpy(cmd1, "G1 X70 Y");
  763. strcat(cmd1, ftostr32(35 - i*width * 2));
  764. strcat(cmd1, " E");
  765. strcat(cmd1, ftostr43(extr));
  766. enquecommand(cmd1);
  767. strcpy(cmd1, "G1 Y");
  768. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  769. strcat(cmd1, " E");
  770. strcat(cmd1, ftostr43(extr_short_segment));
  771. enquecommand(cmd1);
  772. strcpy(cmd1, "G1 X50 Y");
  773. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  774. strcat(cmd1, " E");
  775. strcat(cmd1, ftostr43(extr));
  776. enquecommand(cmd1);
  777. strcpy(cmd1, "G1 Y");
  778. strcat(cmd1, ftostr32(35 - (i + 1)*width * 2));
  779. strcat(cmd1, " E");
  780. strcat(cmd1, ftostr43(extr_short_segment));
  781. enquecommand(cmd1);
  782. }
  783. lcd_commands_step = 3;
  784. }
  785. if (lcd_commands_step == 3 && !blocks_queued() && cmd_buffer_empty())
  786. {
  787. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  788. enquecommand_P(PSTR("G1 E-0.07500 F2100.00000"));
  789. enquecommand_P(PSTR("G4 S0"));
  790. enquecommand_P(PSTR("G1 E-4 F2100.00000"));
  791. enquecommand_P(PSTR("G1 Z0.5 F7200.000"));
  792. enquecommand_P(PSTR("G1 X245 Y1"));
  793. enquecommand_P(PSTR("G1 X240 E4"));
  794. enquecommand_P(PSTR("G1 F4000"));
  795. enquecommand_P(PSTR("G1 X190 E2.7"));
  796. enquecommand_P(PSTR("G1 F4600"));
  797. enquecommand_P(PSTR("G1 X110 E2.8"));
  798. enquecommand_P(PSTR("G1 F5200"));
  799. enquecommand_P(PSTR("G1 X40 E3"));
  800. enquecommand_P(PSTR("G1 E-15.0000 F5000"));
  801. enquecommand_P(PSTR("G1 E-50.0000 F5400"));
  802. enquecommand_P(PSTR("G1 E-15.0000 F3000"));
  803. enquecommand_P(PSTR("G1 E-12.0000 F2000"));
  804. enquecommand_P(PSTR("G1 F1600"));
  805. lcd_commands_step = 2;
  806. }
  807. if (lcd_commands_step == 2 && !blocks_queued() && cmd_buffer_empty())
  808. {
  809. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  810. enquecommand_P(PSTR("G1 X0 Y1 E3.0000"));
  811. enquecommand_P(PSTR("G1 X50 Y1 E-5.0000"));
  812. enquecommand_P(PSTR("G1 F2000"));
  813. enquecommand_P(PSTR("G1 X0 Y1 E5.0000"));
  814. enquecommand_P(PSTR("G1 X50 Y1 E-5.0000"));
  815. enquecommand_P(PSTR("G1 F2400"));
  816. enquecommand_P(PSTR("G1 X0 Y1 E5.0000"));
  817. enquecommand_P(PSTR("G1 X50 Y1 E-5.0000"));
  818. enquecommand_P(PSTR("G1 F2400"));
  819. enquecommand_P(PSTR("G1 X0 Y1 E5.0000"));
  820. enquecommand_P(PSTR("G1 X50 Y1 E-3.0000"));
  821. enquecommand_P(PSTR("G4 S0"));
  822. enquecommand_P(PSTR("M107"));
  823. enquecommand_P(PSTR("M104 S0"));
  824. enquecommand_P(PSTR("M140 S0"));
  825. enquecommand_P(PSTR("G1 X10 Y180 F4000"));
  826. enquecommand_P(PSTR("G1 Z10 F1300.000"));
  827. enquecommand_P(PSTR("M84"));
  828. lcd_commands_step = 1;
  829. }
  830. if (lcd_commands_step == 1 && !blocks_queued() && cmd_buffer_empty())
  831. {
  832. lcd_setstatuspgm(WELCOME_MSG);
  833. lcd_commands_step = 0;
  834. lcd_commands_type = 0;
  835. if (eeprom_read_byte((uint8_t*)EEPROM_WIZARD_ACTIVE) == 1) {
  836. lcd_wizard(10);
  837. }
  838. }
  839. }
  840. #else //if not SNMM
  841. if (lcd_commands_type == LCD_COMMAND_V2_CAL)
  842. {
  843. char cmd1[30];
  844. float width = 0.4;
  845. float length = 20 - width;
  846. float extr = count_e(0.2, width, length);
  847. float extr_short_segment = count_e(0.2, width, width);
  848. if(lcd_commands_step>1) lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS; //if user dont confirm live adjust Z value by pressing the knob, we are saving last value by timeout to status screen
  849. if (lcd_commands_step == 0)
  850. {
  851. lcd_commands_step = 9;
  852. }
  853. if (lcd_commands_step == 9 && !blocks_queued() && cmd_buffer_empty())
  854. {
  855. enquecommand_P(PSTR("M107"));
  856. enquecommand_P(PSTR("M104 S" STRINGIFY(PLA_PREHEAT_HOTEND_TEMP)));
  857. enquecommand_P(PSTR("M140 S" STRINGIFY(PLA_PREHEAT_HPB_TEMP)));
  858. enquecommand_P(PSTR("M190 S" STRINGIFY(PLA_PREHEAT_HPB_TEMP)));
  859. enquecommand_P(PSTR("M109 S" STRINGIFY(PLA_PREHEAT_HOTEND_TEMP)));
  860. enquecommand_P(MSG_M117_V2_CALIBRATION);
  861. enquecommand_P(PSTR("G28"));
  862. enquecommand_P(PSTR("G92 E0.0"));
  863. lcd_commands_step = 8;
  864. }
  865. if (lcd_commands_step == 8 && !blocks_queued() && cmd_buffer_empty())
  866. {
  867. lcd_implementation_clear();
  868. menuStack.reset();
  869. menu_action_submenu(lcd_babystep_z);
  870. enquecommand_P(PSTR("G1 X60.0 E9.0 F1000.0")); //intro line
  871. enquecommand_P(PSTR("G1 X100.0 E12.5 F1000.0")); //intro line
  872. enquecommand_P(PSTR("G92 E0.0"));
  873. enquecommand_P(PSTR("G21")); //set units to millimeters
  874. enquecommand_P(PSTR("G90")); //use absolute coordinates
  875. enquecommand_P(PSTR("M83")); //use relative distances for extrusion
  876. enquecommand_P(PSTR("G1 E-1.50000 F2100.00000"));
  877. enquecommand_P(PSTR("G1 Z0.150 F7200.000"));
  878. enquecommand_P(PSTR("M204 S1000")); //set acceleration
  879. enquecommand_P(PSTR("G1 F4000"));
  880. lcd_commands_step = 7;
  881. }
  882. if (lcd_commands_step == 7 && !blocks_queued() && cmd_buffer_empty()) //draw meander
  883. {
  884. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  885. //just opposite direction
  886. /*enquecommand_P(PSTR("G1 X50 Y55"));
  887. enquecommand_P(PSTR("G1 F1080"));
  888. enquecommand_P(PSTR("G1 X200 Y55 E3.62773"));
  889. enquecommand_P(PSTR("G1 X200 Y75 E0.49386"));
  890. enquecommand_P(PSTR("G1 X50 Y75 E3.62773"));
  891. enquecommand_P(PSTR("G1 X50 Y95 E0.49386"));
  892. enquecommand_P(PSTR("G1 X200 Y95 E3.62773"));
  893. enquecommand_P(PSTR("G1 X200 Y115 E0.49386"));
  894. enquecommand_P(PSTR("G1 X50 Y115 E3.62773"));
  895. enquecommand_P(PSTR("G1 X50 Y135 E0.49386"));
  896. enquecommand_P(PSTR("G1 X200 Y135 E3.62773"));
  897. enquecommand_P(PSTR("G1 X200 Y155 E0.66174"));
  898. enquecommand_P(PSTR("G1 X100 Y155 E2.62773"));
  899. enquecommand_P(PSTR("G1 X75 Y155 E2"));
  900. enquecommand_P(PSTR("G1 X50 Y155 E2.5"));
  901. enquecommand_P(PSTR("G1 E - 0.07500 F2100.00000"));*/
  902. enquecommand_P(PSTR("G1 X50 Y155"));
  903. enquecommand_P(PSTR("G1 F1080"));
  904. enquecommand_P(PSTR("G1 X75 Y155 E2.5"));
  905. enquecommand_P(PSTR("G1 X100 Y155 E2"));
  906. enquecommand_P(PSTR("G1 X200 Y155 E2.62773"));
  907. enquecommand_P(PSTR("G1 X200 Y135 E0.66174"));
  908. enquecommand_P(PSTR("G1 X50 Y135 E3.62773"));
  909. enquecommand_P(PSTR("G1 X50 Y115 E0.49386"));
  910. enquecommand_P(PSTR("G1 X200 Y115 E3.62773"));
  911. enquecommand_P(PSTR("G1 X200 Y95 E0.49386"));
  912. enquecommand_P(PSTR("G1 X50 Y95 E3.62773"));
  913. enquecommand_P(PSTR("G1 X50 Y75 E0.49386"));
  914. enquecommand_P(PSTR("G1 X200 Y75 E3.62773"));
  915. enquecommand_P(PSTR("G1 X200 Y55 E0.49386"));
  916. enquecommand_P(PSTR("G1 X50 Y55 E3.62773"));
  917. strcpy(cmd1, "G1 X50 Y35 E");
  918. strcat(cmd1, ftostr43(extr));
  919. enquecommand(cmd1);
  920. lcd_commands_step = 6;
  921. }
  922. if (lcd_commands_step == 6 && !blocks_queued() && cmd_buffer_empty())
  923. {
  924. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  925. for (int i = 0; i < 4; i++) {
  926. strcpy(cmd1, "G1 X70 Y");
  927. strcat(cmd1, ftostr32(35 - i*width * 2));
  928. strcat(cmd1, " E");
  929. strcat(cmd1, ftostr43(extr));
  930. enquecommand(cmd1);
  931. strcpy(cmd1, "G1 Y");
  932. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  933. strcat(cmd1, " E");
  934. strcat(cmd1, ftostr43(extr_short_segment));
  935. enquecommand(cmd1);
  936. strcpy(cmd1, "G1 X50 Y");
  937. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  938. strcat(cmd1, " E");
  939. strcat(cmd1, ftostr43(extr));
  940. enquecommand(cmd1);
  941. strcpy(cmd1, "G1 Y");
  942. strcat(cmd1, ftostr32(35 - (i + 1)*width * 2));
  943. strcat(cmd1, " E");
  944. strcat(cmd1, ftostr43(extr_short_segment));
  945. enquecommand(cmd1);
  946. }
  947. lcd_commands_step = 5;
  948. }
  949. if (lcd_commands_step == 5 && !blocks_queued() && cmd_buffer_empty())
  950. {
  951. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  952. for (int i = 4; i < 8; i++) {
  953. strcpy(cmd1, "G1 X70 Y");
  954. strcat(cmd1, ftostr32(35 - i*width * 2));
  955. strcat(cmd1, " E");
  956. strcat(cmd1, ftostr43(extr));
  957. enquecommand(cmd1);
  958. strcpy(cmd1, "G1 Y");
  959. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  960. strcat(cmd1, " E");
  961. strcat(cmd1, ftostr43(extr_short_segment));
  962. enquecommand(cmd1);
  963. strcpy(cmd1, "G1 X50 Y");
  964. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  965. strcat(cmd1, " E");
  966. strcat(cmd1, ftostr43(extr));
  967. enquecommand(cmd1);
  968. strcpy(cmd1, "G1 Y");
  969. strcat(cmd1, ftostr32(35 - (i + 1)*width * 2));
  970. strcat(cmd1, " E");
  971. strcat(cmd1, ftostr43(extr_short_segment));
  972. enquecommand(cmd1);
  973. }
  974. lcd_commands_step = 4;
  975. }
  976. if (lcd_commands_step == 4 && !blocks_queued() && cmd_buffer_empty())
  977. {
  978. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  979. for (int i = 8; i < 12; i++) {
  980. strcpy(cmd1, "G1 X70 Y");
  981. strcat(cmd1, ftostr32(35 - i*width * 2));
  982. strcat(cmd1, " E");
  983. strcat(cmd1, ftostr43(extr));
  984. enquecommand(cmd1);
  985. strcpy(cmd1, "G1 Y");
  986. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  987. strcat(cmd1, " E");
  988. strcat(cmd1, ftostr43(extr_short_segment));
  989. enquecommand(cmd1);
  990. strcpy(cmd1, "G1 X50 Y");
  991. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  992. strcat(cmd1, " E");
  993. strcat(cmd1, ftostr43(extr));
  994. enquecommand(cmd1);
  995. strcpy(cmd1, "G1 Y");
  996. strcat(cmd1, ftostr32(35 - (i + 1)*width * 2));
  997. strcat(cmd1, " E");
  998. strcat(cmd1, ftostr43(extr_short_segment));
  999. enquecommand(cmd1);
  1000. }
  1001. lcd_commands_step = 3;
  1002. }
  1003. if (lcd_commands_step == 3 && !blocks_queued() && cmd_buffer_empty())
  1004. {
  1005. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  1006. for (int i = 12; i < 16; i++) {
  1007. strcpy(cmd1, "G1 X70 Y");
  1008. strcat(cmd1, ftostr32(35 - i*width * 2));
  1009. strcat(cmd1, " E");
  1010. strcat(cmd1, ftostr43(extr));
  1011. enquecommand(cmd1);
  1012. strcpy(cmd1, "G1 Y");
  1013. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  1014. strcat(cmd1, " E");
  1015. strcat(cmd1, ftostr43(extr_short_segment));
  1016. enquecommand(cmd1);
  1017. strcpy(cmd1, "G1 X50 Y");
  1018. strcat(cmd1, ftostr32(35 - (2 * i + 1)*width));
  1019. strcat(cmd1, " E");
  1020. strcat(cmd1, ftostr43(extr));
  1021. enquecommand(cmd1);
  1022. strcpy(cmd1, "G1 Y");
  1023. strcat(cmd1, ftostr32(35 - (i + 1)*width * 2));
  1024. strcat(cmd1, " E");
  1025. strcat(cmd1, ftostr43(extr_short_segment));
  1026. enquecommand(cmd1);
  1027. }
  1028. lcd_commands_step = 2;
  1029. }
  1030. if (lcd_commands_step == 2 && !blocks_queued() && cmd_buffer_empty())
  1031. {
  1032. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  1033. enquecommand_P(PSTR("G1 E-0.07500 F2100.00000"));
  1034. enquecommand_P(PSTR("M107")); //turn off printer fan
  1035. enquecommand_P(PSTR("M104 S0")); // turn off temperature
  1036. enquecommand_P(PSTR("M140 S0")); // turn off heatbed
  1037. enquecommand_P(PSTR("G1 Z10 F1300.000"));
  1038. enquecommand_P(PSTR("G1 X10 Y180 F4000")); //home X axis
  1039. enquecommand_P(PSTR("M84"));// disable motors
  1040. lcd_timeoutToStatus = millis() - 1; //if user dont confirm live adjust Z value by pressing the knob, we are saving last value by timeout to status screen
  1041. lcd_commands_step = 1;
  1042. }
  1043. if (lcd_commands_step == 1 && !blocks_queued() && cmd_buffer_empty())
  1044. {
  1045. lcd_setstatuspgm(WELCOME_MSG);
  1046. lcd_commands_step = 0;
  1047. lcd_commands_type = 0;
  1048. if (eeprom_read_byte((uint8_t*)EEPROM_WIZARD_ACTIVE) == 1) {
  1049. lcd_wizard(10);
  1050. }
  1051. }
  1052. }
  1053. #endif // not SNMM
  1054. if (lcd_commands_type == LCD_COMMAND_STOP_PRINT) /// stop print
  1055. {
  1056. if (lcd_commands_step == 0)
  1057. {
  1058. lcd_commands_step = 6;
  1059. custom_message = true;
  1060. }
  1061. if (lcd_commands_step == 1 && !blocks_queued())
  1062. {
  1063. lcd_commands_step = 0;
  1064. lcd_commands_type = 0;
  1065. lcd_setstatuspgm(WELCOME_MSG);
  1066. custom_message_type = 0;
  1067. custom_message = false;
  1068. isPrintPaused = false;
  1069. }
  1070. if (lcd_commands_step == 2 && !blocks_queued())
  1071. {
  1072. setTargetBed(0);
  1073. enquecommand_P(PSTR("M104 S0")); //set hotend temp to 0
  1074. manage_heater();
  1075. lcd_setstatuspgm(WELCOME_MSG);
  1076. cancel_heatup = false;
  1077. lcd_commands_step = 1;
  1078. }
  1079. if (lcd_commands_step == 3 && !blocks_queued())
  1080. {
  1081. // M84: Disable steppers.
  1082. enquecommand_P(PSTR("M84"));
  1083. autotempShutdown();
  1084. lcd_commands_step = 2;
  1085. }
  1086. if (lcd_commands_step == 4 && !blocks_queued())
  1087. {
  1088. lcd_setstatuspgm(MSG_PLEASE_WAIT);
  1089. // G90: Absolute positioning.
  1090. enquecommand_P(PSTR("G90"));
  1091. // M83: Set extruder to relative mode.
  1092. enquecommand_P(PSTR("M83"));
  1093. #ifdef X_CANCEL_POS
  1094. enquecommand_P(PSTR("G1 X" STRINGIFY(X_CANCEL_POS) " Y" STRINGIFY(Y_CANCEL_POS) " E0 F7000"));
  1095. #else
  1096. enquecommand_P(PSTR("G1 X50 Y" STRINGIFY(Y_MAX_POS) " E0 F7000"));
  1097. #endif
  1098. lcd_ignore_click(false);
  1099. #ifdef SNMM
  1100. lcd_commands_step = 8;
  1101. #else
  1102. lcd_commands_step = 3;
  1103. #endif
  1104. }
  1105. if (lcd_commands_step == 5 && !blocks_queued())
  1106. {
  1107. lcd_setstatuspgm(MSG_PRINT_ABORTED);
  1108. // G91: Set to relative positioning.
  1109. enquecommand_P(PSTR("G91"));
  1110. // Lift up.
  1111. enquecommand_P(PSTR("G1 Z15 F1500"));
  1112. if (axis_known_position[X_AXIS] && axis_known_position[Y_AXIS]) lcd_commands_step = 4;
  1113. else lcd_commands_step = 3;
  1114. }
  1115. if (lcd_commands_step == 6 && !blocks_queued())
  1116. {
  1117. lcd_setstatuspgm(MSG_PRINT_ABORTED);
  1118. cancel_heatup = true;
  1119. setTargetBed(0);
  1120. #ifndef SNMM
  1121. setTargetHotend(0, 0); //heating when changing filament for multicolor
  1122. setTargetHotend(0, 1);
  1123. setTargetHotend(0, 2);
  1124. #endif
  1125. manage_heater();
  1126. custom_message = true;
  1127. custom_message_type = 2;
  1128. lcd_commands_step = 5;
  1129. }
  1130. if (lcd_commands_step == 7 && !blocks_queued()) {
  1131. switch(snmm_stop_print_menu()) {
  1132. case 0: enquecommand_P(PSTR("M702")); break;//all
  1133. case 1: enquecommand_P(PSTR("M702 U")); break; //used
  1134. case 2: enquecommand_P(PSTR("M702 C")); break; //current
  1135. default: enquecommand_P(PSTR("M702")); break;
  1136. }
  1137. lcd_commands_step = 3;
  1138. }
  1139. if (lcd_commands_step == 8 && !blocks_queued()) { //step 8 is here for delay (going to next step after execution of all gcodes from step 4)
  1140. lcd_commands_step = 7;
  1141. }
  1142. }
  1143. if (lcd_commands_type == 3)
  1144. {
  1145. lcd_commands_type = 0;
  1146. }
  1147. if (lcd_commands_type == LCD_COMMAND_FARM_MODE_CONFIRM) /// farm mode confirm
  1148. {
  1149. if (lcd_commands_step == 0) { lcd_commands_step = 6; custom_message = true; }
  1150. if (lcd_commands_step == 1 && !blocks_queued())
  1151. {
  1152. lcd_confirm_print();
  1153. lcd_commands_step = 0;
  1154. lcd_commands_type = 0;
  1155. }
  1156. if (lcd_commands_step == 2 && !blocks_queued())
  1157. {
  1158. lcd_commands_step = 1;
  1159. }
  1160. if (lcd_commands_step == 3 && !blocks_queued())
  1161. {
  1162. lcd_commands_step = 2;
  1163. }
  1164. if (lcd_commands_step == 4 && !blocks_queued())
  1165. {
  1166. enquecommand_P(PSTR("G90"));
  1167. enquecommand_P(PSTR("G1 X" STRINGIFY(X_CANCEL_POS) " Y" STRINGIFY(Y_CANCEL_POS) " E0 F7000"));
  1168. lcd_commands_step = 3;
  1169. }
  1170. if (lcd_commands_step == 5 && !blocks_queued())
  1171. {
  1172. lcd_commands_step = 4;
  1173. }
  1174. if (lcd_commands_step == 6 && !blocks_queued())
  1175. {
  1176. enquecommand_P(PSTR("G91"));
  1177. enquecommand_P(PSTR("G1 Z15 F1500"));
  1178. st_synchronize();
  1179. #ifdef SNMM
  1180. lcd_commands_step = 7;
  1181. #else
  1182. lcd_commands_step = 5;
  1183. #endif
  1184. }
  1185. }
  1186. if (lcd_commands_type == LCD_COMMAND_PID_EXTRUDER) {
  1187. char cmd1[30];
  1188. if (lcd_commands_step == 0) {
  1189. custom_message_type = 3;
  1190. custom_message_state = 1;
  1191. custom_message = true;
  1192. lcdDrawUpdate = 3;
  1193. lcd_commands_step = 3;
  1194. }
  1195. if (lcd_commands_step == 3 && !blocks_queued()) { //PID calibration
  1196. strcpy(cmd1, "M303 E0 S");
  1197. strcat(cmd1, ftostr3(pid_temp));
  1198. enquecommand(cmd1);
  1199. lcd_setstatuspgm(MSG_PID_RUNNING);
  1200. lcd_commands_step = 2;
  1201. }
  1202. if (lcd_commands_step == 2 && pid_tuning_finished) { //saving to eeprom
  1203. pid_tuning_finished = false;
  1204. custom_message_state = 0;
  1205. lcd_setstatuspgm(MSG_PID_FINISHED);
  1206. if (_Kp != 0 || _Ki != 0 || _Kd != 0) {
  1207. strcpy(cmd1, "M301 P");
  1208. strcat(cmd1, ftostr32(_Kp));
  1209. strcat(cmd1, " I");
  1210. strcat(cmd1, ftostr32(_Ki));
  1211. strcat(cmd1, " D");
  1212. strcat(cmd1, ftostr32(_Kd));
  1213. enquecommand(cmd1);
  1214. enquecommand_P(PSTR("M500"));
  1215. }
  1216. else {
  1217. SERIAL_ECHOPGM("Invalid PID cal. results. Not stored to EEPROM.");
  1218. }
  1219. display_time = millis();
  1220. lcd_commands_step = 1;
  1221. }
  1222. if ((lcd_commands_step == 1) && ((millis()- display_time)>2000)) { //calibration finished message
  1223. lcd_setstatuspgm(WELCOME_MSG);
  1224. custom_message_type = 0;
  1225. custom_message = false;
  1226. pid_temp = DEFAULT_PID_TEMP;
  1227. lcd_commands_step = 0;
  1228. lcd_commands_type = 0;
  1229. }
  1230. }
  1231. }
  1232. static float count_e(float layer_heigth, float extrusion_width, float extrusion_length) {
  1233. //returns filament length in mm which needs to be extrude to form line with extrusion_length * extrusion_width * layer heigth dimensions
  1234. float extr = extrusion_length * layer_heigth * extrusion_width / (M_PI * pow(1.75, 2) / 4);
  1235. return extr;
  1236. }
  1237. static void lcd_return_to_status() {
  1238. lcd_implementation_init( // to maybe revive the LCD if static electricity killed it.
  1239. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT)
  1240. currentMenu == lcd_status_screen
  1241. #endif
  1242. );
  1243. lcd_goto_menu(lcd_status_screen, 0, false);
  1244. menuStack.reset();
  1245. }
  1246. void lcd_sdcard_pause() {
  1247. lcd_return_to_status();
  1248. lcd_commands_type = LCD_COMMAND_LONG_PAUSE;
  1249. }
  1250. static void lcd_sdcard_resume() {
  1251. lcd_return_to_status();
  1252. lcd_reset_alert_level(); //for fan speed error
  1253. lcd_commands_type = LCD_COMMAND_LONG_PAUSE_RESUME;
  1254. }
  1255. float move_menu_scale;
  1256. static void lcd_move_menu_axis();
  1257. /* Menu implementation */
  1258. void lcd_preheat_farm()
  1259. {
  1260. setTargetHotend0(FARM_PREHEAT_HOTEND_TEMP);
  1261. setTargetBed(FARM_PREHEAT_HPB_TEMP);
  1262. fanSpeed = 0;
  1263. lcd_return_to_status();
  1264. setWatch(); // heater sanity check timer
  1265. }
  1266. void lcd_preheat_farm_nozzle()
  1267. {
  1268. setTargetHotend0(FARM_PREHEAT_HOTEND_TEMP);
  1269. setTargetBed(0);
  1270. fanSpeed = 0;
  1271. lcd_return_to_status();
  1272. setWatch(); // heater sanity check timer
  1273. }
  1274. void lcd_preheat_pla()
  1275. {
  1276. setTargetHotend0(PLA_PREHEAT_HOTEND_TEMP);
  1277. setTargetBed(PLA_PREHEAT_HPB_TEMP);
  1278. fanSpeed = 0;
  1279. lcd_return_to_status();
  1280. setWatch(); // heater sanity check timer
  1281. }
  1282. void lcd_preheat_abs()
  1283. {
  1284. setTargetHotend0(ABS_PREHEAT_HOTEND_TEMP);
  1285. setTargetBed(ABS_PREHEAT_HPB_TEMP);
  1286. fanSpeed = 0;
  1287. lcd_return_to_status();
  1288. setWatch(); // heater sanity check timer
  1289. }
  1290. void lcd_preheat_pp()
  1291. {
  1292. setTargetHotend0(PP_PREHEAT_HOTEND_TEMP);
  1293. setTargetBed(PP_PREHEAT_HPB_TEMP);
  1294. fanSpeed = 0;
  1295. lcd_return_to_status();
  1296. setWatch(); // heater sanity check timer
  1297. }
  1298. void lcd_preheat_pet()
  1299. {
  1300. setTargetHotend0(PET_PREHEAT_HOTEND_TEMP);
  1301. setTargetBed(PET_PREHEAT_HPB_TEMP);
  1302. fanSpeed = 0;
  1303. lcd_return_to_status();
  1304. setWatch(); // heater sanity check timer
  1305. }
  1306. void lcd_preheat_hips()
  1307. {
  1308. setTargetHotend0(HIPS_PREHEAT_HOTEND_TEMP);
  1309. setTargetBed(HIPS_PREHEAT_HPB_TEMP);
  1310. fanSpeed = 0;
  1311. lcd_return_to_status();
  1312. setWatch(); // heater sanity check timer
  1313. }
  1314. void lcd_preheat_flex()
  1315. {
  1316. setTargetHotend0(FLEX_PREHEAT_HOTEND_TEMP);
  1317. setTargetBed(FLEX_PREHEAT_HPB_TEMP);
  1318. fanSpeed = 0;
  1319. lcd_return_to_status();
  1320. setWatch(); // heater sanity check timer
  1321. }
  1322. void lcd_cooldown()
  1323. {
  1324. setTargetHotend0(0);
  1325. setTargetHotend1(0);
  1326. setTargetHotend2(0);
  1327. setTargetBed(0);
  1328. fanSpeed = 0;
  1329. lcd_return_to_status();
  1330. }
  1331. static void lcd_menu_extruder_info()
  1332. {
  1333. int fan_speed_RPM[2];
  1334. #ifdef PAT9125
  1335. pat9125_update();
  1336. #endif //PAT9125
  1337. fan_speed_RPM[0] = 60*fan_speed[0];
  1338. fan_speed_RPM[1] = 60*fan_speed[1];
  1339. // Display Nozzle fan RPM
  1340. lcd.setCursor(0, 0);
  1341. lcd_printPGM(MSG_INFO_NOZZLE_FAN);
  1342. lcd.setCursor(11, 0);
  1343. lcd.print(" ");
  1344. lcd.setCursor(12, 0);
  1345. lcd.print(itostr4(fan_speed_RPM[0]));
  1346. lcd.print(" RPM");
  1347. // Display Nozzle fan RPM
  1348. #if (defined(TACH_1))
  1349. lcd.setCursor(0, 1);
  1350. lcd_printPGM(MSG_INFO_PRINT_FAN);
  1351. lcd.setCursor(11, 1);
  1352. lcd.print(" ");
  1353. lcd.setCursor(12, 1);
  1354. lcd.print(itostr4(fan_speed_RPM[1]));
  1355. lcd.print(" RPM");
  1356. #endif
  1357. #ifdef PAT9125
  1358. // Display X and Y difference from Filament sensor
  1359. lcd.setCursor(0, 2);
  1360. lcd.print("Fil. Xd:");
  1361. lcd.print(itostr3(pat9125_x));
  1362. lcd.print(" ");
  1363. lcd.setCursor(12, 2);
  1364. lcd.print("Yd:");
  1365. lcd.print(itostr3(pat9125_y));
  1366. // Display Light intensity from Filament sensor
  1367. /* Frame_Avg register represents the average brightness of all pixels within a frame (324 pixels). This
  1368. value ranges from 0(darkest) to 255(brightest). */
  1369. lcd.setCursor(0, 3);
  1370. lcd.print("Int: ");
  1371. lcd.setCursor(5, 3);
  1372. lcd.print(itostr3(pat9125_b));
  1373. // Display LASER shutter time from Filament sensor
  1374. /* Shutter register is an index of LASER shutter time. It is automatically controlled by the chip's internal
  1375. auto-exposure algorithm. When the chip is tracking on a good reflection surface, the Shutter is small.
  1376. When the chip is tracking on a poor reflection surface, the Shutter is large. Value ranges from 0 to
  1377. 46. */
  1378. lcd.setCursor(10, 3);
  1379. lcd.print("Shut: ");
  1380. lcd.setCursor(15, 3);
  1381. lcd.print(itostr3(pat9125_s));
  1382. #endif //PAT9125
  1383. if (lcd_clicked())
  1384. {
  1385. menu_action_back();
  1386. }
  1387. }
  1388. #if defined(TMC2130) && defined(PAT9125)
  1389. static void lcd_menu_fails_stats_total()
  1390. {
  1391. //01234567890123456789
  1392. //Total failures
  1393. // Power failures 000
  1394. // Filam. runouts 000
  1395. // Crash X 000 Y 000
  1396. //////////////////////
  1397. uint16_t power = eeprom_read_word((uint16_t*)EEPROM_POWER_COUNT_TOT);
  1398. uint16_t filam = eeprom_read_word((uint16_t*)EEPROM_FERROR_COUNT_TOT);
  1399. uint16_t crashX = eeprom_read_word((uint16_t*)EEPROM_CRASH_COUNT_X_TOT);
  1400. uint16_t crashY = eeprom_read_word((uint16_t*)EEPROM_CRASH_COUNT_Y_TOT);
  1401. fprintf_P(lcdout, PSTR(ESC_H(0,0)"Total failures"ESC_H(1,1)"Power failures %-3d"ESC_H(1,2)"Filam. runouts %-3d"ESC_H(1,3)"Crash X %-3d Y %-3d"), power, filam, crashX, crashY);
  1402. if (lcd_clicked())
  1403. {
  1404. lcd_quick_feedback();
  1405. menu_action_back();
  1406. }
  1407. }
  1408. static void lcd_menu_fails_stats_print()
  1409. {
  1410. //01234567890123456789
  1411. //Last print failures
  1412. // Power failures 000
  1413. // Filam. runouts 000
  1414. // Crash X 000 Y 000
  1415. //////////////////////
  1416. uint8_t power = eeprom_read_byte((uint8_t*)EEPROM_POWER_COUNT);
  1417. uint8_t filam = eeprom_read_byte((uint8_t*)EEPROM_FERROR_COUNT);
  1418. uint8_t crashX = eeprom_read_byte((uint8_t*)EEPROM_CRASH_COUNT_X);
  1419. uint8_t crashY = eeprom_read_byte((uint8_t*)EEPROM_CRASH_COUNT_Y);
  1420. fprintf_P(lcdout, PSTR(ESC_H(0,0)"Last print failures"ESC_H(1,1)"Power failures %-3d"ESC_H(1,2)"Filam. runouts %-3d"ESC_H(1,3)"Crash X %-3d Y %-3d"), power, filam, crashX, crashY);
  1421. if (lcd_clicked())
  1422. {
  1423. lcd_quick_feedback();
  1424. menu_action_back();
  1425. }
  1426. }
  1427. /**
  1428. * @brief Open fail statistics menu
  1429. *
  1430. * This version of function is used, when there is filament sensor,
  1431. * power failure and crash detection.
  1432. * There are Last print and Total menu items.
  1433. */
  1434. static void lcd_menu_fails_stats()
  1435. {
  1436. START_MENU();
  1437. MENU_ITEM(back, MSG_MAIN, 0);
  1438. MENU_ITEM(submenu, PSTR("Last print"), lcd_menu_fails_stats_print);
  1439. MENU_ITEM(submenu, PSTR("Total"), lcd_menu_fails_stats_total);
  1440. END_MENU();
  1441. }
  1442. #else if defined(PAT9125)
  1443. /**
  1444. * @brief Print last print and total filament run outs
  1445. *
  1446. * This version of function is used, when there is filament sensor,
  1447. * but no other sensors (e.g. power failure, crash detection).
  1448. *
  1449. * Example screen:
  1450. * @code
  1451. * 01234567890123456789
  1452. * Last print failures
  1453. * Filam. runouts 0
  1454. * Total failures
  1455. * Filam. runouts 5
  1456. * @endcode
  1457. */
  1458. static void lcd_menu_fails_stats()
  1459. {
  1460. uint8_t filamentLast = eeprom_read_byte((uint8_t*)EEPROM_FERROR_COUNT);
  1461. uint16_t filamentTotal = eeprom_read_word((uint16_t*)EEPROM_FERROR_COUNT_TOT);
  1462. fprintf_P(lcdout, PSTR(ESC_H(0,0)"Last print failures"ESC_H(1,1)"Filam. runouts %-3d"ESC_H(0,2)"Total failures"ESC_H(1,3)"Filam. runouts %-3d"), filamentLast, filamentTotal);
  1463. if (lcd_clicked())
  1464. {
  1465. menu_action_back();
  1466. }
  1467. }
  1468. #endif //TMC2130
  1469. #ifdef DEBUG_BUILD
  1470. #ifdef DEBUG_STACK_MONITOR
  1471. extern uint16_t SP_min;
  1472. extern char* __malloc_heap_start;
  1473. extern char* __malloc_heap_end;
  1474. #endif //DEBUG_STACK_MONITOR
  1475. static void lcd_menu_debug()
  1476. {
  1477. #ifdef DEBUG_STACK_MONITOR
  1478. fprintf_P(lcdout, PSTR(ESC_H(1,1)"RAM statistics"ESC_H(5,1)"SP_min: 0x%04x"ESC_H(1,2)"heap_start: 0x%04x"ESC_H(3,3)"heap_end: 0x%04x"), SP_min, __malloc_heap_start, __malloc_heap_end);
  1479. #endif //DEBUG_STACK_MONITOR
  1480. if (lcd_clicked())
  1481. {
  1482. lcd_quick_feedback();
  1483. menu_action_back();
  1484. }
  1485. }
  1486. #endif /* DEBUG_BUILD */
  1487. static void lcd_menu_temperatures()
  1488. {
  1489. fprintf_P(lcdout, PSTR(ESC_H(1,0)"Nozzle: %d%c" ESC_H(1,1)"Bed: %d%c"), (int)current_temperature[0], '\x01', (int)current_temperature_bed, '\x01');
  1490. #ifdef AMBIENT_THERMISTOR
  1491. fprintf_P(lcdout, PSTR(ESC_H(1,2)"Ambient: %d%c" ESC_H(1,3)"PINDA: %d%c"), (int)current_temperature_ambient, '\x01', (int)current_temperature_pinda, '\x01');
  1492. #else //AMBIENT_THERMISTOR
  1493. fprintf_P(lcdout, PSTR(ESC_H(1,2)"PINDA: %d%c"), (int)current_temperature_pinda, '\x01');
  1494. #endif //AMBIENT_THERMISTOR
  1495. if (lcd_clicked())
  1496. {
  1497. menu_action_back();
  1498. }
  1499. }
  1500. #if defined (VOLT_BED_PIN) || defined (VOLT_PWR_PIN)
  1501. #define VOLT_DIV_R1 10000
  1502. #define VOLT_DIV_R2 2370
  1503. #define VOLT_DIV_FAC ((float)VOLT_DIV_R2 / (VOLT_DIV_R2 + VOLT_DIV_R1))
  1504. #define VOLT_DIV_REF 5
  1505. static void lcd_menu_voltages()
  1506. {
  1507. float volt_pwr = VOLT_DIV_REF * ((float)current_voltage_raw_pwr / (1023 * OVERSAMPLENR)) / VOLT_DIV_FAC;
  1508. //float volt_bed = VOLT_DIV_REF * ((float)current_voltage_raw_bed / (1023 * OVERSAMPLENR)) / VOLT_DIV_FAC;
  1509. //fprintf_P(lcdout, PSTR(ESC_H(1,1)"PWR: %d.%01dV" ESC_H(1,2)"BED: %d.%01dV"), (int)volt_pwr, (int)(10*fabs(volt_pwr - (int)volt_pwr)), (int)volt_bed, (int)(10*fabs(volt_bed - (int)volt_bed)));
  1510. fprintf_P(lcdout, PSTR( ESC_H(1,1)"PWR: %d.%01dV"), (int)volt_pwr, (int)(10*fabs(volt_pwr - (int)volt_pwr))) ;
  1511. if (lcd_clicked())
  1512. {
  1513. menu_action_back();
  1514. }
  1515. }
  1516. #endif //defined VOLT_BED_PIN || defined VOLT_PWR_PIN
  1517. #ifdef TMC2130
  1518. static void lcd_menu_belt_status()
  1519. {
  1520. fprintf_P(lcdout, PSTR(ESC_H(1,0) "Belt status" ESC_H(2,1) "X %d" ESC_H(2,2) "Y %d" ), eeprom_read_word((uint16_t*)(EEPROM_BELTSTATUS_X)), eeprom_read_word((uint16_t*)(EEPROM_BELTSTATUS_Y)));
  1521. if (lcd_clicked())
  1522. {
  1523. menu_action_back();
  1524. }
  1525. }
  1526. #endif //TMC2130
  1527. extern void stop_and_save_print_to_ram(float z_move, float e_move);
  1528. extern void restore_print_from_ram_and_continue(float e_move);
  1529. static void lcd_menu_test_save()
  1530. {
  1531. stop_and_save_print_to_ram(10, -0.8);
  1532. }
  1533. static void lcd_menu_test_restore()
  1534. {
  1535. restore_print_from_ram_and_continue(0.8);
  1536. }
  1537. static void lcd_preheat_menu()
  1538. {
  1539. START_MENU();
  1540. MENU_ITEM(back, MSG_MAIN, 0);
  1541. if (farm_mode) {
  1542. MENU_ITEM(function, PSTR("farm - " STRINGIFY(FARM_PREHEAT_HOTEND_TEMP) "/" STRINGIFY(FARM_PREHEAT_HPB_TEMP)), lcd_preheat_farm);
  1543. MENU_ITEM(function, PSTR("nozzle - " STRINGIFY(FARM_PREHEAT_HOTEND_TEMP) "/0"), lcd_preheat_farm_nozzle);
  1544. MENU_ITEM(function, MSG_COOLDOWN, lcd_cooldown);
  1545. MENU_ITEM(function, PSTR("ABS - " STRINGIFY(ABS_PREHEAT_HOTEND_TEMP) "/" STRINGIFY(ABS_PREHEAT_HPB_TEMP)), lcd_preheat_abs);
  1546. } else {
  1547. MENU_ITEM(function, PSTR("PLA - " STRINGIFY(PLA_PREHEAT_HOTEND_TEMP) "/" STRINGIFY(PLA_PREHEAT_HPB_TEMP)), lcd_preheat_pla);
  1548. MENU_ITEM(function, PSTR("PET - " STRINGIFY(PET_PREHEAT_HOTEND_TEMP) "/" STRINGIFY(PET_PREHEAT_HPB_TEMP)), lcd_preheat_pet);
  1549. MENU_ITEM(function, PSTR("ABS - " STRINGIFY(ABS_PREHEAT_HOTEND_TEMP) "/" STRINGIFY(ABS_PREHEAT_HPB_TEMP)), lcd_preheat_abs);
  1550. MENU_ITEM(function, PSTR("HIPS - " STRINGIFY(HIPS_PREHEAT_HOTEND_TEMP) "/" STRINGIFY(HIPS_PREHEAT_HPB_TEMP)), lcd_preheat_hips);
  1551. MENU_ITEM(function, PSTR("PP - " STRINGIFY(PP_PREHEAT_HOTEND_TEMP) "/" STRINGIFY(PP_PREHEAT_HPB_TEMP)), lcd_preheat_pp);
  1552. MENU_ITEM(function, PSTR("FLEX - " STRINGIFY(FLEX_PREHEAT_HOTEND_TEMP) "/" STRINGIFY(FLEX_PREHEAT_HPB_TEMP)), lcd_preheat_flex);
  1553. MENU_ITEM(function, MSG_COOLDOWN, lcd_cooldown);
  1554. }
  1555. END_MENU();
  1556. }
  1557. static void lcd_support_menu()
  1558. {
  1559. if (menuData.supportMenu.status == 0 || lcdDrawUpdate == 2) {
  1560. // Menu was entered or SD card status has changed (plugged in or removed).
  1561. // Initialize its status.
  1562. menuData.supportMenu.status = 1;
  1563. menuData.supportMenu.is_flash_air = card.ToshibaFlashAir_isEnabled() && card.ToshibaFlashAir_GetIP(menuData.supportMenu.ip);
  1564. if (menuData.supportMenu.is_flash_air)
  1565. sprintf_P(menuData.supportMenu.ip_str, PSTR("%d.%d.%d.%d"),
  1566. menuData.supportMenu.ip[0], menuData.supportMenu.ip[1],
  1567. menuData.supportMenu.ip[2], menuData.supportMenu.ip[3]);
  1568. } else if (menuData.supportMenu.is_flash_air &&
  1569. menuData.supportMenu.ip[0] == 0 && menuData.supportMenu.ip[1] == 0 &&
  1570. menuData.supportMenu.ip[2] == 0 && menuData.supportMenu.ip[3] == 0 &&
  1571. ++ menuData.supportMenu.status == 16) {
  1572. // Waiting for the FlashAir card to get an IP address from a router. Force an update.
  1573. menuData.supportMenu.status = 0;
  1574. }
  1575. START_MENU();
  1576. MENU_ITEM(back, MSG_MAIN, 0);
  1577. MENU_ITEM(back, PSTR("Firmware:"), 0);
  1578. MENU_ITEM(back, PSTR(" " FW_VERSION_FULL), 0);
  1579. #if (FW_DEV_VERSION != FW_VERSION_GOLD) && (FW_DEV_VERSION != FW_VERSION_RC)
  1580. MENU_ITEM(back, PSTR(" repo " FW_REPOSITORY), 0);
  1581. #endif
  1582. // Ideally this block would be optimized out by the compiler.
  1583. /* const uint8_t fw_string_len = strlen_P(FW_VERSION_STR_P());
  1584. if (fw_string_len < 6) {
  1585. MENU_ITEM(back, PSTR(MSG_FW_VERSION " - " FW_version), 0);
  1586. } else {
  1587. MENU_ITEM(back, PSTR("FW - " FW_version), 0);
  1588. }*/
  1589. MENU_ITEM(back, MSG_PRUSA3D, 0);
  1590. MENU_ITEM(back, MSG_PRUSA3D_FORUM, 0);
  1591. MENU_ITEM(back, MSG_PRUSA3D_HOWTO, 0);
  1592. MENU_ITEM(back, PSTR("------------"), 0);
  1593. MENU_ITEM(back, PSTR(FILAMENT_SIZE), 0);
  1594. MENU_ITEM(back, PSTR(ELECTRONICS),0);
  1595. MENU_ITEM(back, PSTR(NOZZLE_TYPE),0);
  1596. MENU_ITEM(back, PSTR("------------"), 0);
  1597. MENU_ITEM(back, MSG_DATE, 0);
  1598. MENU_ITEM(back, PSTR(__DATE__), 0);
  1599. // Show the FlashAir IP address, if the card is available.
  1600. if (menuData.supportMenu.is_flash_air) {
  1601. MENU_ITEM(back, PSTR("------------"), 0);
  1602. MENU_ITEM(back, PSTR("FlashAir IP Addr:"), 0);
  1603. MENU_ITEM(back_RAM, menuData.supportMenu.ip_str, 0);
  1604. }
  1605. #ifndef MK1BP
  1606. MENU_ITEM(back, PSTR("------------"), 0);
  1607. MENU_ITEM(submenu, MSG_XYZ_DETAILS, lcd_menu_xyz_y_min);
  1608. MENU_ITEM(submenu, MSG_INFO_EXTRUDER, lcd_menu_extruder_info);
  1609. #ifdef TMC2130
  1610. MENU_ITEM(submenu, MSG_MENU_BELT_STATUS, lcd_menu_belt_status);
  1611. #endif //TMC2130
  1612. MENU_ITEM(submenu, MSG_MENU_TEMPERATURES, lcd_menu_temperatures);
  1613. #if defined (VOLT_BED_PIN) || defined (VOLT_PWR_PIN)
  1614. MENU_ITEM(submenu, MSG_MENU_VOLTAGES, lcd_menu_voltages);
  1615. #endif //defined VOLT_BED_PIN || defined VOLT_PWR_PIN
  1616. #ifdef DEBUG_BUILD
  1617. MENU_ITEM(submenu, PSTR("Debug"), lcd_menu_debug);
  1618. #endif /* DEBUG_BUILD */
  1619. #endif //MK1BP
  1620. END_MENU();
  1621. }
  1622. void lcd_set_fan_check() {
  1623. fans_check_enabled = !fans_check_enabled;
  1624. eeprom_update_byte((unsigned char *)EEPROM_FAN_CHECK_ENABLED, fans_check_enabled);
  1625. lcd_goto_menu(lcd_settings_menu); //doesn't break menuStack
  1626. }
  1627. void lcd_set_filament_autoload() {
  1628. filament_autoload_enabled = !filament_autoload_enabled;
  1629. eeprom_update_byte((unsigned char *)EEPROM_FSENS_AUTOLOAD_ENABLED, filament_autoload_enabled);
  1630. lcd_goto_menu(lcd_settings_menu); //doesn't break menuStack
  1631. }
  1632. void lcd_unLoadFilament()
  1633. {
  1634. if (degHotend0() > EXTRUDE_MINTEMP) {
  1635. enquecommand_P(PSTR("M702")); //unload filament
  1636. } else {
  1637. lcd_implementation_clear();
  1638. lcd.setCursor(0, 0);
  1639. lcd_printPGM(MSG_ERROR);
  1640. lcd.setCursor(0, 2);
  1641. lcd_printPGM(MSG_PREHEAT_NOZZLE);
  1642. delay(2000);
  1643. lcd_implementation_clear();
  1644. }
  1645. menu_action_back();
  1646. }
  1647. void lcd_change_filament() {
  1648. lcd_implementation_clear();
  1649. lcd.setCursor(0, 1);
  1650. lcd_printPGM(MSG_CHANGING_FILAMENT);
  1651. }
  1652. void lcd_wait_interact() {
  1653. lcd_implementation_clear();
  1654. lcd.setCursor(0, 1);
  1655. #ifdef SNMM
  1656. lcd_printPGM(MSG_PREPARE_FILAMENT);
  1657. #else
  1658. lcd_printPGM(MSG_INSERT_FILAMENT);
  1659. #endif
  1660. lcd.setCursor(0, 2);
  1661. lcd_printPGM(MSG_PRESS);
  1662. }
  1663. void lcd_change_success() {
  1664. lcd_implementation_clear();
  1665. lcd.setCursor(0, 2);
  1666. lcd_printPGM(MSG_CHANGE_SUCCESS);
  1667. }
  1668. void lcd_loading_color() {
  1669. lcd_implementation_clear();
  1670. lcd.setCursor(0, 0);
  1671. lcd_printPGM(MSG_LOADING_COLOR);
  1672. lcd.setCursor(0, 2);
  1673. lcd_printPGM(MSG_PLEASE_WAIT);
  1674. for (int i = 0; i < 20; i++) {
  1675. lcd.setCursor(i, 3);
  1676. lcd.print(".");
  1677. for (int j = 0; j < 10 ; j++) {
  1678. manage_heater();
  1679. manage_inactivity(true);
  1680. delay(85);
  1681. }
  1682. }
  1683. }
  1684. void lcd_loading_filament() {
  1685. lcd_implementation_clear();
  1686. lcd.setCursor(0, 0);
  1687. lcd_printPGM(MSG_LOADING_FILAMENT);
  1688. lcd.setCursor(0, 2);
  1689. lcd_printPGM(MSG_PLEASE_WAIT);
  1690. for (int i = 0; i < 20; i++) {
  1691. lcd.setCursor(i, 3);
  1692. lcd.print(".");
  1693. for (int j = 0; j < 10 ; j++) {
  1694. manage_heater();
  1695. manage_inactivity(true);
  1696. #ifdef SNMM
  1697. delay(153);
  1698. #else
  1699. delay(137);
  1700. #endif
  1701. }
  1702. }
  1703. }
  1704. void lcd_alright() {
  1705. int enc_dif = 0;
  1706. int cursor_pos = 1;
  1707. lcd_implementation_clear();
  1708. lcd.setCursor(0, 0);
  1709. lcd_printPGM(MSG_CORRECTLY);
  1710. lcd.setCursor(1, 1);
  1711. lcd_printPGM(MSG_YES);
  1712. lcd.setCursor(1, 2);
  1713. lcd_printPGM(MSG_NOT_LOADED);
  1714. lcd.setCursor(1, 3);
  1715. lcd_printPGM(MSG_NOT_COLOR);
  1716. lcd.setCursor(0, 1);
  1717. lcd.print(">");
  1718. enc_dif = encoderDiff;
  1719. while (lcd_change_fil_state == 0) {
  1720. manage_heater();
  1721. manage_inactivity(true);
  1722. if ( abs((enc_dif - encoderDiff)) > 4 ) {
  1723. if ( (abs(enc_dif - encoderDiff)) > 1 ) {
  1724. if (enc_dif > encoderDiff ) {
  1725. cursor_pos --;
  1726. }
  1727. if (enc_dif < encoderDiff ) {
  1728. cursor_pos ++;
  1729. }
  1730. if (cursor_pos > 3) {
  1731. cursor_pos = 3;
  1732. }
  1733. if (cursor_pos < 1) {
  1734. cursor_pos = 1;
  1735. }
  1736. lcd.setCursor(0, 1);
  1737. lcd.print(" ");
  1738. lcd.setCursor(0, 2);
  1739. lcd.print(" ");
  1740. lcd.setCursor(0, 3);
  1741. lcd.print(" ");
  1742. lcd.setCursor(0, cursor_pos);
  1743. lcd.print(">");
  1744. enc_dif = encoderDiff;
  1745. delay(100);
  1746. }
  1747. }
  1748. if (lcd_clicked()) {
  1749. lcd_change_fil_state = cursor_pos;
  1750. delay(500);
  1751. }
  1752. };
  1753. lcd_implementation_clear();
  1754. lcd_return_to_status();
  1755. }
  1756. #ifdef PAT9125
  1757. static void lcd_menu_AutoLoadFilament()
  1758. {
  1759. if (degHotend0() > EXTRUDE_MINTEMP)
  1760. {
  1761. uint8_t nlines;
  1762. lcd_display_message_fullscreen_nonBlocking_P(MSG_AUTOLOADING_ENABLED,nlines);
  1763. }
  1764. else
  1765. {
  1766. Timer* ptimer = (Timer*)&(menuData.autoLoadFilamentMenu.dummy);
  1767. if (!ptimer->running()) ptimer->start();
  1768. lcd.setCursor(0, 0);
  1769. lcd_printPGM(MSG_ERROR);
  1770. lcd.setCursor(0, 2);
  1771. lcd_printPGM(MSG_PREHEAT_NOZZLE);
  1772. if (ptimer->expired(2000ul)) menu_action_back();
  1773. }
  1774. if (lcd_clicked()) menu_action_back();
  1775. }
  1776. #endif //PAT9125
  1777. static void lcd_LoadFilament()
  1778. {
  1779. if (degHotend0() > EXTRUDE_MINTEMP)
  1780. {
  1781. custom_message = true;
  1782. loading_flag = true;
  1783. enquecommand_P(PSTR("M701")); //load filament
  1784. SERIAL_ECHOLN("Loading filament");
  1785. lcd_return_to_status();
  1786. }
  1787. else
  1788. {
  1789. lcd_implementation_clear();
  1790. lcd.setCursor(0, 0);
  1791. lcd_printPGM(MSG_ERROR);
  1792. lcd.setCursor(0, 2);
  1793. lcd_printPGM(MSG_PREHEAT_NOZZLE);
  1794. delay(2000);
  1795. lcd_implementation_clear();
  1796. }
  1797. }
  1798. void lcd_menu_statistics()
  1799. {
  1800. if (IS_SD_PRINTING)
  1801. {
  1802. int _met = total_filament_used / 100000;
  1803. int _cm = (total_filament_used - (_met * 100000))/10;
  1804. int _t = (millis() - starttime) / 1000;
  1805. int _h = _t / 3600;
  1806. int _m = (_t - (_h * 3600)) / 60;
  1807. int _s = _t - ((_h * 3600) + (_m * 60));
  1808. lcd.setCursor(0, 0);
  1809. lcd_printPGM(MSG_STATS_FILAMENTUSED);
  1810. lcd.setCursor(6, 1);
  1811. lcd.print(itostr3(_met));
  1812. lcd.print("m ");
  1813. lcd.print(ftostr32ns(_cm));
  1814. lcd.print("cm");
  1815. lcd.setCursor(0, 2);
  1816. lcd_printPGM(MSG_STATS_PRINTTIME);
  1817. lcd.setCursor(8, 3);
  1818. lcd.print(itostr2(_h));
  1819. lcd.print("h ");
  1820. lcd.print(itostr2(_m));
  1821. lcd.print("m ");
  1822. lcd.print(itostr2(_s));
  1823. lcd.print("s");
  1824. if (lcd_clicked())
  1825. {
  1826. lcd_quick_feedback();
  1827. menu_action_back();
  1828. }
  1829. }
  1830. else
  1831. {
  1832. unsigned long _filament = eeprom_read_dword((uint32_t *)EEPROM_FILAMENTUSED);
  1833. unsigned long _time = eeprom_read_dword((uint32_t *)EEPROM_TOTALTIME); //in minutes
  1834. uint8_t _hours, _minutes;
  1835. uint32_t _days;
  1836. float _filament_m = (float)_filament;
  1837. int _filament_km = (_filament >= 100000) ? _filament / 100000 : 0;
  1838. if (_filament_km > 0) _filament_m = _filament - (_filament_km * 100000);
  1839. _days = _time / 1440;
  1840. _hours = (_time - (_days * 1440)) / 60;
  1841. _minutes = _time - ((_days * 1440) + (_hours * 60));
  1842. lcd_implementation_clear();
  1843. lcd.setCursor(0, 0);
  1844. lcd_printPGM(MSG_STATS_TOTALFILAMENT);
  1845. lcd.setCursor(17 - strlen(ftostr32ns(_filament_m)), 1);
  1846. lcd.print(ftostr32ns(_filament_m));
  1847. if (_filament_km > 0)
  1848. {
  1849. lcd.setCursor(17 - strlen(ftostr32ns(_filament_m)) - 3, 1);
  1850. lcd.print("km");
  1851. lcd.setCursor(17 - strlen(ftostr32ns(_filament_m)) - 8, 1);
  1852. lcd.print(itostr4(_filament_km));
  1853. }
  1854. lcd.setCursor(18, 1);
  1855. lcd.print("m");
  1856. lcd.setCursor(0, 2);
  1857. lcd_printPGM(MSG_STATS_TOTALPRINTTIME);;
  1858. lcd.setCursor(18, 3);
  1859. lcd.print("m");
  1860. lcd.setCursor(14, 3);
  1861. lcd.print(itostr3(_minutes));
  1862. lcd.setCursor(14, 3);
  1863. lcd.print(":");
  1864. lcd.setCursor(12, 3);
  1865. lcd.print("h");
  1866. lcd.setCursor(9, 3);
  1867. lcd.print(itostr3(_hours));
  1868. lcd.setCursor(9, 3);
  1869. lcd.print(":");
  1870. lcd.setCursor(7, 3);
  1871. lcd.print("d");
  1872. lcd.setCursor(4, 3);
  1873. lcd.print(itostr3(_days));
  1874. KEEPALIVE_STATE(PAUSED_FOR_USER);
  1875. while (!lcd_clicked())
  1876. {
  1877. manage_heater();
  1878. manage_inactivity(true);
  1879. delay(100);
  1880. }
  1881. KEEPALIVE_STATE(NOT_BUSY);
  1882. lcd_quick_feedback();
  1883. menu_action_back();
  1884. }
  1885. }
  1886. static void _lcd_move(const char *name, int axis, int min, int max) {
  1887. if (!menuData._lcd_moveMenu.initialized)
  1888. {
  1889. menuData._lcd_moveMenu.endstopsEnabledPrevious = enable_endstops(false);
  1890. menuData._lcd_moveMenu.initialized = true;
  1891. }
  1892. if (encoderPosition != 0) {
  1893. refresh_cmd_timeout();
  1894. if (! planner_queue_full()) {
  1895. current_position[axis] += float((int)encoderPosition) * move_menu_scale;
  1896. if (min_software_endstops && current_position[axis] < min) current_position[axis] = min;
  1897. if (max_software_endstops && current_position[axis] > max) current_position[axis] = max;
  1898. encoderPosition = 0;
  1899. world2machine_clamp(current_position[X_AXIS], current_position[Y_AXIS]);
  1900. 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);
  1901. lcdDrawUpdate = 1;
  1902. }
  1903. }
  1904. if (lcdDrawUpdate) lcd_implementation_drawedit(name, ftostr31(current_position[axis]));
  1905. if (menuExiting || LCD_CLICKED) (void)enable_endstops(menuData._lcd_moveMenu.endstopsEnabledPrevious);
  1906. if (LCD_CLICKED) menu_action_back();
  1907. }
  1908. static void lcd_move_e()
  1909. {
  1910. if (degHotend0() > EXTRUDE_MINTEMP) {
  1911. if (encoderPosition != 0)
  1912. {
  1913. refresh_cmd_timeout();
  1914. if (! planner_queue_full()) {
  1915. current_position[E_AXIS] += float((int)encoderPosition) * move_menu_scale;
  1916. encoderPosition = 0;
  1917. 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);
  1918. lcdDrawUpdate = 1;
  1919. }
  1920. }
  1921. if (lcdDrawUpdate)
  1922. {
  1923. lcd_implementation_drawedit(PSTR("Extruder"), ftostr31(current_position[E_AXIS]));
  1924. }
  1925. if (LCD_CLICKED) menu_action_back();
  1926. }
  1927. else {
  1928. lcd_implementation_clear();
  1929. lcd.setCursor(0, 0);
  1930. lcd_printPGM(MSG_ERROR);
  1931. lcd.setCursor(0, 2);
  1932. lcd_printPGM(MSG_PREHEAT_NOZZLE);
  1933. delay(2000);
  1934. lcd_return_to_status();
  1935. }
  1936. }
  1937. /**
  1938. * @brief Show measured Y distance of front calibration points from Y_MIN_POS
  1939. *
  1940. * If those points are detected too close to edge of reachable area, their confidence is lowered.
  1941. * This functionality is applied more often for MK2 printers.
  1942. */
  1943. static void lcd_menu_xyz_y_min()
  1944. {
  1945. lcd.setCursor(0,0);
  1946. lcd_printPGM(MSG_Y_DISTANCE_FROM_MIN);
  1947. lcd_print_at_PGM(0, 1, separator);
  1948. lcd_print_at_PGM(0, 2, MSG_LEFT);
  1949. lcd_print_at_PGM(0, 3, MSG_RIGHT);
  1950. float distanceMin[2];
  1951. count_xyz_details(distanceMin);
  1952. for (int i = 0; i < 2; i++) {
  1953. if(distanceMin[i] < 200) {
  1954. lcd_print_at_PGM(11, i + 2, PSTR(""));
  1955. lcd.print(distanceMin[i]);
  1956. lcd_print_at_PGM((distanceMin[i] < 0) ? 17 : 16, i + 2, PSTR("mm"));
  1957. } else lcd_print_at_PGM(11, i + 2, PSTR("N/A"));
  1958. }
  1959. if (lcd_clicked())
  1960. {
  1961. lcd_goto_menu(lcd_menu_xyz_skew);
  1962. }
  1963. }
  1964. /**
  1965. * @brief Show measured axis skewness
  1966. */
  1967. static void lcd_menu_xyz_skew()
  1968. {
  1969. float angleDiff;
  1970. angleDiff = eeprom_read_float((float*)(EEPROM_XYZ_CAL_SKEW));
  1971. lcd.setCursor(0,0);
  1972. lcd_printPGM(MSG_MEASURED_SKEW);
  1973. if (angleDiff < 100) {
  1974. lcd.setCursor(15, 0);
  1975. lcd.print(angleDiff * 180 / M_PI);
  1976. lcd.print(LCD_STR_DEGREE);
  1977. }else lcd_print_at_PGM(16, 0, PSTR("N/A"));
  1978. lcd_print_at_PGM(0, 1, separator);
  1979. lcd_print_at_PGM(0, 2, MSG_SLIGHT_SKEW);
  1980. lcd_print_at_PGM(15, 2, PSTR(""));
  1981. lcd.print(bed_skew_angle_mild * 180 / M_PI);
  1982. lcd.print(LCD_STR_DEGREE);
  1983. lcd_print_at_PGM(0, 3, MSG_SEVERE_SKEW);
  1984. lcd_print_at_PGM(15, 3, PSTR(""));
  1985. lcd.print(bed_skew_angle_extreme * 180 / M_PI);
  1986. lcd.print(LCD_STR_DEGREE);
  1987. if (lcd_clicked())
  1988. {
  1989. lcd_goto_menu(lcd_menu_xyz_offset);
  1990. }
  1991. }
  1992. /**
  1993. * @brief Show measured bed offset from expected position
  1994. */
  1995. static void lcd_menu_xyz_offset()
  1996. {
  1997. lcd.setCursor(0,0);
  1998. lcd_printPGM(MSG_MEASURED_OFFSET);
  1999. lcd_print_at_PGM(0, 1, separator);
  2000. lcd_print_at_PGM(0, 2, PSTR("X"));
  2001. lcd_print_at_PGM(0, 3, PSTR("Y"));
  2002. float vec_x[2];
  2003. float vec_y[2];
  2004. float cntr[2];
  2005. world2machine_read_valid(vec_x, vec_y, cntr);
  2006. for (int i = 0; i < 2; i++)
  2007. {
  2008. lcd_print_at_PGM(11, i + 2, PSTR(""));
  2009. lcd.print(cntr[i]);
  2010. lcd_print_at_PGM((cntr[i] < 0) ? 17 : 16, i + 2, PSTR("mm"));
  2011. }
  2012. if (lcd_clicked())
  2013. {
  2014. menu_action_back();
  2015. }
  2016. }
  2017. // Save a single axis babystep value.
  2018. void EEPROM_save_B(int pos, int* value)
  2019. {
  2020. union Data data;
  2021. data.value = *value;
  2022. eeprom_update_byte((unsigned char*)pos, data.b[0]);
  2023. eeprom_update_byte((unsigned char*)pos + 1, data.b[1]);
  2024. }
  2025. // Read a single axis babystep value.
  2026. void EEPROM_read_B(int pos, int* value)
  2027. {
  2028. union Data data;
  2029. data.b[0] = eeprom_read_byte((unsigned char*)pos);
  2030. data.b[1] = eeprom_read_byte((unsigned char*)pos + 1);
  2031. *value = data.value;
  2032. }
  2033. static void lcd_move_x() {
  2034. _lcd_move(PSTR("X"), X_AXIS, X_MIN_POS, X_MAX_POS);
  2035. }
  2036. static void lcd_move_y() {
  2037. _lcd_move(PSTR("Y"), Y_AXIS, Y_MIN_POS, Y_MAX_POS);
  2038. }
  2039. static void lcd_move_z() {
  2040. _lcd_move(PSTR("Z"), Z_AXIS, Z_MIN_POS, Z_MAX_POS);
  2041. }
  2042. /**
  2043. * @brief Adjust first layer offset from bed if axis is Z_AXIS
  2044. *
  2045. * If menu is left (button pushed or timed out), value is stored to EEPROM and
  2046. * if the axis is Z_AXIS, CALIBRATION_STATUS_CALIBRATED is also stored.
  2047. * Purpose of this function for other axis then Z is unknown.
  2048. *
  2049. * @param axis AxisEnum X_AXIS Y_AXIS Z_AXIS
  2050. * other value leads to storing Z_AXIS
  2051. * @param msg text to be displayed
  2052. */
  2053. static void _lcd_babystep(int axis, const char *msg)
  2054. {
  2055. if (menuData.babyStep.status == 0) {
  2056. // Menu was entered.
  2057. // Initialize its status.
  2058. menuData.babyStep.status = 1;
  2059. check_babystep();
  2060. EEPROM_read_B(EEPROM_BABYSTEP_X, &menuData.babyStep.babystepMem[0]);
  2061. EEPROM_read_B(EEPROM_BABYSTEP_Y, &menuData.babyStep.babystepMem[1]);
  2062. EEPROM_read_B(EEPROM_BABYSTEP_Z, &menuData.babyStep.babystepMem[2]);
  2063. menuData.babyStep.babystepMemMM[0] = menuData.babyStep.babystepMem[0]/axis_steps_per_unit[X_AXIS];
  2064. menuData.babyStep.babystepMemMM[1] = menuData.babyStep.babystepMem[1]/axis_steps_per_unit[Y_AXIS];
  2065. menuData.babyStep.babystepMemMM[2] = menuData.babyStep.babystepMem[2]/axis_steps_per_unit[Z_AXIS];
  2066. lcdDrawUpdate = 1;
  2067. //SERIAL_ECHO("Z baby step: ");
  2068. //SERIAL_ECHO(menuData.babyStep.babystepMem[2]);
  2069. // Wait 90 seconds before closing the live adjust dialog.
  2070. lcd_timeoutToStatus = millis() + 90000;
  2071. }
  2072. if (encoderPosition != 0)
  2073. {
  2074. if (homing_flag) encoderPosition = 0;
  2075. menuData.babyStep.babystepMem[axis] += (int)encoderPosition;
  2076. if (axis == 2) {
  2077. if (menuData.babyStep.babystepMem[axis] < Z_BABYSTEP_MIN) menuData.babyStep.babystepMem[axis] = Z_BABYSTEP_MIN; //-3999 -> -9.99 mm
  2078. else if (menuData.babyStep.babystepMem[axis] > Z_BABYSTEP_MAX) menuData.babyStep.babystepMem[axis] = Z_BABYSTEP_MAX; //0
  2079. else {
  2080. CRITICAL_SECTION_START
  2081. babystepsTodo[axis] += (int)encoderPosition;
  2082. CRITICAL_SECTION_END
  2083. }
  2084. }
  2085. menuData.babyStep.babystepMemMM[axis] = menuData.babyStep.babystepMem[axis]/axis_steps_per_unit[axis];
  2086. delay(50);
  2087. encoderPosition = 0;
  2088. lcdDrawUpdate = 1;
  2089. }
  2090. if (lcdDrawUpdate)
  2091. lcd_implementation_drawedit_2(msg, ftostr13ns(menuData.babyStep.babystepMemMM[axis]));
  2092. if (LCD_CLICKED || menuExiting) {
  2093. // Only update the EEPROM when leaving the menu.
  2094. EEPROM_save_B(
  2095. (axis == X_AXIS) ? EEPROM_BABYSTEP_X : ((axis == Y_AXIS) ? EEPROM_BABYSTEP_Y : EEPROM_BABYSTEP_Z),
  2096. &menuData.babyStep.babystepMem[axis]);
  2097. if(Z_AXIS == axis) calibration_status_store(CALIBRATION_STATUS_CALIBRATED);
  2098. }
  2099. if (LCD_CLICKED) menu_action_back();
  2100. }
  2101. static void lcd_babystep_x() {
  2102. _lcd_babystep(X_AXIS, (MSG_BABYSTEPPING_X));
  2103. }
  2104. static void lcd_babystep_y() {
  2105. _lcd_babystep(Y_AXIS, (MSG_BABYSTEPPING_Y));
  2106. }
  2107. static void lcd_babystep_z() {
  2108. _lcd_babystep(Z_AXIS, (MSG_BABYSTEPPING_Z));
  2109. }
  2110. static void lcd_adjust_bed();
  2111. /**
  2112. * @brief adjust bed reset menu item function
  2113. *
  2114. * To be used as MENU_ITEM(function,...) inside lcd_adjust_bed submenu. In such case lcd_goto_menu usage
  2115. * is correct and doesn't break menuStack.
  2116. * Because we did not leave the menu, the menuData did not reset.
  2117. * Force refresh of the bed leveling data.
  2118. */
  2119. static void lcd_adjust_bed_reset()
  2120. {
  2121. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_VALID, 1);
  2122. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_LEFT , 0);
  2123. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_RIGHT, 0);
  2124. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_FRONT, 0);
  2125. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_REAR , 0);
  2126. lcd_goto_menu(lcd_adjust_bed, 0, false); //doesn't break menuStack
  2127. menuData.adjustBed.status = 0;
  2128. }
  2129. void adjust_bed_reset() {
  2130. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_VALID, 1);
  2131. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_LEFT, 0);
  2132. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_RIGHT, 0);
  2133. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_FRONT, 0);
  2134. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_REAR, 0);
  2135. menuData.adjustBed.left = menuData.adjustBed.left2 = 0;
  2136. menuData.adjustBed.right = menuData.adjustBed.right2 = 0;
  2137. menuData.adjustBed.front = menuData.adjustBed.front2 = 0;
  2138. menuData.adjustBed.rear = menuData.adjustBed.rear2 = 0;
  2139. }
  2140. #define BED_ADJUSTMENT_UM_MAX 50
  2141. static void lcd_adjust_bed()
  2142. {
  2143. if (menuData.adjustBed.status == 0) {
  2144. // Menu was entered.
  2145. // Initialize its status.
  2146. menuData.adjustBed.status = 1;
  2147. bool valid = false;
  2148. menuData.adjustBed.left = menuData.adjustBed.left2 = eeprom_read_int8((unsigned char*)EEPROM_BED_CORRECTION_LEFT);
  2149. menuData.adjustBed.right = menuData.adjustBed.right2 = eeprom_read_int8((unsigned char*)EEPROM_BED_CORRECTION_RIGHT);
  2150. menuData.adjustBed.front = menuData.adjustBed.front2 = eeprom_read_int8((unsigned char*)EEPROM_BED_CORRECTION_FRONT);
  2151. menuData.adjustBed.rear = menuData.adjustBed.rear2 = eeprom_read_int8((unsigned char*)EEPROM_BED_CORRECTION_REAR);
  2152. if (eeprom_read_byte((unsigned char*)EEPROM_BED_CORRECTION_VALID) == 1 &&
  2153. menuData.adjustBed.left >= -BED_ADJUSTMENT_UM_MAX && menuData.adjustBed.left <= BED_ADJUSTMENT_UM_MAX &&
  2154. menuData.adjustBed.right >= -BED_ADJUSTMENT_UM_MAX && menuData.adjustBed.right <= BED_ADJUSTMENT_UM_MAX &&
  2155. menuData.adjustBed.front >= -BED_ADJUSTMENT_UM_MAX && menuData.adjustBed.front <= BED_ADJUSTMENT_UM_MAX &&
  2156. menuData.adjustBed.rear >= -BED_ADJUSTMENT_UM_MAX && menuData.adjustBed.rear <= BED_ADJUSTMENT_UM_MAX)
  2157. valid = true;
  2158. if (! valid) {
  2159. // Reset the values: simulate an edit.
  2160. menuData.adjustBed.left2 = 0;
  2161. menuData.adjustBed.right2 = 0;
  2162. menuData.adjustBed.front2 = 0;
  2163. menuData.adjustBed.rear2 = 0;
  2164. }
  2165. lcdDrawUpdate = 1;
  2166. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_VALID, 1);
  2167. }
  2168. if (menuData.adjustBed.left != menuData.adjustBed.left2)
  2169. eeprom_update_int8((unsigned char*)EEPROM_BED_CORRECTION_LEFT, menuData.adjustBed.left = menuData.adjustBed.left2);
  2170. if (menuData.adjustBed.right != menuData.adjustBed.right2)
  2171. eeprom_update_int8((unsigned char*)EEPROM_BED_CORRECTION_RIGHT, menuData.adjustBed.right = menuData.adjustBed.right2);
  2172. if (menuData.adjustBed.front != menuData.adjustBed.front2)
  2173. eeprom_update_int8((unsigned char*)EEPROM_BED_CORRECTION_FRONT, menuData.adjustBed.front = menuData.adjustBed.front2);
  2174. if (menuData.adjustBed.rear != menuData.adjustBed.rear2)
  2175. eeprom_update_int8((unsigned char*)EEPROM_BED_CORRECTION_REAR, menuData.adjustBed.rear = menuData.adjustBed.rear2);
  2176. START_MENU();
  2177. MENU_ITEM(back, MSG_SETTINGS, 0);
  2178. MENU_ITEM_EDIT(int3, MSG_BED_CORRECTION_LEFT, &menuData.adjustBed.left2, -BED_ADJUSTMENT_UM_MAX, BED_ADJUSTMENT_UM_MAX);
  2179. MENU_ITEM_EDIT(int3, MSG_BED_CORRECTION_RIGHT, &menuData.adjustBed.right2, -BED_ADJUSTMENT_UM_MAX, BED_ADJUSTMENT_UM_MAX);
  2180. MENU_ITEM_EDIT(int3, MSG_BED_CORRECTION_FRONT, &menuData.adjustBed.front2, -BED_ADJUSTMENT_UM_MAX, BED_ADJUSTMENT_UM_MAX);
  2181. MENU_ITEM_EDIT(int3, MSG_BED_CORRECTION_REAR, &menuData.adjustBed.rear2, -BED_ADJUSTMENT_UM_MAX, BED_ADJUSTMENT_UM_MAX);
  2182. MENU_ITEM(function, MSG_BED_CORRECTION_RESET, lcd_adjust_bed_reset);
  2183. END_MENU();
  2184. }
  2185. void pid_extruder() {
  2186. lcd_implementation_clear();
  2187. lcd.setCursor(1, 0);
  2188. lcd_printPGM(MSG_SET_TEMPERATURE);
  2189. pid_temp += int(encoderPosition);
  2190. if (pid_temp > HEATER_0_MAXTEMP) pid_temp = HEATER_0_MAXTEMP;
  2191. if (pid_temp < HEATER_0_MINTEMP) pid_temp = HEATER_0_MINTEMP;
  2192. encoderPosition = 0;
  2193. lcd.setCursor(1, 2);
  2194. lcd.print(ftostr3(pid_temp));
  2195. if (lcd_clicked()) {
  2196. lcd_commands_type = LCD_COMMAND_PID_EXTRUDER;
  2197. lcd_return_to_status();
  2198. lcd_update(2);
  2199. }
  2200. }
  2201. void lcd_adjust_z() {
  2202. int enc_dif = 0;
  2203. int cursor_pos = 1;
  2204. int fsm = 0;
  2205. lcd_implementation_clear();
  2206. lcd.setCursor(0, 0);
  2207. lcd_printPGM(MSG_ADJUSTZ);
  2208. lcd.setCursor(1, 1);
  2209. lcd_printPGM(MSG_YES);
  2210. lcd.setCursor(1, 2);
  2211. lcd_printPGM(MSG_NO);
  2212. lcd.setCursor(0, 1);
  2213. lcd.print(">");
  2214. enc_dif = encoderDiff;
  2215. while (fsm == 0) {
  2216. manage_heater();
  2217. manage_inactivity(true);
  2218. if ( abs((enc_dif - encoderDiff)) > 4 ) {
  2219. if ( (abs(enc_dif - encoderDiff)) > 1 ) {
  2220. if (enc_dif > encoderDiff ) {
  2221. cursor_pos --;
  2222. }
  2223. if (enc_dif < encoderDiff ) {
  2224. cursor_pos ++;
  2225. }
  2226. if (cursor_pos > 2) {
  2227. cursor_pos = 2;
  2228. }
  2229. if (cursor_pos < 1) {
  2230. cursor_pos = 1;
  2231. }
  2232. lcd.setCursor(0, 1);
  2233. lcd.print(" ");
  2234. lcd.setCursor(0, 2);
  2235. lcd.print(" ");
  2236. lcd.setCursor(0, cursor_pos);
  2237. lcd.print(">");
  2238. enc_dif = encoderDiff;
  2239. delay(100);
  2240. }
  2241. }
  2242. if (lcd_clicked()) {
  2243. fsm = cursor_pos;
  2244. if (fsm == 1) {
  2245. int babystepLoadZ = 0;
  2246. EEPROM_read_B(EEPROM_BABYSTEP_Z, &babystepLoadZ);
  2247. CRITICAL_SECTION_START
  2248. babystepsTodo[Z_AXIS] = babystepLoadZ;
  2249. CRITICAL_SECTION_END
  2250. } else {
  2251. int zero = 0;
  2252. EEPROM_save_B(EEPROM_BABYSTEP_X, &zero);
  2253. EEPROM_save_B(EEPROM_BABYSTEP_Y, &zero);
  2254. EEPROM_save_B(EEPROM_BABYSTEP_Z, &zero);
  2255. }
  2256. delay(500);
  2257. }
  2258. };
  2259. lcd_implementation_clear();
  2260. lcd_return_to_status();
  2261. }
  2262. bool lcd_wait_for_pinda(float temp) {
  2263. lcd_set_custom_characters_degree();
  2264. setTargetHotend(0, 0);
  2265. setTargetBed(0);
  2266. Timer pinda_timeout;
  2267. pinda_timeout.start();
  2268. bool target_temp_reached = true;
  2269. while (current_temperature_pinda > temp){
  2270. lcd_display_message_fullscreen_P(MSG_WAITING_TEMP_PINDA);
  2271. lcd.setCursor(0, 4);
  2272. lcd.print(LCD_STR_THERMOMETER[0]);
  2273. lcd.print(ftostr3(current_temperature_pinda));
  2274. lcd.print("/");
  2275. lcd.print(ftostr3(temp));
  2276. lcd.print(LCD_STR_DEGREE);
  2277. delay_keep_alive(1000);
  2278. serialecho_temperatures();
  2279. if (pinda_timeout.expired(8 * 60 * 1000ul)) { //PINDA cooling from 60 C to 35 C takes about 7 minutes
  2280. target_temp_reached = false;
  2281. break;
  2282. }
  2283. }
  2284. lcd_set_custom_characters_arrows();
  2285. lcd_update_enable(true);
  2286. return(target_temp_reached);
  2287. }
  2288. void lcd_wait_for_heater() {
  2289. lcd_display_message_fullscreen_P(MSG_WIZARD_HEATING);
  2290. lcd.setCursor(0, 4);
  2291. lcd.print(LCD_STR_THERMOMETER[0]);
  2292. lcd.print(ftostr3(degHotend(active_extruder)));
  2293. lcd.print("/");
  2294. lcd.print(ftostr3(degTargetHotend(active_extruder)));
  2295. lcd.print(LCD_STR_DEGREE);
  2296. }
  2297. void lcd_wait_for_cool_down() {
  2298. lcd_set_custom_characters_degree();
  2299. setTargetHotend(0,0);
  2300. setTargetBed(0);
  2301. while ((degHotend(0)>MAX_HOTEND_TEMP_CALIBRATION) || (degBed() > MAX_BED_TEMP_CALIBRATION)) {
  2302. lcd_display_message_fullscreen_P(MSG_WAITING_TEMP);
  2303. lcd.setCursor(0, 4);
  2304. lcd.print(LCD_STR_THERMOMETER[0]);
  2305. lcd.print(ftostr3(degHotend(0)));
  2306. lcd.print("/0");
  2307. lcd.print(LCD_STR_DEGREE);
  2308. lcd.setCursor(9, 4);
  2309. lcd.print(LCD_STR_BEDTEMP[0]);
  2310. lcd.print(ftostr3(degBed()));
  2311. lcd.print("/0");
  2312. lcd.print(LCD_STR_DEGREE);
  2313. lcd_set_custom_characters();
  2314. delay_keep_alive(1000);
  2315. serialecho_temperatures();
  2316. }
  2317. lcd_set_custom_characters_arrows();
  2318. lcd_update_enable(true);
  2319. }
  2320. // Lets the user move the Z carriage up to the end stoppers.
  2321. // When done, it sets the current Z to Z_MAX_POS and returns true.
  2322. // Otherwise the Z calibration is not changed and false is returned.
  2323. #ifndef TMC2130
  2324. bool lcd_calibrate_z_end_stop_manual(bool only_z)
  2325. {
  2326. bool clean_nozzle_asked = false;
  2327. // Don't know where we are. Let's claim we are Z=0, so the soft end stops will not be triggered when moving up.
  2328. current_position[Z_AXIS] = 0;
  2329. plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
  2330. // Until confirmed by the confirmation dialog.
  2331. for (;;) {
  2332. unsigned long previous_millis_cmd = millis();
  2333. const char *msg = only_z ? MSG_MOVE_CARRIAGE_TO_THE_TOP_Z : MSG_MOVE_CARRIAGE_TO_THE_TOP;
  2334. const char *msg_next = lcd_display_message_fullscreen_P(msg);
  2335. const bool multi_screen = msg_next != NULL;
  2336. unsigned long previous_millis_msg = millis();
  2337. // Until the user finishes the z up movement.
  2338. encoderDiff = 0;
  2339. encoderPosition = 0;
  2340. for (;;) {
  2341. // if (millis() - previous_millis_cmd > LCD_TIMEOUT_TO_STATUS)
  2342. // goto canceled;
  2343. manage_heater();
  2344. manage_inactivity(true);
  2345. if (abs(encoderDiff) >= ENCODER_PULSES_PER_STEP) {
  2346. delay(50);
  2347. previous_millis_cmd = millis();
  2348. encoderPosition += abs(encoderDiff / ENCODER_PULSES_PER_STEP);
  2349. encoderDiff = 0;
  2350. if (! planner_queue_full()) {
  2351. // Only move up, whatever direction the user rotates the encoder.
  2352. current_position[Z_AXIS] += fabs(encoderPosition);
  2353. encoderPosition = 0;
  2354. 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);
  2355. }
  2356. }
  2357. if (lcd_clicked()) {
  2358. // Abort a move if in progress.
  2359. planner_abort_hard();
  2360. while (lcd_clicked()) ;
  2361. delay(10);
  2362. while (lcd_clicked()) ;
  2363. break;
  2364. }
  2365. if (multi_screen && millis() - previous_millis_msg > 5000) {
  2366. if (msg_next == NULL)
  2367. msg_next = msg;
  2368. msg_next = lcd_display_message_fullscreen_P(msg_next);
  2369. previous_millis_msg = millis();
  2370. }
  2371. }
  2372. if (! clean_nozzle_asked) {
  2373. lcd_show_fullscreen_message_and_wait_P(MSG_CONFIRM_NOZZLE_CLEAN);
  2374. clean_nozzle_asked = true;
  2375. }
  2376. // Let the user confirm, that the Z carriage is at the top end stoppers.
  2377. int8_t result = lcd_show_fullscreen_message_yes_no_and_wait_P(MSG_CONFIRM_CARRIAGE_AT_THE_TOP, false);
  2378. if (result == -1)
  2379. goto canceled;
  2380. else if (result == 1)
  2381. goto calibrated;
  2382. // otherwise perform another round of the Z up dialog.
  2383. }
  2384. calibrated:
  2385. // Let the machine think the Z axis is a bit higher than it is, so it will not home into the bed
  2386. // during the search for the induction points.
  2387. current_position[Z_AXIS] = Z_MAX_POS-3.f;
  2388. plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
  2389. if(only_z){
  2390. lcd_display_message_fullscreen_P(MSG_MEASURE_BED_REFERENCE_HEIGHT_LINE1);
  2391. lcd_implementation_print_at(0, 3, 1);
  2392. lcd_printPGM(MSG_MEASURE_BED_REFERENCE_HEIGHT_LINE2);
  2393. }else{
  2394. //lcd_show_fullscreen_message_and_wait_P(MSG_PAPER);
  2395. lcd_display_message_fullscreen_P(MSG_FIND_BED_OFFSET_AND_SKEW_LINE1);
  2396. lcd_implementation_print_at(0, 2, 1);
  2397. lcd_printPGM(MSG_FIND_BED_OFFSET_AND_SKEW_LINE2);
  2398. }
  2399. return true;
  2400. canceled:
  2401. return false;
  2402. }
  2403. #endif // TMC2130
  2404. static inline bool pgm_is_whitespace(const char *c_addr)
  2405. {
  2406. const char c = pgm_read_byte(c_addr);
  2407. return c == ' ' || c == '\t' || c == '\r' || c == '\n';
  2408. }
  2409. static inline bool pgm_is_interpunction(const char *c_addr)
  2410. {
  2411. const char c = pgm_read_byte(c_addr);
  2412. return c == '.' || c == ',' || c == ':'|| c == ';' || c == '?' || c == '!' || c == '/';
  2413. }
  2414. /**
  2415. * @brief show full screen message
  2416. *
  2417. * This function is non-blocking
  2418. * @param msg message to be displayed from PROGMEM
  2419. * @param nlines
  2420. * @return rest of the text (to be displayed on next page)
  2421. */
  2422. static const char* lcd_display_message_fullscreen_nonBlocking_P(const char *msg, uint8_t &nlines)
  2423. {
  2424. lcd.setCursor(0, 0);
  2425. const char *msgend = msg;
  2426. uint8_t row = 0;
  2427. bool multi_screen = false;
  2428. for (; row < 4; ++ row) {
  2429. while (pgm_is_whitespace(msg))
  2430. ++ msg;
  2431. if (pgm_read_byte(msg) == 0)
  2432. // End of the message.
  2433. break;
  2434. lcd.setCursor(0, row);
  2435. uint8_t linelen = min(strlen_P(msg), 20);
  2436. const char *msgend2 = msg + linelen;
  2437. msgend = msgend2;
  2438. if (row == 3 && linelen == 20) {
  2439. // Last line of the display, full line shall be displayed.
  2440. // Find out, whether this message will be split into multiple screens.
  2441. while (pgm_is_whitespace(msgend))
  2442. ++ msgend;
  2443. multi_screen = pgm_read_byte(msgend) != 0;
  2444. if (multi_screen)
  2445. msgend = (msgend2 -= 2);
  2446. }
  2447. if (pgm_read_byte(msgend) != 0 && ! pgm_is_whitespace(msgend) && ! pgm_is_interpunction(msgend)) {
  2448. // Splitting a word. Find the start of the current word.
  2449. while (msgend > msg && ! pgm_is_whitespace(msgend - 1))
  2450. -- msgend;
  2451. if (msgend == msg)
  2452. // Found a single long word, which cannot be split. Just cut it.
  2453. msgend = msgend2;
  2454. }
  2455. for (; msg < msgend; ++ msg) {
  2456. char c = char(pgm_read_byte(msg));
  2457. if (c == '~')
  2458. c = ' ';
  2459. lcd.print(c);
  2460. }
  2461. }
  2462. if (multi_screen) {
  2463. // Display the "next screen" indicator character.
  2464. // lcd_set_custom_characters_arrows();
  2465. lcd_set_custom_characters_nextpage();
  2466. lcd.setCursor(19, 3);
  2467. // Display the down arrow.
  2468. lcd.print(char(1));
  2469. }
  2470. nlines = row;
  2471. return multi_screen ? msgend : NULL;
  2472. }
  2473. const char* lcd_display_message_fullscreen_P(const char *msg, uint8_t &nlines)
  2474. {
  2475. // Disable update of the screen by the usual lcd_update() routine.
  2476. lcd_update_enable(false);
  2477. lcd_implementation_clear();
  2478. return lcd_display_message_fullscreen_nonBlocking_P(msg, nlines);
  2479. }
  2480. /**
  2481. * @brief show full screen message and wait
  2482. *
  2483. * This function is blocking.
  2484. * @param msg message to be displayed from PROGMEM
  2485. */
  2486. void lcd_show_fullscreen_message_and_wait_P(const char *msg)
  2487. {
  2488. const char *msg_next = lcd_display_message_fullscreen_P(msg);
  2489. bool multi_screen = msg_next != NULL;
  2490. lcd_set_custom_characters_nextpage();
  2491. KEEPALIVE_STATE(PAUSED_FOR_USER);
  2492. // Until confirmed by a button click.
  2493. for (;;) {
  2494. if (!multi_screen) {
  2495. lcd.setCursor(19, 3);
  2496. // Display the confirm char.
  2497. lcd.print(char(2));
  2498. }
  2499. // Wait for 5 seconds before displaying the next text.
  2500. for (uint8_t i = 0; i < 100; ++ i) {
  2501. delay_keep_alive(50);
  2502. if (lcd_clicked()) {
  2503. while (lcd_clicked()) ;
  2504. delay(10);
  2505. while (lcd_clicked()) ;
  2506. if (msg_next == NULL) {
  2507. KEEPALIVE_STATE(IN_HANDLER);
  2508. lcd_set_custom_characters();
  2509. lcd_update_enable(true);
  2510. lcd_update(2);
  2511. return;
  2512. }
  2513. else {
  2514. break;
  2515. }
  2516. }
  2517. }
  2518. if (multi_screen) {
  2519. if (msg_next == NULL)
  2520. msg_next = msg;
  2521. msg_next = lcd_display_message_fullscreen_P(msg_next);
  2522. if (msg_next == NULL) {
  2523. lcd.setCursor(19, 3);
  2524. // Display the confirm char.
  2525. lcd.print(char(2));
  2526. }
  2527. }
  2528. }
  2529. }
  2530. void lcd_wait_for_click()
  2531. {
  2532. KEEPALIVE_STATE(PAUSED_FOR_USER);
  2533. for (;;) {
  2534. manage_heater();
  2535. manage_inactivity(true);
  2536. if (lcd_clicked()) {
  2537. while (lcd_clicked()) ;
  2538. delay(10);
  2539. while (lcd_clicked()) ;
  2540. KEEPALIVE_STATE(IN_HANDLER);
  2541. return;
  2542. }
  2543. }
  2544. }
  2545. int8_t lcd_show_multiscreen_message_yes_no_and_wait_P(const char *msg, bool allow_timeouting, bool default_yes) //currently just max. n*4 + 3 lines supported (set in language header files)
  2546. {
  2547. const char *msg_next = lcd_display_message_fullscreen_P(msg);
  2548. bool multi_screen = msg_next != NULL;
  2549. bool yes = default_yes ? true : false;
  2550. // Wait for user confirmation or a timeout.
  2551. unsigned long previous_millis_cmd = millis();
  2552. int8_t enc_dif = encoderDiff;
  2553. //KEEPALIVE_STATE(PAUSED_FOR_USER);
  2554. for (;;) {
  2555. for (uint8_t i = 0; i < 100; ++i) {
  2556. delay_keep_alive(50);
  2557. if (allow_timeouting && millis() - previous_millis_cmd > LCD_TIMEOUT_TO_STATUS)
  2558. return -1;
  2559. manage_heater();
  2560. manage_inactivity(true);
  2561. if (abs(enc_dif - encoderDiff) > 4) {
  2562. if (msg_next == NULL) {
  2563. lcd.setCursor(0, 3);
  2564. if (enc_dif < encoderDiff && yes) {
  2565. lcd_printPGM((PSTR(" ")));
  2566. lcd.setCursor(7, 3);
  2567. lcd_printPGM((PSTR(">")));
  2568. yes = false;
  2569. }
  2570. else if (enc_dif > encoderDiff && !yes) {
  2571. lcd_printPGM((PSTR(">")));
  2572. lcd.setCursor(7, 3);
  2573. lcd_printPGM((PSTR(" ")));
  2574. yes = true;
  2575. }
  2576. enc_dif = encoderDiff;
  2577. }
  2578. else {
  2579. break; //turning knob skips waiting loop
  2580. }
  2581. }
  2582. if (lcd_clicked()) {
  2583. while (lcd_clicked());
  2584. delay(10);
  2585. while (lcd_clicked());
  2586. if (msg_next == NULL) {
  2587. //KEEPALIVE_STATE(IN_HANDLER);
  2588. lcd_set_custom_characters();
  2589. return yes;
  2590. }
  2591. else break;
  2592. }
  2593. }
  2594. if (multi_screen) {
  2595. if (msg_next == NULL) {
  2596. msg_next = msg;
  2597. }
  2598. msg_next = lcd_display_message_fullscreen_P(msg_next);
  2599. }
  2600. if (msg_next == NULL) {
  2601. lcd.setCursor(0, 3);
  2602. if (yes) lcd_printPGM(PSTR(">"));
  2603. lcd.setCursor(1, 3);
  2604. lcd_printPGM(MSG_YES);
  2605. lcd.setCursor(7, 3);
  2606. if (!yes) lcd_printPGM(PSTR(">"));
  2607. lcd.setCursor(8, 3);
  2608. lcd_printPGM(MSG_NO);
  2609. }
  2610. }
  2611. }
  2612. int8_t lcd_show_fullscreen_message_yes_no_and_wait_P(const char *msg, bool allow_timeouting, bool default_yes)
  2613. {
  2614. lcd_display_message_fullscreen_P(msg);
  2615. if (default_yes) {
  2616. lcd.setCursor(0, 2);
  2617. lcd_printPGM(PSTR(">"));
  2618. lcd_printPGM(MSG_YES);
  2619. lcd.setCursor(1, 3);
  2620. lcd_printPGM(MSG_NO);
  2621. }
  2622. else {
  2623. lcd.setCursor(1, 2);
  2624. lcd_printPGM(MSG_YES);
  2625. lcd.setCursor(0, 3);
  2626. lcd_printPGM(PSTR(">"));
  2627. lcd_printPGM(MSG_NO);
  2628. }
  2629. bool yes = default_yes ? true : false;
  2630. // Wait for user confirmation or a timeout.
  2631. unsigned long previous_millis_cmd = millis();
  2632. int8_t enc_dif = encoderDiff;
  2633. KEEPALIVE_STATE(PAUSED_FOR_USER);
  2634. for (;;) {
  2635. if (allow_timeouting && millis() - previous_millis_cmd > LCD_TIMEOUT_TO_STATUS)
  2636. return -1;
  2637. manage_heater();
  2638. manage_inactivity(true);
  2639. if (abs(enc_dif - encoderDiff) > 4) {
  2640. lcd.setCursor(0, 2);
  2641. if (enc_dif < encoderDiff && yes) {
  2642. lcd_printPGM((PSTR(" ")));
  2643. lcd.setCursor(0, 3);
  2644. lcd_printPGM((PSTR(">")));
  2645. yes = false;
  2646. }
  2647. else if (enc_dif > encoderDiff && !yes) {
  2648. lcd_printPGM((PSTR(">")));
  2649. lcd.setCursor(0, 3);
  2650. lcd_printPGM((PSTR(" ")));
  2651. yes = true;
  2652. }
  2653. enc_dif = encoderDiff;
  2654. }
  2655. if (lcd_clicked()) {
  2656. while (lcd_clicked());
  2657. delay(10);
  2658. while (lcd_clicked());
  2659. KEEPALIVE_STATE(IN_HANDLER);
  2660. return yes;
  2661. }
  2662. }
  2663. }
  2664. void lcd_bed_calibration_show_result(BedSkewOffsetDetectionResultType result, uint8_t point_too_far_mask)
  2665. {
  2666. const char *msg = NULL;
  2667. if (result == BED_SKEW_OFFSET_DETECTION_POINT_NOT_FOUND) {
  2668. lcd_show_fullscreen_message_and_wait_P(MSG_BED_SKEW_OFFSET_DETECTION_POINT_NOT_FOUND);
  2669. } else if (result == BED_SKEW_OFFSET_DETECTION_FITTING_FAILED) {
  2670. if (point_too_far_mask == 0)
  2671. msg = MSG_BED_SKEW_OFFSET_DETECTION_FITTING_FAILED;
  2672. else if (point_too_far_mask == 2 || point_too_far_mask == 7)
  2673. // Only the center point or all the three front points.
  2674. msg = MSG_BED_SKEW_OFFSET_DETECTION_FAILED_FRONT_BOTH_FAR;
  2675. else if (point_too_far_mask & 1 == 0)
  2676. // The right and maybe the center point out of reach.
  2677. msg = MSG_BED_SKEW_OFFSET_DETECTION_FAILED_FRONT_RIGHT_FAR;
  2678. else
  2679. // The left and maybe the center point out of reach.
  2680. msg = MSG_BED_SKEW_OFFSET_DETECTION_FAILED_FRONT_LEFT_FAR;
  2681. lcd_show_fullscreen_message_and_wait_P(msg);
  2682. } else {
  2683. if (point_too_far_mask != 0) {
  2684. if (point_too_far_mask == 2 || point_too_far_mask == 7)
  2685. // Only the center point or all the three front points.
  2686. msg = MSG_BED_SKEW_OFFSET_DETECTION_WARNING_FRONT_BOTH_FAR;
  2687. else if (point_too_far_mask & 1 == 0)
  2688. // The right and maybe the center point out of reach.
  2689. msg = MSG_BED_SKEW_OFFSET_DETECTION_WARNING_FRONT_RIGHT_FAR;
  2690. else
  2691. // The left and maybe the center point out of reach.
  2692. msg = MSG_BED_SKEW_OFFSET_DETECTION_WARNING_FRONT_LEFT_FAR;
  2693. lcd_show_fullscreen_message_and_wait_P(msg);
  2694. }
  2695. if (point_too_far_mask == 0 || result > 0) {
  2696. switch (result) {
  2697. default:
  2698. // should not happen
  2699. msg = MSG_BED_SKEW_OFFSET_DETECTION_FITTING_FAILED;
  2700. break;
  2701. case BED_SKEW_OFFSET_DETECTION_PERFECT:
  2702. msg = MSG_BED_SKEW_OFFSET_DETECTION_PERFECT;
  2703. break;
  2704. case BED_SKEW_OFFSET_DETECTION_SKEW_MILD:
  2705. msg = MSG_BED_SKEW_OFFSET_DETECTION_SKEW_MILD;
  2706. break;
  2707. case BED_SKEW_OFFSET_DETECTION_SKEW_EXTREME:
  2708. msg = MSG_BED_SKEW_OFFSET_DETECTION_SKEW_EXTREME;
  2709. break;
  2710. }
  2711. lcd_show_fullscreen_message_and_wait_P(msg);
  2712. }
  2713. }
  2714. }
  2715. void lcd_temp_cal_show_result(bool result) {
  2716. custom_message_type = 0;
  2717. custom_message = false;
  2718. disable_x();
  2719. disable_y();
  2720. disable_z();
  2721. disable_e0();
  2722. disable_e1();
  2723. disable_e2();
  2724. setTargetBed(0); //set bed target temperature back to 0
  2725. if (result == true) {
  2726. eeprom_update_byte((uint8_t*)EEPROM_CALIBRATION_STATUS_PINDA, 1);
  2727. SERIAL_ECHOLNPGM("Temperature calibration done. Continue with pressing the knob.");
  2728. lcd_show_fullscreen_message_and_wait_P(MSG_TEMP_CALIBRATION_DONE);
  2729. temp_cal_active = true;
  2730. eeprom_update_byte((unsigned char *)EEPROM_TEMP_CAL_ACTIVE, 1);
  2731. }
  2732. else {
  2733. eeprom_update_byte((uint8_t*)EEPROM_CALIBRATION_STATUS_PINDA, 0);
  2734. SERIAL_ECHOLNPGM("Temperature calibration failed. Continue with pressing the knob.");
  2735. lcd_show_fullscreen_message_and_wait_P(MSG_TEMP_CAL_FAILED);
  2736. temp_cal_active = false;
  2737. eeprom_update_byte((unsigned char *)EEPROM_TEMP_CAL_ACTIVE, 0);
  2738. }
  2739. lcd_update_enable(true);
  2740. lcd_update(2);
  2741. }
  2742. static void lcd_show_end_stops() {
  2743. lcd.setCursor(0, 0);
  2744. lcd_printPGM((PSTR("End stops diag")));
  2745. lcd.setCursor(0, 1);
  2746. lcd_printPGM((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING == 1) ? (PSTR("X1")) : (PSTR("X0")));
  2747. lcd.setCursor(0, 2);
  2748. lcd_printPGM((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING == 1) ? (PSTR("Y1")) : (PSTR("Y0")));
  2749. lcd.setCursor(0, 3);
  2750. lcd_printPGM((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING == 1) ? (PSTR("Z1")) : (PSTR("Z0")));
  2751. }
  2752. static void menu_show_end_stops() {
  2753. lcd_show_end_stops();
  2754. if (LCD_CLICKED) menu_action_back();
  2755. }
  2756. // Lets the user move the Z carriage up to the end stoppers.
  2757. // When done, it sets the current Z to Z_MAX_POS and returns true.
  2758. // Otherwise the Z calibration is not changed and false is returned.
  2759. void lcd_diag_show_end_stops()
  2760. {
  2761. int enc_dif = encoderDiff;
  2762. lcd_implementation_clear();
  2763. for (;;) {
  2764. manage_heater();
  2765. manage_inactivity(true);
  2766. lcd_show_end_stops();
  2767. if (lcd_clicked()) {
  2768. while (lcd_clicked()) ;
  2769. delay(10);
  2770. while (lcd_clicked()) ;
  2771. break;
  2772. }
  2773. }
  2774. lcd_implementation_clear();
  2775. lcd_return_to_status();
  2776. }
  2777. void prusa_statistics(int _message, uint8_t _fil_nr) {
  2778. #ifdef DEBUG_DISABLE_PRUSA_STATISTICS
  2779. return;
  2780. #endif //DEBUG_DISABLE_PRUSA_STATISTICS
  2781. switch (_message)
  2782. {
  2783. case 0: // default message
  2784. if (IS_SD_PRINTING)
  2785. {
  2786. SERIAL_ECHO("{");
  2787. prusa_stat_printerstatus(4);
  2788. prusa_stat_farm_number();
  2789. prusa_stat_printinfo();
  2790. SERIAL_ECHOLN("}");
  2791. status_number = 4;
  2792. }
  2793. else
  2794. {
  2795. SERIAL_ECHO("{");
  2796. prusa_stat_printerstatus(1);
  2797. prusa_stat_farm_number();
  2798. SERIAL_ECHOLN("}");
  2799. status_number = 1;
  2800. }
  2801. break;
  2802. case 1: // 1 heating
  2803. farm_status = 2;
  2804. SERIAL_ECHO("{");
  2805. prusa_stat_printerstatus(2);
  2806. prusa_stat_farm_number();
  2807. SERIAL_ECHOLN("}");
  2808. status_number = 2;
  2809. farm_timer = 1;
  2810. break;
  2811. case 2: // heating done
  2812. farm_status = 3;
  2813. SERIAL_ECHO("{");
  2814. prusa_stat_printerstatus(3);
  2815. prusa_stat_farm_number();
  2816. SERIAL_ECHOLN("}");
  2817. status_number = 3;
  2818. farm_timer = 1;
  2819. if (IS_SD_PRINTING)
  2820. {
  2821. farm_status = 4;
  2822. SERIAL_ECHO("{");
  2823. prusa_stat_printerstatus(4);
  2824. prusa_stat_farm_number();
  2825. SERIAL_ECHOLN("}");
  2826. status_number = 4;
  2827. }
  2828. else
  2829. {
  2830. SERIAL_ECHO("{");
  2831. prusa_stat_printerstatus(3);
  2832. prusa_stat_farm_number();
  2833. SERIAL_ECHOLN("}");
  2834. status_number = 3;
  2835. }
  2836. farm_timer = 1;
  2837. break;
  2838. case 3: // filament change
  2839. break;
  2840. case 4: // print succesfull
  2841. SERIAL_ECHO("{[RES:1][FIL:");
  2842. MYSERIAL.print(int(_fil_nr));
  2843. SERIAL_ECHO("]");
  2844. prusa_stat_printerstatus(status_number);
  2845. prusa_stat_farm_number();
  2846. SERIAL_ECHOLN("}");
  2847. farm_timer = 2;
  2848. break;
  2849. case 5: // print not succesfull
  2850. SERIAL_ECHO("{[RES:0][FIL:");
  2851. MYSERIAL.print(int(_fil_nr));
  2852. SERIAL_ECHO("]");
  2853. prusa_stat_printerstatus(status_number);
  2854. prusa_stat_farm_number();
  2855. SERIAL_ECHOLN("}");
  2856. farm_timer = 2;
  2857. break;
  2858. case 6: // print done
  2859. SERIAL_ECHO("{[PRN:8]");
  2860. prusa_stat_farm_number();
  2861. SERIAL_ECHOLN("}");
  2862. status_number = 8;
  2863. farm_timer = 2;
  2864. break;
  2865. case 7: // print done - stopped
  2866. SERIAL_ECHO("{[PRN:9]");
  2867. prusa_stat_farm_number();
  2868. SERIAL_ECHOLN("}");
  2869. status_number = 9;
  2870. farm_timer = 2;
  2871. break;
  2872. case 8: // printer started
  2873. SERIAL_ECHO("{[PRN:0][PFN:");
  2874. status_number = 0;
  2875. SERIAL_ECHO(farm_no);
  2876. SERIAL_ECHOLN("]}");
  2877. farm_timer = 2;
  2878. break;
  2879. case 20: // echo farm no
  2880. SERIAL_ECHO("{");
  2881. prusa_stat_printerstatus(status_number);
  2882. prusa_stat_farm_number();
  2883. SERIAL_ECHOLN("}");
  2884. farm_timer = 4;
  2885. break;
  2886. case 21: // temperatures
  2887. SERIAL_ECHO("{");
  2888. prusa_stat_temperatures();
  2889. prusa_stat_farm_number();
  2890. prusa_stat_printerstatus(status_number);
  2891. SERIAL_ECHOLN("}");
  2892. break;
  2893. case 22: // waiting for filament change
  2894. SERIAL_ECHO("{[PRN:5]");
  2895. prusa_stat_farm_number();
  2896. SERIAL_ECHOLN("}");
  2897. status_number = 5;
  2898. break;
  2899. case 90: // Error - Thermal Runaway
  2900. SERIAL_ECHO("{[ERR:1]");
  2901. prusa_stat_farm_number();
  2902. SERIAL_ECHOLN("}");
  2903. break;
  2904. case 91: // Error - Thermal Runaway Preheat
  2905. SERIAL_ECHO("{[ERR:2]");
  2906. prusa_stat_farm_number();
  2907. SERIAL_ECHOLN("}");
  2908. break;
  2909. case 92: // Error - Min temp
  2910. SERIAL_ECHO("{[ERR:3]");
  2911. prusa_stat_farm_number();
  2912. SERIAL_ECHOLN("}");
  2913. break;
  2914. case 93: // Error - Max temp
  2915. SERIAL_ECHO("{[ERR:4]");
  2916. prusa_stat_farm_number();
  2917. SERIAL_ECHOLN("}");
  2918. break;
  2919. case 99: // heartbeat
  2920. SERIAL_ECHO("{[PRN:99]");
  2921. prusa_stat_temperatures();
  2922. SERIAL_ECHO("[PFN:");
  2923. SERIAL_ECHO(farm_no);
  2924. SERIAL_ECHO("]");
  2925. SERIAL_ECHOLN("}");
  2926. break;
  2927. }
  2928. }
  2929. static void prusa_stat_printerstatus(int _status)
  2930. {
  2931. SERIAL_ECHO("[PRN:");
  2932. SERIAL_ECHO(_status);
  2933. SERIAL_ECHO("]");
  2934. }
  2935. static void prusa_stat_farm_number() {
  2936. SERIAL_ECHO("[PFN:");
  2937. SERIAL_ECHO(farm_no);
  2938. SERIAL_ECHO("]");
  2939. }
  2940. static void prusa_stat_temperatures()
  2941. {
  2942. SERIAL_ECHO("[ST0:");
  2943. SERIAL_ECHO(target_temperature[0]);
  2944. SERIAL_ECHO("][STB:");
  2945. SERIAL_ECHO(target_temperature_bed);
  2946. SERIAL_ECHO("][AT0:");
  2947. SERIAL_ECHO(current_temperature[0]);
  2948. SERIAL_ECHO("][ATB:");
  2949. SERIAL_ECHO(current_temperature_bed);
  2950. SERIAL_ECHO("]");
  2951. }
  2952. static void prusa_stat_printinfo()
  2953. {
  2954. SERIAL_ECHO("[TFU:");
  2955. SERIAL_ECHO(total_filament_used);
  2956. SERIAL_ECHO("][PCD:");
  2957. SERIAL_ECHO(itostr3(card.percentDone()));
  2958. SERIAL_ECHO("][FEM:");
  2959. SERIAL_ECHO(itostr3(feedmultiply));
  2960. SERIAL_ECHO("][FNM:");
  2961. SERIAL_ECHO(longFilenameOLD);
  2962. SERIAL_ECHO("][TIM:");
  2963. if (starttime != 0)
  2964. {
  2965. SERIAL_ECHO(millis() / 1000 - starttime / 1000);
  2966. }
  2967. else
  2968. {
  2969. SERIAL_ECHO(0);
  2970. }
  2971. SERIAL_ECHO("][FWR:");
  2972. SERIAL_ECHO(FW_VERSION);
  2973. SERIAL_ECHO("]");
  2974. }
  2975. /*
  2976. void lcd_pick_babystep(){
  2977. int enc_dif = 0;
  2978. int cursor_pos = 1;
  2979. int fsm = 0;
  2980. lcd_implementation_clear();
  2981. lcd.setCursor(0, 0);
  2982. lcd_printPGM(MSG_PICK_Z);
  2983. lcd.setCursor(3, 2);
  2984. lcd.print("1");
  2985. lcd.setCursor(3, 3);
  2986. lcd.print("2");
  2987. lcd.setCursor(12, 2);
  2988. lcd.print("3");
  2989. lcd.setCursor(12, 3);
  2990. lcd.print("4");
  2991. lcd.setCursor(1, 2);
  2992. lcd.print(">");
  2993. enc_dif = encoderDiff;
  2994. while (fsm == 0) {
  2995. manage_heater();
  2996. manage_inactivity(true);
  2997. if ( abs((enc_dif - encoderDiff)) > 4 ) {
  2998. if ( (abs(enc_dif - encoderDiff)) > 1 ) {
  2999. if (enc_dif > encoderDiff ) {
  3000. cursor_pos --;
  3001. }
  3002. if (enc_dif < encoderDiff ) {
  3003. cursor_pos ++;
  3004. }
  3005. if (cursor_pos > 4) {
  3006. cursor_pos = 4;
  3007. }
  3008. if (cursor_pos < 1) {
  3009. cursor_pos = 1;
  3010. }
  3011. lcd.setCursor(1, 2);
  3012. lcd.print(" ");
  3013. lcd.setCursor(1, 3);
  3014. lcd.print(" ");
  3015. lcd.setCursor(10, 2);
  3016. lcd.print(" ");
  3017. lcd.setCursor(10, 3);
  3018. lcd.print(" ");
  3019. if (cursor_pos < 3) {
  3020. lcd.setCursor(1, cursor_pos+1);
  3021. lcd.print(">");
  3022. }else{
  3023. lcd.setCursor(10, cursor_pos-1);
  3024. lcd.print(">");
  3025. }
  3026. enc_dif = encoderDiff;
  3027. delay(100);
  3028. }
  3029. }
  3030. if (lcd_clicked()) {
  3031. fsm = cursor_pos;
  3032. int babyStepZ;
  3033. EEPROM_read_B(EEPROM_BABYSTEP_Z0+((fsm-1)*2),&babyStepZ);
  3034. EEPROM_save_B(EEPROM_BABYSTEP_Z,&babyStepZ);
  3035. calibration_status_store(CALIBRATION_STATUS_CALIBRATED);
  3036. delay(500);
  3037. }
  3038. };
  3039. lcd_implementation_clear();
  3040. lcd_return_to_status();
  3041. }
  3042. */
  3043. void lcd_move_menu_axis()
  3044. {
  3045. START_MENU();
  3046. MENU_ITEM(back, MSG_SETTINGS, 0);
  3047. MENU_ITEM(submenu, MSG_MOVE_X, lcd_move_x);
  3048. MENU_ITEM(submenu, MSG_MOVE_Y, lcd_move_y);
  3049. MENU_ITEM(submenu, MSG_MOVE_Z, lcd_move_z);
  3050. MENU_ITEM(submenu, MSG_MOVE_E, lcd_move_e);
  3051. END_MENU();
  3052. }
  3053. static void lcd_move_menu_1mm()
  3054. {
  3055. move_menu_scale = 1.0;
  3056. lcd_move_menu_axis();
  3057. }
  3058. void EEPROM_save(int pos, uint8_t* value, uint8_t size)
  3059. {
  3060. do
  3061. {
  3062. eeprom_write_byte((unsigned char*)pos, *value);
  3063. pos++;
  3064. value++;
  3065. } while (--size);
  3066. }
  3067. void EEPROM_read(int pos, uint8_t* value, uint8_t size)
  3068. {
  3069. do
  3070. {
  3071. *value = eeprom_read_byte((unsigned char*)pos);
  3072. pos++;
  3073. value++;
  3074. } while (--size);
  3075. }
  3076. #ifdef SDCARD_SORT_ALPHA
  3077. static void lcd_sort_type_set() {
  3078. uint8_t sdSort;
  3079. EEPROM_read(EEPROM_SD_SORT, (uint8_t*)&sdSort, sizeof(sdSort));
  3080. switch (sdSort) {
  3081. case SD_SORT_TIME: sdSort = SD_SORT_ALPHA; break;
  3082. case SD_SORT_ALPHA: sdSort = SD_SORT_NONE; break;
  3083. default: sdSort = SD_SORT_TIME;
  3084. }
  3085. eeprom_update_byte((unsigned char *)EEPROM_SD_SORT, sdSort);
  3086. presort_flag = true;
  3087. lcd_goto_menu(lcd_settings_menu); //doesn't break menuStack
  3088. }
  3089. #endif //SDCARD_SORT_ALPHA
  3090. #ifdef TMC2130
  3091. static void lcd_crash_mode_info()
  3092. {
  3093. lcd_update_enable(true);
  3094. static uint32_t tim = 0;
  3095. if ((tim + 1000) < millis())
  3096. {
  3097. fputs_P(MSG_CRASH_DET_ONLY_IN_NORMAL, lcdout);
  3098. tim = millis();
  3099. }
  3100. if (lcd_clicked())
  3101. menu_action_back();
  3102. }
  3103. static void lcd_crash_mode_info2()
  3104. {
  3105. lcd_update_enable(true);
  3106. static uint32_t tim = 0;
  3107. if ((tim + 1000) < millis())
  3108. {
  3109. fputs_P(MSG_CRASH_DET_STEALTH_FORCE_OFF, lcdout);
  3110. tim = millis();
  3111. }
  3112. if (lcd_clicked())
  3113. menu_action_back();
  3114. }
  3115. #endif //TMC2130
  3116. #ifdef PAT9125
  3117. static void lcd_filament_autoload_info()
  3118. {
  3119. lcd_show_fullscreen_message_and_wait_P(MSG_AUTOLOADING_ONLY_IF_FSENS_ON);
  3120. }
  3121. static void lcd_fsensor_fail()
  3122. {
  3123. lcd_show_fullscreen_message_and_wait_P(MSG_FSENS_NOT_RESPONDING);
  3124. }
  3125. #endif //PAT9125
  3126. static void lcd_silent_mode_set() {
  3127. switch (SilentModeMenu) {
  3128. #ifdef TMC2130
  3129. case SILENT_MODE_NORMAL: SilentModeMenu = SILENT_MODE_STEALTH; break;
  3130. case SILENT_MODE_STEALTH: SilentModeMenu = SILENT_MODE_NORMAL; break;
  3131. default: SilentModeMenu = SILENT_MODE_NORMAL; break; // (probably) not needed
  3132. #else
  3133. case SILENT_MODE_POWER: SilentModeMenu = SILENT_MODE_SILENT; break;
  3134. case SILENT_MODE_SILENT: SilentModeMenu = SILENT_MODE_AUTO; break;
  3135. case SILENT_MODE_AUTO: SilentModeMenu = SILENT_MODE_POWER; break;
  3136. default: SilentModeMenu = SILENT_MODE_POWER; break; // (probably) not needed
  3137. #endif //TMC2130
  3138. }
  3139. eeprom_update_byte((unsigned char *)EEPROM_SILENT, SilentModeMenu);
  3140. #ifdef TMC2130
  3141. // Wait until the planner queue is drained and the stepper routine achieves
  3142. // an idle state.
  3143. st_synchronize();
  3144. if (tmc2130_wait_standstill_xy(1000)) {}
  3145. // MYSERIAL.print("standstill OK");
  3146. // else
  3147. // MYSERIAL.print("standstill NG!");
  3148. cli();
  3149. tmc2130_mode = (SilentModeMenu != SILENT_MODE_NORMAL)?TMC2130_MODE_SILENT:TMC2130_MODE_NORMAL;
  3150. tmc2130_init();
  3151. // We may have missed a stepper timer interrupt due to the time spent in tmc2130_init.
  3152. // Be safe than sorry, reset the stepper timer before re-enabling interrupts.
  3153. st_reset_timer();
  3154. sei();
  3155. #endif //TMC2130
  3156. st_current_init();
  3157. #ifdef TMC2130
  3158. if (CrashDetectMenu && (SilentModeMenu != SILENT_MODE_NORMAL))
  3159. menu_action_submenu(lcd_crash_mode_info2);
  3160. #endif //TMC2130
  3161. }
  3162. #ifdef TMC2130
  3163. static void lcd_crash_mode_set()
  3164. {
  3165. CrashDetectMenu = !CrashDetectMenu; //set also from crashdet_enable() and crashdet_disable()
  3166. if (CrashDetectMenu==0) {
  3167. crashdet_disable();
  3168. }else{
  3169. crashdet_enable();
  3170. }
  3171. if (IS_SD_PRINTING || is_usb_printing || (lcd_commands_type == LCD_COMMAND_V2_CAL)) lcd_goto_menu(lcd_tune_menu, 9);
  3172. else lcd_goto_menu(lcd_settings_menu, 9);
  3173. }
  3174. #endif //TMC2130
  3175. static void lcd_set_lang(unsigned char lang) {
  3176. lang_selected = lang;
  3177. firstrun = 1;
  3178. eeprom_update_byte((unsigned char *)EEPROM_LANG, lang);
  3179. /*langsel=0;*/
  3180. if (langsel == LANGSEL_MODAL)
  3181. // From modal mode to an active mode? This forces the menu to return to the setup menu.
  3182. langsel = LANGSEL_ACTIVE;
  3183. }
  3184. #ifdef PAT9125
  3185. static void lcd_fsensor_state_set()
  3186. {
  3187. FSensorStateMenu = !FSensorStateMenu; //set also from fsensor_enable() and fsensor_disable()
  3188. if (FSensorStateMenu==0) {
  3189. fsensor_disable();
  3190. if ((filament_autoload_enabled == true)){
  3191. lcd_filament_autoload_info();
  3192. }
  3193. }else{
  3194. fsensor_enable();
  3195. if (fsensor_not_responding)
  3196. {
  3197. lcd_fsensor_fail();
  3198. }
  3199. }
  3200. if (IS_SD_PRINTING || is_usb_printing || (lcd_commands_type == LCD_COMMAND_V2_CAL)) lcd_goto_menu(lcd_tune_menu);
  3201. else lcd_goto_menu(lcd_settings_menu); //doesn't break menuStack
  3202. }
  3203. #endif //PAT9125
  3204. #if !SDSORT_USES_RAM
  3205. void lcd_set_degree() {
  3206. lcd_set_custom_characters_degree();
  3207. }
  3208. void lcd_set_progress() {
  3209. lcd_set_custom_characters_progress();
  3210. }
  3211. #endif
  3212. void lcd_force_language_selection() {
  3213. eeprom_update_byte((unsigned char *)EEPROM_LANG, LANG_ID_FORCE_SELECTION);
  3214. }
  3215. static void lcd_language_menu()
  3216. {
  3217. START_MENU();
  3218. if (langsel == LANGSEL_OFF) {
  3219. MENU_ITEM(back, MSG_SETTINGS, 0);
  3220. } else if (langsel == LANGSEL_ACTIVE) {
  3221. MENU_ITEM(back, MSG_WATCH, 0);
  3222. }
  3223. for (int i=0;i<LANG_NUM;i++){
  3224. MENU_ITEM(setlang, MSG_LANGUAGE_NAME_EXPLICIT(i), i);
  3225. }
  3226. END_MENU();
  3227. }
  3228. void lcd_mesh_bedleveling()
  3229. {
  3230. mesh_bed_run_from_menu = true;
  3231. enquecommand_P(PSTR("G80"));
  3232. lcd_return_to_status();
  3233. }
  3234. void lcd_mesh_calibration()
  3235. {
  3236. enquecommand_P(PSTR("M45"));
  3237. lcd_return_to_status();
  3238. }
  3239. void lcd_mesh_calibration_z()
  3240. {
  3241. enquecommand_P(PSTR("M45 Z"));
  3242. lcd_return_to_status();
  3243. }
  3244. void lcd_pinda_calibration_menu()
  3245. {
  3246. START_MENU();
  3247. MENU_ITEM(back, MSG_MENU_CALIBRATION, 0);
  3248. MENU_ITEM(submenu, MSG_CALIBRATE_PINDA, lcd_calibrate_pinda);
  3249. END_MENU();
  3250. }
  3251. void lcd_temp_calibration_set() {
  3252. temp_cal_active = !temp_cal_active;
  3253. eeprom_update_byte((unsigned char *)EEPROM_TEMP_CAL_ACTIVE, temp_cal_active);
  3254. st_current_init();
  3255. lcd_goto_menu(lcd_settings_menu); //doesn't break menuStack
  3256. }
  3257. #ifdef HAS_SECOND_SERIAL_PORT
  3258. void lcd_second_serial_set() {
  3259. if(selectedSerialPort == 1) selectedSerialPort = 0;
  3260. else selectedSerialPort = 1;
  3261. eeprom_update_byte((unsigned char *)EEPROM_SECOND_SERIAL_ACTIVE, selectedSerialPort);
  3262. MYSERIAL.begin(BAUDRATE);
  3263. lcd_goto_menu(lcd_settings_menu);//doesn't break menuStack
  3264. }
  3265. #endif //HAS_SECOND_SERIAL_PORT
  3266. void lcd_calibrate_pinda() {
  3267. enquecommand_P(PSTR("G76"));
  3268. lcd_return_to_status();
  3269. }
  3270. #ifndef SNMM
  3271. /*void lcd_calibrate_extruder() {
  3272. if (degHotend0() > EXTRUDE_MINTEMP)
  3273. {
  3274. current_position[E_AXIS] = 0; //set initial position to zero
  3275. plan_set_e_position(current_position[E_AXIS]);
  3276. //long steps_start = st_get_position(E_AXIS);
  3277. long steps_final;
  3278. float e_steps_per_unit;
  3279. float feedrate = (180 / axis_steps_per_unit[E_AXIS]) * 1; //3 //initial automatic extrusion feedrate (depends on current value of axis_steps_per_unit to avoid too fast extrusion)
  3280. float e_shift_calibration = (axis_steps_per_unit[E_AXIS] > 180 ) ? ((180 / axis_steps_per_unit[E_AXIS]) * 70): 70; //length of initial automatic extrusion sequence
  3281. const char *msg_e_cal_knob = MSG_E_CAL_KNOB;
  3282. const char *msg_next_e_cal_knob = lcd_display_message_fullscreen_P(msg_e_cal_knob);
  3283. const bool multi_screen = msg_next_e_cal_knob != NULL;
  3284. unsigned long msg_millis;
  3285. lcd_show_fullscreen_message_and_wait_P(MSG_MARK_FIL);
  3286. lcd_implementation_clear();
  3287. lcd.setCursor(0, 1); lcd_printPGM(MSG_PLEASE_WAIT);
  3288. current_position[E_AXIS] += e_shift_calibration;
  3289. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], feedrate, active_extruder);
  3290. st_synchronize();
  3291. lcd_display_message_fullscreen_P(msg_e_cal_knob);
  3292. msg_millis = millis();
  3293. while (!LCD_CLICKED) {
  3294. if (multi_screen && millis() - msg_millis > 5000) {
  3295. if (msg_next_e_cal_knob == NULL)
  3296. msg_next_e_cal_knob = msg_e_cal_knob;
  3297. msg_next_e_cal_knob = lcd_display_message_fullscreen_P(msg_next_e_cal_knob);
  3298. msg_millis = millis();
  3299. }
  3300. //manage_inactivity(true);
  3301. manage_heater();
  3302. if (abs(encoderDiff) >= ENCODER_PULSES_PER_STEP) { //adjusting mark by knob rotation
  3303. delay_keep_alive(50);
  3304. //previous_millis_cmd = millis();
  3305. encoderPosition += (encoderDiff / ENCODER_PULSES_PER_STEP);
  3306. encoderDiff = 0;
  3307. if (!planner_queue_full()) {
  3308. current_position[E_AXIS] += float(abs((int)encoderPosition)) * 0.01; //0.05
  3309. encoderPosition = 0;
  3310. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], feedrate, active_extruder);
  3311. }
  3312. }
  3313. }
  3314. steps_final = current_position[E_AXIS] * axis_steps_per_unit[E_AXIS];
  3315. //steps_final = st_get_position(E_AXIS);
  3316. lcdDrawUpdate = 1;
  3317. e_steps_per_unit = ((float)(steps_final)) / 100.0f;
  3318. if (e_steps_per_unit < MIN_E_STEPS_PER_UNIT) e_steps_per_unit = MIN_E_STEPS_PER_UNIT;
  3319. if (e_steps_per_unit > MAX_E_STEPS_PER_UNIT) e_steps_per_unit = MAX_E_STEPS_PER_UNIT;
  3320. lcd_implementation_clear();
  3321. axis_steps_per_unit[E_AXIS] = e_steps_per_unit;
  3322. enquecommand_P(PSTR("M500")); //store settings to eeprom
  3323. //lcd_implementation_drawedit(PSTR("Result"), ftostr31(axis_steps_per_unit[E_AXIS]));
  3324. //delay_keep_alive(2000);
  3325. delay_keep_alive(500);
  3326. lcd_show_fullscreen_message_and_wait_P(MSG_CLEAN_NOZZLE_E);
  3327. lcd_update_enable(true);
  3328. lcdDrawUpdate = 2;
  3329. }
  3330. else
  3331. {
  3332. lcd_implementation_clear();
  3333. lcd.setCursor(0, 0);
  3334. lcd_printPGM(MSG_ERROR);
  3335. lcd.setCursor(0, 2);
  3336. lcd_printPGM(MSG_PREHEAT_NOZZLE);
  3337. delay(2000);
  3338. lcd_implementation_clear();
  3339. }
  3340. lcd_return_to_status();
  3341. }
  3342. void lcd_extr_cal_reset() {
  3343. float tmp1[] = DEFAULT_AXIS_STEPS_PER_UNIT;
  3344. axis_steps_per_unit[E_AXIS] = tmp1[3];
  3345. //extrudemultiply = 100;
  3346. enquecommand_P(PSTR("M500"));
  3347. }*/
  3348. #endif
  3349. void lcd_toshiba_flash_air_compatibility_toggle()
  3350. {
  3351. card.ToshibaFlashAir_enable(! card.ToshibaFlashAir_isEnabled());
  3352. eeprom_update_byte((uint8_t*)EEPROM_TOSHIBA_FLASH_AIR_COMPATIBLITY, card.ToshibaFlashAir_isEnabled());
  3353. }
  3354. void lcd_v2_calibration() {
  3355. bool loaded = lcd_show_fullscreen_message_yes_no_and_wait_P(MSG_PLA_FILAMENT_LOADED, false, true);
  3356. if (loaded) {
  3357. lcd_commands_type = LCD_COMMAND_V2_CAL;
  3358. }
  3359. else {
  3360. lcd_display_message_fullscreen_P(MSG_PLEASE_LOAD_PLA);
  3361. for (int i = 0; i < 20; i++) { //wait max. 2s
  3362. delay_keep_alive(100);
  3363. if (lcd_clicked()) {
  3364. while (lcd_clicked());
  3365. delay(10);
  3366. while (lcd_clicked());
  3367. break;
  3368. }
  3369. }
  3370. }
  3371. lcd_return_to_status();
  3372. lcd_update_enable(true);
  3373. }
  3374. void lcd_wizard() {
  3375. bool result = true;
  3376. if (calibration_status() != CALIBRATION_STATUS_ASSEMBLED) {
  3377. result = lcd_show_multiscreen_message_yes_no_and_wait_P(MSG_WIZARD_RERUN, false, false);
  3378. }
  3379. if (result) {
  3380. calibration_status_store(CALIBRATION_STATUS_ASSEMBLED);
  3381. lcd_wizard(0);
  3382. }
  3383. else {
  3384. lcd_return_to_status();
  3385. lcd_update_enable(true);
  3386. lcd_update(2);
  3387. }
  3388. }
  3389. void lcd_wizard(int state) {
  3390. bool end = false;
  3391. int wizard_event;
  3392. const char *msg = NULL;
  3393. while (!end) {
  3394. switch (state) {
  3395. case 0: // run wizard?
  3396. wizard_event = lcd_show_multiscreen_message_yes_no_and_wait_P(MSG_WIZARD_WELCOME, false, true);
  3397. if (wizard_event) {
  3398. state = 1;
  3399. eeprom_write_byte((uint8_t*)EEPROM_WIZARD_ACTIVE, 1);
  3400. }
  3401. else {
  3402. eeprom_write_byte((uint8_t*)EEPROM_WIZARD_ACTIVE, 0);
  3403. end = true;
  3404. }
  3405. break;
  3406. case 1: // restore calibration status
  3407. switch (calibration_status()) {
  3408. case CALIBRATION_STATUS_ASSEMBLED: state = 2; break; //run selftest
  3409. case CALIBRATION_STATUS_XYZ_CALIBRATION: state = 3; break; //run xyz cal.
  3410. case CALIBRATION_STATUS_Z_CALIBRATION: state = 4; break; //run z cal.
  3411. case CALIBRATION_STATUS_LIVE_ADJUST: state = 5; break; //run live adjust
  3412. case CALIBRATION_STATUS_CALIBRATED: end = true; eeprom_write_byte((uint8_t*)EEPROM_WIZARD_ACTIVE, 0); break;
  3413. default: state = 2; break; //if calibration status is unknown, run wizard from the beginning
  3414. }
  3415. break;
  3416. case 2: //selftest
  3417. lcd_show_fullscreen_message_and_wait_P(MSG_WIZARD_SELFTEST);
  3418. wizard_event = lcd_selftest();
  3419. if (wizard_event) {
  3420. calibration_status_store(CALIBRATION_STATUS_XYZ_CALIBRATION);
  3421. state = 3;
  3422. }
  3423. else end = true;
  3424. break;
  3425. case 3: //xyz cal.
  3426. lcd_show_fullscreen_message_and_wait_P(MSG_WIZARD_XYZ_CAL);
  3427. wizard_event = gcode_M45(false, 0);
  3428. if (wizard_event) state = 5;
  3429. else end = true;
  3430. break;
  3431. case 4: //z cal.
  3432. lcd_show_fullscreen_message_and_wait_P(MSG_WIZARD_Z_CAL);
  3433. wizard_event = lcd_show_fullscreen_message_yes_no_and_wait_P(MSG_STEEL_SHEET_CHECK, false, false);
  3434. if (!wizard_event) lcd_show_fullscreen_message_and_wait_P(MSG_PLACE_STEEL_SHEET);
  3435. wizard_event = gcode_M45(true, 0);
  3436. if (wizard_event) state = 11; //shipped, no need to set first layer, go to final message directly
  3437. else end = true;
  3438. break;
  3439. case 5: //is filament loaded?
  3440. //start to preheat nozzle and bed to save some time later
  3441. setTargetHotend(PLA_PREHEAT_HOTEND_TEMP, 0);
  3442. setTargetBed(PLA_PREHEAT_HPB_TEMP);
  3443. wizard_event = lcd_show_fullscreen_message_yes_no_and_wait_P(MSG_WIZARD_FILAMENT_LOADED, false);
  3444. if (wizard_event) state = 8;
  3445. else state = 6;
  3446. break;
  3447. case 6: //waiting for preheat nozzle for PLA;
  3448. #ifndef SNMM
  3449. lcd_display_message_fullscreen_P(MSG_WIZARD_WILL_PREHEAT);
  3450. current_position[Z_AXIS] = 100; //move in z axis to make space for loading filament
  3451. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], homing_feedrate[Z_AXIS] / 60, active_extruder);
  3452. delay_keep_alive(2000);
  3453. lcd_display_message_fullscreen_P(MSG_WIZARD_HEATING);
  3454. while (abs(degHotend(0) - PLA_PREHEAT_HOTEND_TEMP) > 3) {
  3455. lcd_display_message_fullscreen_P(MSG_WIZARD_HEATING);
  3456. lcd.setCursor(0, 4);
  3457. lcd.print(LCD_STR_THERMOMETER[0]);
  3458. lcd.print(ftostr3(degHotend(0)));
  3459. lcd.print("/");
  3460. lcd.print(PLA_PREHEAT_HOTEND_TEMP);
  3461. lcd.print(LCD_STR_DEGREE);
  3462. lcd_set_custom_characters();
  3463. delay_keep_alive(1000);
  3464. }
  3465. #endif //not SNMM
  3466. state = 7;
  3467. break;
  3468. case 7: //load filament
  3469. #ifdef PAT9125
  3470. fsensor_block();
  3471. #endif //PAT9125
  3472. lcd_show_fullscreen_message_and_wait_P(MSG_WIZARD_LOAD_FILAMENT);
  3473. lcd_update_enable(false);
  3474. lcd_implementation_clear();
  3475. lcd_print_at_PGM(0, 2, MSG_LOADING_FILAMENT);
  3476. #ifdef SNMM
  3477. change_extr(0);
  3478. #endif
  3479. gcode_M701();
  3480. #ifdef PAT9125
  3481. fsensor_unblock();
  3482. #endif //PAT9125
  3483. state = 9;
  3484. break;
  3485. case 8:
  3486. wizard_event = lcd_show_fullscreen_message_yes_no_and_wait_P(MSG_WIZARD_PLA_FILAMENT, false, true);
  3487. if (wizard_event) state = 9;
  3488. else end = true;
  3489. break;
  3490. case 9:
  3491. lcd_show_fullscreen_message_and_wait_P(MSG_WIZARD_V2_CAL);
  3492. lcd_show_fullscreen_message_and_wait_P(MSG_WIZARD_V2_CAL_2);
  3493. lcd_commands_type = LCD_COMMAND_V2_CAL;
  3494. end = true;
  3495. break;
  3496. case 10: //repeat first layer cal.?
  3497. wizard_event = lcd_show_multiscreen_message_yes_no_and_wait_P(MSG_WIZARD_REPEAT_V2_CAL, false);
  3498. if (wizard_event) {
  3499. lcd_show_fullscreen_message_and_wait_P(MSG_WIZARD_CLEAN_HEATBED);
  3500. state = 9;
  3501. }
  3502. else {
  3503. state = 11;
  3504. }
  3505. break;
  3506. case 11: //we are finished
  3507. eeprom_write_byte((uint8_t*)EEPROM_WIZARD_ACTIVE, 0);
  3508. end = true;
  3509. break;
  3510. default: break;
  3511. }
  3512. }
  3513. SERIAL_ECHOPGM("State: ");
  3514. MYSERIAL.println(state);
  3515. switch (state) { //final message
  3516. case 0: //user dont want to use wizard
  3517. msg = MSG_WIZARD_QUIT;
  3518. break;
  3519. case 1: //printer was already calibrated
  3520. msg = MSG_WIZARD_DONE;
  3521. break;
  3522. case 2: //selftest
  3523. msg = MSG_WIZARD_CALIBRATION_FAILED;
  3524. break;
  3525. case 3: //xyz cal.
  3526. msg = MSG_WIZARD_CALIBRATION_FAILED;
  3527. break;
  3528. case 4: //z cal.
  3529. msg = MSG_WIZARD_CALIBRATION_FAILED;
  3530. break;
  3531. case 8:
  3532. msg = MSG_WIZARD_INSERT_CORRECT_FILAMENT;
  3533. break;
  3534. case 9: break; //exit wizard for v2 calibration, which is implemted in lcd_commands (we need lcd_update running)
  3535. case 11: //we are finished
  3536. msg = MSG_WIZARD_DONE;
  3537. lcd_reset_alert_level();
  3538. lcd_setstatuspgm(WELCOME_MSG);
  3539. break;
  3540. default:
  3541. msg = MSG_WIZARD_QUIT;
  3542. break;
  3543. }
  3544. if (state != 9) lcd_show_fullscreen_message_and_wait_P(msg);
  3545. lcd_update_enable(true);
  3546. lcd_return_to_status();
  3547. lcd_update(2);
  3548. }
  3549. static void lcd_settings_menu()
  3550. {
  3551. EEPROM_read(EEPROM_SILENT, (uint8_t*)&SilentModeMenu, sizeof(SilentModeMenu));
  3552. START_MENU();
  3553. MENU_ITEM(back, MSG_MAIN, lcd_settings_menu_back);
  3554. MENU_ITEM(submenu, MSG_TEMPERATURE, lcd_control_temperature_menu);
  3555. if (!homing_flag)
  3556. {
  3557. MENU_ITEM(submenu, MSG_MOVE_AXIS, lcd_move_menu_1mm);
  3558. }
  3559. if (!isPrintPaused)
  3560. {
  3561. MENU_ITEM(gcode, MSG_DISABLE_STEPPERS, PSTR("M84"));
  3562. }
  3563. #ifndef TMC2130
  3564. if (!farm_mode) { //dont show in menu if we are in farm mode
  3565. switch (SilentModeMenu) {
  3566. case SILENT_MODE_POWER: MENU_ITEM(function, MSG_SILENT_MODE_OFF, lcd_silent_mode_set); break;
  3567. case SILENT_MODE_SILENT: MENU_ITEM(function, MSG_SILENT_MODE_ON, lcd_silent_mode_set); break;
  3568. case SILENT_MODE_AUTO: MENU_ITEM(function, MSG_AUTO_MODE_ON, lcd_silent_mode_set); break;
  3569. default: MENU_ITEM(function, MSG_SILENT_MODE_OFF, lcd_silent_mode_set); break; // (probably) not needed
  3570. }
  3571. }
  3572. #endif //TMC2130
  3573. #ifdef PAT9125
  3574. #ifndef DEBUG_DISABLE_FSENSORCHECK
  3575. if (FSensorStateMenu == 0) {
  3576. if (fsensor_not_responding){
  3577. // Filament sensor not working
  3578. MENU_ITEM(function, MSG_FSENSOR_NA, lcd_fsensor_state_set);
  3579. MENU_ITEM(function, MSG_FSENS_AUTOLOAD_NA, lcd_fsensor_fail);
  3580. }
  3581. else{
  3582. // Filament sensor turned off, working, no problems
  3583. MENU_ITEM(function, MSG_FSENSOR_OFF, lcd_fsensor_state_set);
  3584. MENU_ITEM(function, MSG_FSENS_AUTOLOAD_NA, lcd_filament_autoload_info);
  3585. }
  3586. } else {
  3587. // Filament sensor turned on, working, no problems
  3588. MENU_ITEM(function, MSG_FSENSOR_ON, lcd_fsensor_state_set);
  3589. if ((filament_autoload_enabled == true)) {
  3590. MENU_ITEM(function, MSG_FSENS_AUTOLOAD_ON, lcd_set_filament_autoload);
  3591. }
  3592. else {
  3593. MENU_ITEM(function, MSG_FSENS_AUTOLOAD_OFF, lcd_set_filament_autoload);
  3594. }
  3595. }
  3596. #endif //DEBUG_DISABLE_FSENSORCHECK
  3597. #endif //PAT9125
  3598. if (fans_check_enabled == true) {
  3599. MENU_ITEM(function, MSG_FANS_CHECK_ON, lcd_set_fan_check);
  3600. }
  3601. else {
  3602. MENU_ITEM(function, MSG_FANS_CHECK_OFF, lcd_set_fan_check);
  3603. }
  3604. #ifdef TMC2130
  3605. if(!farm_mode)
  3606. {
  3607. //*** MaR::180416_01a
  3608. if (SilentModeMenu == SILENT_MODE_NORMAL) MENU_ITEM(function, MSG_STEALTH_MODE_OFF, lcd_silent_mode_set);
  3609. else MENU_ITEM(function, MSG_STEALTH_MODE_ON, lcd_silent_mode_set);
  3610. if (SilentModeMenu == SILENT_MODE_NORMAL)
  3611. {
  3612. if (CrashDetectMenu == 0) MENU_ITEM(function, MSG_CRASHDETECT_OFF, lcd_crash_mode_set);
  3613. else MENU_ITEM(function, MSG_CRASHDETECT_ON, lcd_crash_mode_set);
  3614. }
  3615. else MENU_ITEM(submenu, MSG_CRASHDETECT_NA, lcd_crash_mode_info);
  3616. }
  3617. MENU_ITEM_EDIT(wfac, MSG_EXTRUDER_CORRECTION, &tmc2130_wave_fac[E_AXIS], TMC2130_WAVE_FAC1000_MIN-TMC2130_WAVE_FAC1000_STP, TMC2130_WAVE_FAC1000_MAX);
  3618. #endif //TMC2130
  3619. if (temp_cal_active == false) {
  3620. MENU_ITEM(function, MSG_TEMP_CALIBRATION_OFF, lcd_temp_calibration_set);
  3621. }
  3622. else {
  3623. MENU_ITEM(function, MSG_TEMP_CALIBRATION_ON, lcd_temp_calibration_set);
  3624. }
  3625. #ifdef HAS_SECOND_SERIAL_PORT
  3626. if (selectedSerialPort == 0) {
  3627. MENU_ITEM(function, MSG_SECOND_SERIAL_OFF, lcd_second_serial_set);
  3628. }
  3629. else {
  3630. MENU_ITEM(function, MSG_SECOND_SERIAL_ON, lcd_second_serial_set);
  3631. }
  3632. #endif //HAS_SECOND_SERIAL
  3633. if (!isPrintPaused && !homing_flag)
  3634. {
  3635. MENU_ITEM(submenu, MSG_BABYSTEP_Z, lcd_babystep_z);
  3636. }
  3637. MENU_ITEM(submenu, MSG_LANGUAGE_SELECT, lcd_language_menu);
  3638. if (card.ToshibaFlashAir_isEnabled()) {
  3639. MENU_ITEM(function, MSG_TOSHIBA_FLASH_AIR_COMPATIBILITY_ON, lcd_toshiba_flash_air_compatibility_toggle);
  3640. } else {
  3641. MENU_ITEM(function, MSG_TOSHIBA_FLASH_AIR_COMPATIBILITY_OFF, lcd_toshiba_flash_air_compatibility_toggle);
  3642. }
  3643. #ifdef SDCARD_SORT_ALPHA
  3644. if (!farm_mode) {
  3645. uint8_t sdSort;
  3646. EEPROM_read(EEPROM_SD_SORT, (uint8_t*)&sdSort, sizeof(sdSort));
  3647. switch (sdSort) {
  3648. case SD_SORT_TIME: MENU_ITEM(function, MSG_SORT_TIME, lcd_sort_type_set); break;
  3649. case SD_SORT_ALPHA: MENU_ITEM(function, MSG_SORT_ALPHA, lcd_sort_type_set); break;
  3650. default: MENU_ITEM(function, MSG_SORT_NONE, lcd_sort_type_set);
  3651. }
  3652. }
  3653. #endif // SDCARD_SORT_ALPHA
  3654. if (farm_mode)
  3655. {
  3656. MENU_ITEM(submenu, PSTR("Farm number"), lcd_farm_no);
  3657. MENU_ITEM(function, PSTR("Disable farm mode"), lcd_disable_farm_mode);
  3658. }
  3659. END_MENU();
  3660. }
  3661. static void lcd_selftest_()
  3662. {
  3663. lcd_selftest();
  3664. }
  3665. #ifdef TMC2130
  3666. static void lcd_ustep_linearity_menu_save()
  3667. {
  3668. eeprom_update_word((uint16_t*)EEPROM_TMC2130_WAVE_X_FAC, tmc2130_wave_fac[X_AXIS]);
  3669. eeprom_update_word((uint16_t*)EEPROM_TMC2130_WAVE_Y_FAC, tmc2130_wave_fac[Y_AXIS]);
  3670. eeprom_update_word((uint16_t*)EEPROM_TMC2130_WAVE_Z_FAC, tmc2130_wave_fac[Z_AXIS]);
  3671. eeprom_update_word((uint16_t*)EEPROM_TMC2130_WAVE_E_FAC, tmc2130_wave_fac[E_AXIS]);
  3672. }
  3673. #endif //TMC2130
  3674. static void lcd_settings_menu_back()
  3675. {
  3676. #ifdef TMC2130
  3677. bool changed = false;
  3678. if (tmc2130_wave_fac[E_AXIS] < TMC2130_WAVE_FAC1000_MIN) tmc2130_wave_fac[E_AXIS] = 0;
  3679. changed |= (eeprom_read_word((uint16_t*)EEPROM_TMC2130_WAVE_E_FAC) != tmc2130_wave_fac[E_AXIS]);
  3680. lcd_ustep_linearity_menu_save();
  3681. if (changed) tmc2130_init();
  3682. #endif //TMC2130
  3683. currentMenu = lcd_main_menu;
  3684. lcd_main_menu();
  3685. }
  3686. #ifdef EXPERIMENTAL_FEATURES
  3687. static void lcd_experimantal_menu();
  3688. static void lcd_homing_accuracy_menu();
  3689. static void lcd_accurate_home_set()
  3690. {
  3691. tmc2130_home_enabled = tmc2130_home_enabled?0:1;
  3692. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_ENABLED, tmc2130_home_enabled);
  3693. }
  3694. static void lcd_homing_accuracy_menu_advanced_reset()
  3695. {
  3696. tmc2130_home_bsteps[X_AXIS] = 48;
  3697. tmc2130_home_fsteps[X_AXIS] = 48;
  3698. tmc2130_home_bsteps[Y_AXIS] = 48;
  3699. tmc2130_home_fsteps[Y_AXIS] = 48;
  3700. }
  3701. static void lcd_homing_accuracy_menu_advanced_save()
  3702. {
  3703. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_X_ORIGIN, tmc2130_home_origin[X_AXIS]);
  3704. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_X_BSTEPS, tmc2130_home_bsteps[X_AXIS]);
  3705. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_X_FSTEPS, tmc2130_home_fsteps[X_AXIS]);
  3706. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_Y_ORIGIN, tmc2130_home_origin[Y_AXIS]);
  3707. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_Y_BSTEPS, tmc2130_home_bsteps[Y_AXIS]);
  3708. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_Y_FSTEPS, tmc2130_home_fsteps[Y_AXIS]);
  3709. }
  3710. static void lcd_homing_accuracy_menu_advanced_back()
  3711. {
  3712. lcd_homing_accuracy_menu_advanced_save();
  3713. currentMenu = lcd_homing_accuracy_menu;
  3714. lcd_homing_accuracy_menu();
  3715. }
  3716. static void lcd_homing_accuracy_menu_advanced()
  3717. {
  3718. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  3719. START_MENU();
  3720. MENU_ITEM(back, PSTR("Homing accuracy"), lcd_homing_accuracy_menu_advanced_back);
  3721. MENU_ITEM(function, PSTR("Reset def. steps"), lcd_homing_accuracy_menu_advanced_reset);
  3722. MENU_ITEM_EDIT(byte3, PSTR("X-origin"), &tmc2130_home_origin[X_AXIS], 0, 63);
  3723. MENU_ITEM_EDIT(byte3, PSTR("Y-origin"), &tmc2130_home_origin[Y_AXIS], 0, 63);
  3724. MENU_ITEM_EDIT(byte3, PSTR("X-bsteps"), &tmc2130_home_bsteps[X_AXIS], 0, 128);
  3725. MENU_ITEM_EDIT(byte3, PSTR("Y-bsteps"), &tmc2130_home_bsteps[Y_AXIS], 0, 128);
  3726. MENU_ITEM_EDIT(byte3, PSTR("X-fsteps"), &tmc2130_home_fsteps[X_AXIS], 0, 128);
  3727. MENU_ITEM_EDIT(byte3, PSTR("Y-fsteps"), &tmc2130_home_fsteps[Y_AXIS], 0, 128);
  3728. END_MENU();
  3729. }
  3730. static void lcd_homing_accuracy_menu()
  3731. {
  3732. START_MENU();
  3733. MENU_ITEM(back, PSTR("Experimental"), 0);
  3734. MENU_ITEM(function, tmc2130_home_enabled?PSTR("Accur. homing On"):PSTR("Accur. homing Off"), lcd_accurate_home_set);
  3735. MENU_ITEM(gcode, PSTR("Calibrate X"), PSTR("G28XC"));
  3736. MENU_ITEM(gcode, PSTR("Calibrate Y"), PSTR("G28YC"));
  3737. MENU_ITEM(submenu, PSTR("Advanced"), lcd_homing_accuracy_menu_advanced);
  3738. END_MENU();
  3739. }
  3740. static void lcd_ustep_resolution_menu_save()
  3741. {
  3742. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_X_MRES, tmc2130_mres[X_AXIS]);
  3743. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_Y_MRES, tmc2130_mres[Y_AXIS]);
  3744. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_Z_MRES, tmc2130_mres[Z_AXIS]);
  3745. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_E_MRES, tmc2130_mres[E_AXIS]);
  3746. }
  3747. static void lcd_ustep_resolution_menu_back()
  3748. {
  3749. float tmp1[]=DEFAULT_AXIS_STEPS_PER_UNIT;
  3750. bool changed = false;
  3751. if (tmc2130_mres[X_AXIS] != eeprom_read_byte((uint8_t*)EEPROM_TMC2130_X_MRES))
  3752. {
  3753. axis_steps_per_unit[X_AXIS] = tmp1[X_AXIS] * tmc2130_mres2usteps(tmc2130_mres[X_AXIS]) / TMC2130_USTEPS_XY;
  3754. changed = true;
  3755. }
  3756. if (tmc2130_mres[Y_AXIS] != eeprom_read_byte((uint8_t*)EEPROM_TMC2130_Y_MRES))
  3757. {
  3758. axis_steps_per_unit[Y_AXIS] = tmp1[Y_AXIS] * tmc2130_mres2usteps(tmc2130_mres[Y_AXIS]) / TMC2130_USTEPS_XY;
  3759. changed = true;
  3760. }
  3761. if (tmc2130_mres[Z_AXIS] != eeprom_read_byte((uint8_t*)EEPROM_TMC2130_Z_MRES))
  3762. {
  3763. axis_steps_per_unit[Z_AXIS] = tmp1[Z_AXIS] * tmc2130_mres2usteps(tmc2130_mres[Z_AXIS]) / TMC2130_USTEPS_Z;
  3764. changed = true;
  3765. }
  3766. if (tmc2130_mres[E_AXIS] != eeprom_read_byte((uint8_t*)EEPROM_TMC2130_E_MRES))
  3767. {
  3768. axis_steps_per_unit[E_AXIS] = tmp1[E_AXIS] * tmc2130_mres2usteps(tmc2130_mres[E_AXIS]) / TMC2130_USTEPS_E;
  3769. changed = true;
  3770. }
  3771. if (changed)
  3772. {
  3773. lcd_ustep_resolution_menu_save();
  3774. Config_StoreSettings(EEPROM_OFFSET);
  3775. tmc2130_init();
  3776. }
  3777. currentMenu = lcd_experimantal_menu;
  3778. lcd_experimantal_menu();
  3779. }
  3780. static void lcd_ustep_resolution_reset_def_xyze()
  3781. {
  3782. tmc2130_mres[X_AXIS] = tmc2130_usteps2mres(TMC2130_USTEPS_XY);
  3783. tmc2130_mres[Y_AXIS] = tmc2130_usteps2mres(TMC2130_USTEPS_XY);
  3784. tmc2130_mres[Z_AXIS] = tmc2130_usteps2mres(TMC2130_USTEPS_Z);
  3785. tmc2130_mres[E_AXIS] = tmc2130_usteps2mres(TMC2130_USTEPS_E);
  3786. float tmp1[]=DEFAULT_AXIS_STEPS_PER_UNIT;
  3787. axis_steps_per_unit[X_AXIS] = tmp1[X_AXIS];
  3788. axis_steps_per_unit[Y_AXIS] = tmp1[Y_AXIS];
  3789. axis_steps_per_unit[Z_AXIS] = tmp1[Z_AXIS];
  3790. axis_steps_per_unit[E_AXIS] = tmp1[E_AXIS];
  3791. }
  3792. static void lcd_ustep_resolution_menu()
  3793. {
  3794. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  3795. START_MENU();
  3796. MENU_ITEM(back, PSTR("Experimental"), lcd_ustep_resolution_menu_back);
  3797. MENU_ITEM(function, PSTR("Reset defaults"), lcd_ustep_resolution_reset_def_xyze);
  3798. MENU_ITEM_EDIT(mres, PSTR("X-resolution"), &tmc2130_mres[X_AXIS], 4, 4);
  3799. MENU_ITEM_EDIT(mres, PSTR("Y-resolution"), &tmc2130_mres[Y_AXIS], 4, 4);
  3800. MENU_ITEM_EDIT(mres, PSTR("Z-resolution"), &tmc2130_mres[Z_AXIS], 4, 4);
  3801. MENU_ITEM_EDIT(mres, PSTR("E-resolution"), &tmc2130_mres[E_AXIS], 2, 5);
  3802. END_MENU();
  3803. }
  3804. static void lcd_ustep_linearity_menu_back()
  3805. {
  3806. bool changed = false;
  3807. if (tmc2130_wave_fac[X_AXIS] < TMC2130_WAVE_FAC1000_MIN) tmc2130_wave_fac[X_AXIS] = 0;
  3808. if (tmc2130_wave_fac[Y_AXIS] < TMC2130_WAVE_FAC1000_MIN) tmc2130_wave_fac[Y_AXIS] = 0;
  3809. if (tmc2130_wave_fac[Z_AXIS] < TMC2130_WAVE_FAC1000_MIN) tmc2130_wave_fac[Z_AXIS] = 0;
  3810. if (tmc2130_wave_fac[E_AXIS] < TMC2130_WAVE_FAC1000_MIN) tmc2130_wave_fac[E_AXIS] = 0;
  3811. changed |= (eeprom_read_word((uint16_t*)EEPROM_TMC2130_WAVE_X_FAC) != tmc2130_wave_fac[X_AXIS]);
  3812. changed |= (eeprom_read_word((uint16_t*)EEPROM_TMC2130_WAVE_Y_FAC) != tmc2130_wave_fac[Y_AXIS]);
  3813. changed |= (eeprom_read_word((uint16_t*)EEPROM_TMC2130_WAVE_Z_FAC) != tmc2130_wave_fac[Z_AXIS]);
  3814. changed |= (eeprom_read_word((uint16_t*)EEPROM_TMC2130_WAVE_E_FAC) != tmc2130_wave_fac[E_AXIS]);
  3815. lcd_ustep_linearity_menu_save();
  3816. if (changed) tmc2130_init();
  3817. currentMenu = lcd_experimantal_menu;
  3818. lcd_experimantal_menu();
  3819. }
  3820. static void lcd_ustep_linearity_menu_recomended()
  3821. {
  3822. tmc2130_wave_fac[X_AXIS] = 220;
  3823. tmc2130_wave_fac[Y_AXIS] = 220;
  3824. tmc2130_wave_fac[Z_AXIS] = 220;
  3825. tmc2130_wave_fac[E_AXIS] = 220;
  3826. }
  3827. static void lcd_ustep_linearity_menu_reset()
  3828. {
  3829. tmc2130_wave_fac[X_AXIS] = 0;
  3830. tmc2130_wave_fac[Y_AXIS] = 0;
  3831. tmc2130_wave_fac[Z_AXIS] = 0;
  3832. tmc2130_wave_fac[E_AXIS] = 0;
  3833. }
  3834. static void lcd_ustep_linearity_menu()
  3835. {
  3836. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  3837. START_MENU();
  3838. MENU_ITEM(back, PSTR("Experimental"), lcd_ustep_linearity_menu_back);
  3839. MENU_ITEM(function, PSTR("Reset correction"), lcd_ustep_linearity_menu_reset);
  3840. MENU_ITEM(function, PSTR("Recomended config"), lcd_ustep_linearity_menu_recomended);
  3841. MENU_ITEM_EDIT(wfac, PSTR("X-correction"), &tmc2130_wave_fac[X_AXIS], TMC2130_WAVE_FAC1000_MIN-TMC2130_WAVE_FAC1000_STP, TMC2130_WAVE_FAC1000_MAX);
  3842. MENU_ITEM_EDIT(wfac, PSTR("Y-correction"), &tmc2130_wave_fac[Y_AXIS], TMC2130_WAVE_FAC1000_MIN-TMC2130_WAVE_FAC1000_STP, TMC2130_WAVE_FAC1000_MAX);
  3843. MENU_ITEM_EDIT(wfac, PSTR("Z-correction"), &tmc2130_wave_fac[Z_AXIS], TMC2130_WAVE_FAC1000_MIN-TMC2130_WAVE_FAC1000_STP, TMC2130_WAVE_FAC1000_MAX);
  3844. MENU_ITEM_EDIT(wfac, PSTR("E-correction"), &tmc2130_wave_fac[E_AXIS], TMC2130_WAVE_FAC1000_MIN-TMC2130_WAVE_FAC1000_STP, TMC2130_WAVE_FAC1000_MAX);
  3845. END_MENU();
  3846. }
  3847. static void lcd_experimantal_menu_save_all()
  3848. {
  3849. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_ENABLED, tmc2130_home_enabled);
  3850. lcd_ustep_resolution_menu_save();
  3851. lcd_ustep_linearity_menu_save();
  3852. Config_StoreSettings(EEPROM_OFFSET);
  3853. }
  3854. static void lcd_experimantal_menu_disable_all()
  3855. {
  3856. tmc2130_home_enabled = 0;
  3857. lcd_ustep_resolution_reset_def_xyze();
  3858. lcd_ustep_linearity_menu_reset();
  3859. lcd_experimantal_menu_save_all();
  3860. tmc2130_init();
  3861. }
  3862. static void lcd_experimantal_menu()
  3863. {
  3864. START_MENU();
  3865. MENU_ITEM(back, MSG_MAIN, 0);
  3866. MENU_ITEM(function, PSTR("All Xfeatures off"), lcd_experimantal_menu_disable_all);
  3867. MENU_ITEM(submenu, PSTR("Homing accuracy"), lcd_homing_accuracy_menu);
  3868. MENU_ITEM(submenu, PSTR("uStep resolution"), lcd_ustep_resolution_menu);
  3869. MENU_ITEM(submenu, PSTR("uStep linearity"), lcd_ustep_linearity_menu);
  3870. END_MENU();
  3871. }
  3872. #endif //EXPERIMENTAL_FEATURES
  3873. static void lcd_calibration_menu()
  3874. {
  3875. START_MENU();
  3876. MENU_ITEM(back, MSG_MAIN, 0);
  3877. if (!isPrintPaused)
  3878. {
  3879. MENU_ITEM(function, MSG_WIZARD, lcd_wizard);
  3880. MENU_ITEM(submenu, MSG_V2_CALIBRATION, lcd_v2_calibration);
  3881. MENU_ITEM(gcode, MSG_AUTO_HOME, PSTR("G28 W"));
  3882. MENU_ITEM(function, MSG_SELFTEST, lcd_selftest_v);
  3883. #ifdef MK1BP
  3884. // MK1
  3885. // "Calibrate Z"
  3886. MENU_ITEM(gcode, MSG_HOMEYZ, PSTR("G28 Z"));
  3887. #else //MK1BP
  3888. // MK2
  3889. MENU_ITEM(function, MSG_CALIBRATE_BED, lcd_mesh_calibration);
  3890. // "Calibrate Z" with storing the reference values to EEPROM.
  3891. MENU_ITEM(submenu, MSG_HOMEYZ, lcd_mesh_calibration_z);
  3892. #ifndef SNMM
  3893. //MENU_ITEM(function, MSG_CALIBRATE_E, lcd_calibrate_extruder);
  3894. #endif
  3895. // "Mesh Bed Leveling"
  3896. MENU_ITEM(submenu, MSG_MESH_BED_LEVELING, lcd_mesh_bedleveling);
  3897. #endif //MK1BP
  3898. MENU_ITEM(submenu, MSG_BED_CORRECTION_MENU, lcd_adjust_bed);
  3899. MENU_ITEM(submenu, MSG_PID_EXTRUDER, pid_extruder);
  3900. MENU_ITEM(submenu, MSG_SHOW_END_STOPS, menu_show_end_stops);
  3901. #ifndef MK1BP
  3902. MENU_ITEM(gcode, MSG_CALIBRATE_BED_RESET, PSTR("M44"));
  3903. #endif //MK1BP
  3904. #ifndef SNMM
  3905. //MENU_ITEM(function, MSG_RESET_CALIBRATE_E, lcd_extr_cal_reset);
  3906. #endif
  3907. #ifndef MK1BP
  3908. MENU_ITEM(submenu, MSG_CALIBRATION_PINDA_MENU, lcd_pinda_calibration_menu);
  3909. #endif //MK1BP
  3910. }
  3911. END_MENU();
  3912. }
  3913. /*
  3914. void lcd_mylang_top(int hlaska) {
  3915. lcd.setCursor(0,0);
  3916. lcd.print(" ");
  3917. lcd.setCursor(0,0);
  3918. lcd_printPGM(MSG_ALL[hlaska-1][LANGUAGE_SELECT]);
  3919. }
  3920. void lcd_mylang_drawmenu(int cursor) {
  3921. int first = 0;
  3922. if (cursor>2) first = cursor-2;
  3923. if (cursor==LANG_NUM) first = LANG_NUM-3;
  3924. lcd.setCursor(0, 1);
  3925. lcd.print(" ");
  3926. lcd.setCursor(1, 1);
  3927. lcd_printPGM(MSG_ALL[first][LANGUAGE_NAME]);
  3928. lcd.setCursor(0, 2);
  3929. lcd.print(" ");
  3930. lcd.setCursor(1, 2);
  3931. lcd_printPGM(MSG_ALL[first+1][LANGUAGE_NAME]);
  3932. lcd.setCursor(0, 3);
  3933. lcd.print(" ");
  3934. lcd.setCursor(1, 3);
  3935. lcd_printPGM(MSG_ALL[first+2][LANGUAGE_NAME]);
  3936. if (cursor==1) lcd.setCursor(0, 1);
  3937. if (cursor>1 && cursor<LANG_NUM) lcd.setCursor(0, 2);
  3938. if (cursor==LANG_NUM) lcd.setCursor(0, 3);
  3939. lcd.print(">");
  3940. if (cursor<LANG_NUM-1) {
  3941. lcd.setCursor(19,3);
  3942. lcd.print("\x01");
  3943. }
  3944. if (cursor>2) {
  3945. lcd.setCursor(19,1);
  3946. lcd.print("^");
  3947. }
  3948. }
  3949. */
  3950. void lcd_mylang_drawmenu(int cursor) {
  3951. int first = 0;
  3952. if (cursor>3) first = cursor-3;
  3953. if (cursor==LANG_NUM && LANG_NUM>4) first = LANG_NUM-4;
  3954. if (cursor==LANG_NUM && LANG_NUM==4) first = LANG_NUM-4;
  3955. lcd.setCursor(0, 0);
  3956. lcd.print(" ");
  3957. lcd.setCursor(1, 0);
  3958. lcd_printPGM(MSG_LANGUAGE_NAME_EXPLICIT(first+0));
  3959. lcd.setCursor(0, 1);
  3960. lcd.print(" ");
  3961. lcd.setCursor(1, 1);
  3962. lcd_printPGM(MSG_LANGUAGE_NAME_EXPLICIT(first+1));
  3963. lcd.setCursor(0, 2);
  3964. lcd.print(" ");
  3965. if (LANG_NUM > 2){
  3966. lcd.setCursor(1, 2);
  3967. lcd_printPGM(MSG_LANGUAGE_NAME_EXPLICIT(first+2));
  3968. }
  3969. lcd.setCursor(0, 3);
  3970. lcd.print(" ");
  3971. if (LANG_NUM>3) {
  3972. lcd.setCursor(1, 3);
  3973. lcd_printPGM(MSG_LANGUAGE_NAME_EXPLICIT(first+3));
  3974. }
  3975. if (cursor==1) lcd.setCursor(0, 0);
  3976. if (cursor==2) lcd.setCursor(0, 1);
  3977. if (cursor>2) lcd.setCursor(0, 2);
  3978. if (cursor==LANG_NUM && LANG_NUM>3) lcd.setCursor(0, 3);
  3979. lcd.print(">");
  3980. if (cursor<LANG_NUM-1 && LANG_NUM>4) {
  3981. lcd.setCursor(19,3);
  3982. lcd.print("\x01");
  3983. }
  3984. if (cursor>3 && LANG_NUM>4) {
  3985. lcd.setCursor(19,0);
  3986. lcd.print("^");
  3987. }
  3988. }
  3989. void lcd_mylang_drawcursor(int cursor) {
  3990. if (cursor==1) lcd.setCursor(0, 1);
  3991. if (cursor>1 && cursor<LANG_NUM) lcd.setCursor(0, 2);
  3992. if (cursor==LANG_NUM) lcd.setCursor(0, 3);
  3993. lcd.print(">");
  3994. }
  3995. void lcd_mylang() {
  3996. int enc_dif = 0;
  3997. int cursor_pos = 1;
  3998. lang_selected=255;
  3999. int hlaska=1;
  4000. int counter=0;
  4001. lcd_set_custom_characters_arrows();
  4002. lcd_implementation_clear();
  4003. //lcd_mylang_top(hlaska);
  4004. lcd_mylang_drawmenu(cursor_pos);
  4005. enc_dif = encoderDiff;
  4006. while ( (lang_selected == 255) ) {
  4007. manage_heater();
  4008. manage_inactivity(true);
  4009. if ( abs((enc_dif - encoderDiff)) > 4 ) {
  4010. //if ( (abs(enc_dif - encoderDiff)) > 1 ) {
  4011. if (enc_dif > encoderDiff ) {
  4012. cursor_pos --;
  4013. }
  4014. if (enc_dif < encoderDiff ) {
  4015. cursor_pos ++;
  4016. }
  4017. if (cursor_pos > LANG_NUM) {
  4018. cursor_pos = LANG_NUM;
  4019. }
  4020. if (cursor_pos < 1) {
  4021. cursor_pos = 1;
  4022. }
  4023. lcd_mylang_drawmenu(cursor_pos);
  4024. enc_dif = encoderDiff;
  4025. delay(100);
  4026. //}
  4027. } else delay(20);
  4028. if (lcd_clicked()) {
  4029. lcd_set_lang(cursor_pos-1);
  4030. delay(500);
  4031. }
  4032. /*
  4033. if (++counter == 80) {
  4034. hlaska++;
  4035. if(hlaska>LANG_NUM) hlaska=1;
  4036. lcd_mylang_top(hlaska);
  4037. lcd_mylang_drawcursor(cursor_pos);
  4038. counter=0;
  4039. }
  4040. */
  4041. };
  4042. if(MYSERIAL.available() > 1){
  4043. lang_selected = 0;
  4044. firstrun = 0;
  4045. }
  4046. lcd_set_custom_characters_degree();
  4047. lcd_implementation_clear();
  4048. lcd_return_to_status();
  4049. }
  4050. void bowden_menu() {
  4051. int enc_dif = encoderDiff;
  4052. int cursor_pos = 0;
  4053. lcd_implementation_clear();
  4054. lcd.setCursor(0, 0);
  4055. lcd.print(">");
  4056. for (int i = 0; i < 4; i++) {
  4057. lcd.setCursor(1, i);
  4058. lcd.print("Extruder ");
  4059. lcd.print(i);
  4060. lcd.print(": ");
  4061. EEPROM_read_B(EEPROM_BOWDEN_LENGTH + i * 2, &bowden_length[i]);
  4062. lcd.print(bowden_length[i] - 48);
  4063. }
  4064. enc_dif = encoderDiff;
  4065. while (1) {
  4066. manage_heater();
  4067. manage_inactivity(true);
  4068. if (abs((enc_dif - encoderDiff)) > 2) {
  4069. if (enc_dif > encoderDiff) {
  4070. cursor_pos--;
  4071. }
  4072. if (enc_dif < encoderDiff) {
  4073. cursor_pos++;
  4074. }
  4075. if (cursor_pos > 3) {
  4076. cursor_pos = 3;
  4077. }
  4078. if (cursor_pos < 0) {
  4079. cursor_pos = 0;
  4080. }
  4081. lcd.setCursor(0, 0);
  4082. lcd.print(" ");
  4083. lcd.setCursor(0, 1);
  4084. lcd.print(" ");
  4085. lcd.setCursor(0, 2);
  4086. lcd.print(" ");
  4087. lcd.setCursor(0, 3);
  4088. lcd.print(" ");
  4089. lcd.setCursor(0, cursor_pos);
  4090. lcd.print(">");
  4091. enc_dif = encoderDiff;
  4092. delay(100);
  4093. }
  4094. if (lcd_clicked()) {
  4095. while (lcd_clicked());
  4096. delay(10);
  4097. while (lcd_clicked());
  4098. lcd_implementation_clear();
  4099. while (1) {
  4100. manage_heater();
  4101. manage_inactivity(true);
  4102. lcd.setCursor(1, 1);
  4103. lcd.print("Extruder ");
  4104. lcd.print(cursor_pos);
  4105. lcd.print(": ");
  4106. lcd.setCursor(13, 1);
  4107. lcd.print(bowden_length[cursor_pos] - 48);
  4108. if (abs((enc_dif - encoderDiff)) > 2) {
  4109. if (enc_dif > encoderDiff) {
  4110. bowden_length[cursor_pos]--;
  4111. lcd.setCursor(13, 1);
  4112. lcd.print(bowden_length[cursor_pos] - 48);
  4113. enc_dif = encoderDiff;
  4114. }
  4115. if (enc_dif < encoderDiff) {
  4116. bowden_length[cursor_pos]++;
  4117. lcd.setCursor(13, 1);
  4118. lcd.print(bowden_length[cursor_pos] - 48);
  4119. enc_dif = encoderDiff;
  4120. }
  4121. }
  4122. delay(100);
  4123. if (lcd_clicked()) {
  4124. while (lcd_clicked());
  4125. delay(10);
  4126. while (lcd_clicked());
  4127. EEPROM_save_B(EEPROM_BOWDEN_LENGTH + cursor_pos * 2, &bowden_length[cursor_pos]);
  4128. if (lcd_show_fullscreen_message_yes_no_and_wait_P(PSTR("Continue with another bowden?"))) {
  4129. lcd_update_enable(true);
  4130. lcd_implementation_clear();
  4131. enc_dif = encoderDiff;
  4132. lcd.setCursor(0, cursor_pos);
  4133. lcd.print(">");
  4134. for (int i = 0; i < 4; i++) {
  4135. lcd.setCursor(1, i);
  4136. lcd.print("Extruder ");
  4137. lcd.print(i);
  4138. lcd.print(": ");
  4139. EEPROM_read_B(EEPROM_BOWDEN_LENGTH + i * 2, &bowden_length[i]);
  4140. lcd.print(bowden_length[i] - 48);
  4141. }
  4142. break;
  4143. }
  4144. else return;
  4145. }
  4146. }
  4147. }
  4148. }
  4149. }
  4150. static char snmm_stop_print_menu() { //menu for choosing which filaments will be unloaded in stop print
  4151. lcd_implementation_clear();
  4152. lcd_print_at_PGM(0,0,MSG_UNLOAD_FILAMENT); lcd.print(":");
  4153. lcd.setCursor(0, 1); lcd.print(">");
  4154. lcd_print_at_PGM(1,1,MSG_ALL);
  4155. lcd_print_at_PGM(1,2,MSG_USED);
  4156. lcd_print_at_PGM(1,3,MSG_CURRENT);
  4157. char cursor_pos = 1;
  4158. int enc_dif = 0;
  4159. KEEPALIVE_STATE(PAUSED_FOR_USER);
  4160. while (1) {
  4161. manage_heater();
  4162. manage_inactivity(true);
  4163. if (abs((enc_dif - encoderDiff)) > 4) {
  4164. if ((abs(enc_dif - encoderDiff)) > 1) {
  4165. if (enc_dif > encoderDiff) cursor_pos--;
  4166. if (enc_dif < encoderDiff) cursor_pos++;
  4167. if (cursor_pos > 3) cursor_pos = 3;
  4168. if (cursor_pos < 1) cursor_pos = 1;
  4169. lcd.setCursor(0, 1);
  4170. lcd.print(" ");
  4171. lcd.setCursor(0, 2);
  4172. lcd.print(" ");
  4173. lcd.setCursor(0, 3);
  4174. lcd.print(" ");
  4175. lcd.setCursor(0, cursor_pos);
  4176. lcd.print(">");
  4177. enc_dif = encoderDiff;
  4178. delay(100);
  4179. }
  4180. }
  4181. if (lcd_clicked()) {
  4182. while (lcd_clicked());
  4183. delay(10);
  4184. while (lcd_clicked());
  4185. KEEPALIVE_STATE(IN_HANDLER);
  4186. return(cursor_pos - 1);
  4187. }
  4188. }
  4189. }
  4190. char choose_extruder_menu() {
  4191. int items_no = 4;
  4192. int first = 0;
  4193. int enc_dif = 0;
  4194. char cursor_pos = 1;
  4195. enc_dif = encoderDiff;
  4196. lcd_implementation_clear();
  4197. lcd_printPGM(MSG_CHOOSE_EXTRUDER);
  4198. lcd.setCursor(0, 1);
  4199. lcd.print(">");
  4200. for (int i = 0; i < 3; i++) {
  4201. lcd_print_at_PGM(1, i + 1, MSG_EXTRUDER);
  4202. }
  4203. KEEPALIVE_STATE(PAUSED_FOR_USER);
  4204. while (1) {
  4205. for (int i = 0; i < 3; i++) {
  4206. lcd.setCursor(2 + strlen_P(MSG_EXTRUDER), i+1);
  4207. lcd.print(first + i + 1);
  4208. }
  4209. manage_heater();
  4210. manage_inactivity(true);
  4211. if (abs((enc_dif - encoderDiff)) > 4) {
  4212. if ((abs(enc_dif - encoderDiff)) > 1) {
  4213. if (enc_dif > encoderDiff) {
  4214. cursor_pos--;
  4215. }
  4216. if (enc_dif < encoderDiff) {
  4217. cursor_pos++;
  4218. }
  4219. if (cursor_pos > 3) {
  4220. cursor_pos = 3;
  4221. if (first < items_no - 3) {
  4222. first++;
  4223. lcd_implementation_clear();
  4224. lcd_printPGM(MSG_CHOOSE_EXTRUDER);
  4225. for (int i = 0; i < 3; i++) {
  4226. lcd_print_at_PGM(1, i + 1, MSG_EXTRUDER);
  4227. }
  4228. }
  4229. }
  4230. if (cursor_pos < 1) {
  4231. cursor_pos = 1;
  4232. if (first > 0) {
  4233. first--;
  4234. lcd_implementation_clear();
  4235. lcd_printPGM(MSG_CHOOSE_EXTRUDER);
  4236. for (int i = 0; i < 3; i++) {
  4237. lcd_print_at_PGM(1, i + 1, MSG_EXTRUDER);
  4238. }
  4239. }
  4240. }
  4241. lcd.setCursor(0, 1);
  4242. lcd.print(" ");
  4243. lcd.setCursor(0, 2);
  4244. lcd.print(" ");
  4245. lcd.setCursor(0, 3);
  4246. lcd.print(" ");
  4247. lcd.setCursor(0, cursor_pos);
  4248. lcd.print(">");
  4249. enc_dif = encoderDiff;
  4250. delay(100);
  4251. }
  4252. }
  4253. if (lcd_clicked()) {
  4254. lcd_update(2);
  4255. while (lcd_clicked());
  4256. delay(10);
  4257. while (lcd_clicked());
  4258. KEEPALIVE_STATE(IN_HANDLER);
  4259. return(cursor_pos + first - 1);
  4260. }
  4261. }
  4262. }
  4263. char reset_menu() {
  4264. #ifdef SNMM
  4265. int items_no = 5;
  4266. #else
  4267. int items_no = 4;
  4268. #endif
  4269. static int first = 0;
  4270. int enc_dif = 0;
  4271. char cursor_pos = 0;
  4272. const char *item [items_no];
  4273. item[0] = "Language";
  4274. item[1] = "Statistics";
  4275. item[2] = "Shipping prep";
  4276. item[3] = "All Data";
  4277. #ifdef SNMM
  4278. item[4] = "Bowden length";
  4279. #endif // SNMM
  4280. enc_dif = encoderDiff;
  4281. lcd_implementation_clear();
  4282. lcd.setCursor(0, 0);
  4283. lcd.print(">");
  4284. while (1) {
  4285. for (int i = 0; i < 4; i++) {
  4286. lcd.setCursor(1, i);
  4287. lcd.print(item[first + i]);
  4288. }
  4289. manage_heater();
  4290. manage_inactivity(true);
  4291. if (abs((enc_dif - encoderDiff)) > 4) {
  4292. if ((abs(enc_dif - encoderDiff)) > 1) {
  4293. if (enc_dif > encoderDiff) {
  4294. cursor_pos--;
  4295. }
  4296. if (enc_dif < encoderDiff) {
  4297. cursor_pos++;
  4298. }
  4299. if (cursor_pos > 3) {
  4300. cursor_pos = 3;
  4301. if (first < items_no - 4) {
  4302. first++;
  4303. lcd_implementation_clear();
  4304. }
  4305. }
  4306. if (cursor_pos < 0) {
  4307. cursor_pos = 0;
  4308. if (first > 0) {
  4309. first--;
  4310. lcd_implementation_clear();
  4311. }
  4312. }
  4313. lcd.setCursor(0, 0);
  4314. lcd.print(" ");
  4315. lcd.setCursor(0, 1);
  4316. lcd.print(" ");
  4317. lcd.setCursor(0, 2);
  4318. lcd.print(" ");
  4319. lcd.setCursor(0, 3);
  4320. lcd.print(" ");
  4321. lcd.setCursor(0, cursor_pos);
  4322. lcd.print(">");
  4323. enc_dif = encoderDiff;
  4324. delay(100);
  4325. }
  4326. }
  4327. if (lcd_clicked()) {
  4328. while (lcd_clicked());
  4329. delay(10);
  4330. while (lcd_clicked());
  4331. return(cursor_pos + first);
  4332. }
  4333. }
  4334. }
  4335. static void lcd_disable_farm_mode() {
  4336. int8_t disable = lcd_show_fullscreen_message_yes_no_and_wait_P(PSTR("Disable farm mode?"), true, false); //allow timeouting, default no
  4337. if (disable) {
  4338. enquecommand_P(PSTR("G99"));
  4339. lcd_return_to_status();
  4340. }
  4341. else {
  4342. lcd_goto_menu(lcd_settings_menu); //doesn't break menuStack
  4343. }
  4344. lcd_update_enable(true);
  4345. lcdDrawUpdate = 2;
  4346. }
  4347. static void lcd_ping_allert() {
  4348. if ((abs(millis() - allert_timer)*0.001) > PING_ALLERT_PERIOD) {
  4349. allert_timer = millis();
  4350. SET_OUTPUT(BEEPER);
  4351. for (int i = 0; i < 2; i++) {
  4352. WRITE(BEEPER, HIGH);
  4353. delay(50);
  4354. WRITE(BEEPER, LOW);
  4355. delay(100);
  4356. }
  4357. }
  4358. };
  4359. #ifdef SNMM
  4360. static void extr_mov(float shift, float feed_rate) { //move extruder no matter what the current heater temperature is
  4361. set_extrude_min_temp(.0);
  4362. current_position[E_AXIS] += shift;
  4363. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], feed_rate, active_extruder);
  4364. set_extrude_min_temp(EXTRUDE_MINTEMP);
  4365. }
  4366. void change_extr(int extr) { //switches multiplexer for extruders
  4367. st_synchronize();
  4368. delay(100);
  4369. disable_e0();
  4370. disable_e1();
  4371. disable_e2();
  4372. snmm_extruder = extr;
  4373. pinMode(E_MUX0_PIN, OUTPUT);
  4374. pinMode(E_MUX1_PIN, OUTPUT);
  4375. switch (extr) {
  4376. case 1:
  4377. WRITE(E_MUX0_PIN, HIGH);
  4378. WRITE(E_MUX1_PIN, LOW);
  4379. break;
  4380. case 2:
  4381. WRITE(E_MUX0_PIN, LOW);
  4382. WRITE(E_MUX1_PIN, HIGH);
  4383. break;
  4384. case 3:
  4385. WRITE(E_MUX0_PIN, HIGH);
  4386. WRITE(E_MUX1_PIN, HIGH);
  4387. break;
  4388. default:
  4389. WRITE(E_MUX0_PIN, LOW);
  4390. WRITE(E_MUX1_PIN, LOW);
  4391. break;
  4392. }
  4393. delay(100);
  4394. }
  4395. static int get_ext_nr() { //reads multiplexer input pins and return current extruder number (counted from 0)
  4396. return(2 * READ(E_MUX1_PIN) + READ(E_MUX0_PIN));
  4397. }
  4398. void display_loading() {
  4399. switch (snmm_extruder) {
  4400. case 1: lcd_display_message_fullscreen_P(MSG_FILAMENT_LOADING_T1); break;
  4401. case 2: lcd_display_message_fullscreen_P(MSG_FILAMENT_LOADING_T2); break;
  4402. case 3: lcd_display_message_fullscreen_P(MSG_FILAMENT_LOADING_T3); break;
  4403. default: lcd_display_message_fullscreen_P(MSG_FILAMENT_LOADING_T0); break;
  4404. }
  4405. }
  4406. void extr_adj(int extruder) //loading filament for SNMM
  4407. {
  4408. bool correct;
  4409. max_feedrate[E_AXIS] =80;
  4410. //max_feedrate[E_AXIS] = 50;
  4411. START:
  4412. lcd_implementation_clear();
  4413. lcd.setCursor(0, 0);
  4414. switch (extruder) {
  4415. case 1: lcd_display_message_fullscreen_P(MSG_FILAMENT_LOADING_T1); break;
  4416. case 2: lcd_display_message_fullscreen_P(MSG_FILAMENT_LOADING_T2); break;
  4417. case 3: lcd_display_message_fullscreen_P(MSG_FILAMENT_LOADING_T3); break;
  4418. default: lcd_display_message_fullscreen_P(MSG_FILAMENT_LOADING_T0); break;
  4419. }
  4420. KEEPALIVE_STATE(PAUSED_FOR_USER);
  4421. do{
  4422. extr_mov(0.001,1000);
  4423. delay_keep_alive(2);
  4424. } while (!lcd_clicked());
  4425. //delay_keep_alive(500);
  4426. KEEPALIVE_STATE(IN_HANDLER);
  4427. st_synchronize();
  4428. //correct = lcd_show_fullscreen_message_yes_no_and_wait_P(MSG_FIL_LOADED_CHECK, false);
  4429. //if (!correct) goto START;
  4430. //extr_mov(BOWDEN_LENGTH/2.f, 500); //dividing by 2 is there because of max. extrusion length limitation (x_max + y_max)
  4431. //extr_mov(BOWDEN_LENGTH/2.f, 500);
  4432. extr_mov(bowden_length[extruder], 500);
  4433. lcd_implementation_clear();
  4434. lcd.setCursor(0, 0); lcd_printPGM(MSG_LOADING_FILAMENT);
  4435. if(strlen(MSG_LOADING_FILAMENT)>18) lcd.setCursor(0, 1);
  4436. else lcd.print(" ");
  4437. lcd.print(snmm_extruder + 1);
  4438. lcd.setCursor(0, 2); lcd_printPGM(MSG_PLEASE_WAIT);
  4439. st_synchronize();
  4440. max_feedrate[E_AXIS] = 50;
  4441. lcd_update_enable(true);
  4442. lcd_return_to_status();
  4443. lcdDrawUpdate = 2;
  4444. }
  4445. void extr_unload() { //unloads filament
  4446. float tmp_motor[3] = DEFAULT_PWM_MOTOR_CURRENT;
  4447. float tmp_motor_loud[3] = DEFAULT_PWM_MOTOR_CURRENT_LOUD;
  4448. uint8_t SilentMode = eeprom_read_byte((uint8_t*)EEPROM_SILENT);
  4449. if (degHotend0() > EXTRUDE_MINTEMP) {
  4450. lcd_implementation_clear();
  4451. lcd_display_message_fullscreen_P(PSTR(""));
  4452. max_feedrate[E_AXIS] = 50;
  4453. lcd.setCursor(0, 0); lcd_printPGM(MSG_UNLOADING_FILAMENT);
  4454. lcd.print(" ");
  4455. lcd.print(snmm_extruder + 1);
  4456. lcd.setCursor(0, 2); lcd_printPGM(MSG_PLEASE_WAIT);
  4457. if (current_position[Z_AXIS] < 15) {
  4458. current_position[Z_AXIS] += 15; //lifting in Z direction to make space for extrusion
  4459. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 25, active_extruder);
  4460. }
  4461. current_position[E_AXIS] += 10; //extrusion
  4462. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 10, active_extruder);
  4463. st_current_set(2, E_MOTOR_HIGH_CURRENT);
  4464. if (current_temperature[0] < 230) { //PLA & all other filaments
  4465. current_position[E_AXIS] += 5.4;
  4466. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 2800 / 60, active_extruder);
  4467. current_position[E_AXIS] += 3.2;
  4468. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 3000 / 60, active_extruder);
  4469. current_position[E_AXIS] += 3;
  4470. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 3400 / 60, active_extruder);
  4471. }
  4472. else { //ABS
  4473. current_position[E_AXIS] += 3.1;
  4474. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 2000 / 60, active_extruder);
  4475. current_position[E_AXIS] += 3.1;
  4476. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 2500 / 60, active_extruder);
  4477. current_position[E_AXIS] += 4;
  4478. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 3000 / 60, active_extruder);
  4479. /*current_position[X_AXIS] += 23; //delay
  4480. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 600 / 60, active_extruder); //delay
  4481. current_position[X_AXIS] -= 23; //delay
  4482. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 600 / 60, active_extruder); //delay*/
  4483. delay_keep_alive(4700);
  4484. }
  4485. max_feedrate[E_AXIS] = 80;
  4486. current_position[E_AXIS] -= (bowden_length[snmm_extruder] + 60 + FIL_LOAD_LENGTH) / 2;
  4487. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 500, active_extruder);
  4488. current_position[E_AXIS] -= (bowden_length[snmm_extruder] + 60 + FIL_LOAD_LENGTH) / 2;
  4489. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 500, active_extruder);
  4490. st_synchronize();
  4491. //st_current_init();
  4492. if (SilentMode != SILENT_MODE_OFF) st_current_set(2, tmp_motor[2]); //set back to normal operation currents
  4493. else st_current_set(2, tmp_motor_loud[2]);
  4494. lcd_update_enable(true);
  4495. lcd_return_to_status();
  4496. max_feedrate[E_AXIS] = 50;
  4497. }
  4498. else {
  4499. lcd_implementation_clear();
  4500. lcd.setCursor(0, 0);
  4501. lcd_printPGM(MSG_ERROR);
  4502. lcd.setCursor(0, 2);
  4503. lcd_printPGM(MSG_PREHEAT_NOZZLE);
  4504. delay(2000);
  4505. lcd_implementation_clear();
  4506. }
  4507. lcd_return_to_status();
  4508. }
  4509. //wrapper functions for loading filament
  4510. static void extr_adj_0(){
  4511. change_extr(0);
  4512. extr_adj(0);
  4513. }
  4514. static void extr_adj_1() {
  4515. change_extr(1);
  4516. extr_adj(1);
  4517. }
  4518. static void extr_adj_2() {
  4519. change_extr(2);
  4520. extr_adj(2);
  4521. }
  4522. static void extr_adj_3() {
  4523. change_extr(3);
  4524. extr_adj(3);
  4525. }
  4526. static void load_all() {
  4527. for (int i = 0; i < 4; i++) {
  4528. change_extr(i);
  4529. extr_adj(i);
  4530. }
  4531. }
  4532. //wrapper functions for changing extruders
  4533. static void extr_change_0() {
  4534. change_extr(0);
  4535. lcd_return_to_status();
  4536. }
  4537. static void extr_change_1() {
  4538. change_extr(1);
  4539. lcd_return_to_status();
  4540. }
  4541. static void extr_change_2() {
  4542. change_extr(2);
  4543. lcd_return_to_status();
  4544. }
  4545. static void extr_change_3() {
  4546. change_extr(3);
  4547. lcd_return_to_status();
  4548. }
  4549. //wrapper functions for unloading filament
  4550. void extr_unload_all() {
  4551. if (degHotend0() > EXTRUDE_MINTEMP) {
  4552. for (int i = 0; i < 4; i++) {
  4553. change_extr(i);
  4554. extr_unload();
  4555. }
  4556. }
  4557. else {
  4558. lcd_implementation_clear();
  4559. lcd.setCursor(0, 0);
  4560. lcd_printPGM(MSG_ERROR);
  4561. lcd.setCursor(0, 2);
  4562. lcd_printPGM(MSG_PREHEAT_NOZZLE);
  4563. delay(2000);
  4564. lcd_implementation_clear();
  4565. lcd_return_to_status();
  4566. }
  4567. }
  4568. //unloading just used filament (for snmm)
  4569. void extr_unload_used() {
  4570. if (degHotend0() > EXTRUDE_MINTEMP) {
  4571. for (int i = 0; i < 4; i++) {
  4572. if (snmm_filaments_used & (1 << i)) {
  4573. change_extr(i);
  4574. extr_unload();
  4575. }
  4576. }
  4577. snmm_filaments_used = 0;
  4578. }
  4579. else {
  4580. lcd_implementation_clear();
  4581. lcd.setCursor(0, 0);
  4582. lcd_printPGM(MSG_ERROR);
  4583. lcd.setCursor(0, 2);
  4584. lcd_printPGM(MSG_PREHEAT_NOZZLE);
  4585. delay(2000);
  4586. lcd_implementation_clear();
  4587. lcd_return_to_status();
  4588. }
  4589. }
  4590. static void extr_unload_0() {
  4591. change_extr(0);
  4592. extr_unload();
  4593. }
  4594. static void extr_unload_1() {
  4595. change_extr(1);
  4596. extr_unload();
  4597. }
  4598. static void extr_unload_2() {
  4599. change_extr(2);
  4600. extr_unload();
  4601. }
  4602. static void extr_unload_3() {
  4603. change_extr(3);
  4604. extr_unload();
  4605. }
  4606. static void fil_load_menu()
  4607. {
  4608. START_MENU();
  4609. MENU_ITEM(back, MSG_MAIN, 0);
  4610. MENU_ITEM(function, MSG_LOAD_ALL, load_all);
  4611. MENU_ITEM(function, MSG_LOAD_FILAMENT_1, extr_adj_0);
  4612. MENU_ITEM(function, MSG_LOAD_FILAMENT_2, extr_adj_1);
  4613. MENU_ITEM(function, MSG_LOAD_FILAMENT_3, extr_adj_2);
  4614. MENU_ITEM(function, MSG_LOAD_FILAMENT_4, extr_adj_3);
  4615. END_MENU();
  4616. }
  4617. static void fil_unload_menu()
  4618. {
  4619. START_MENU();
  4620. MENU_ITEM(back, MSG_MAIN, 0);
  4621. MENU_ITEM(function, MSG_UNLOAD_ALL, extr_unload_all);
  4622. MENU_ITEM(function, MSG_UNLOAD_FILAMENT_1, extr_unload_0);
  4623. MENU_ITEM(function, MSG_UNLOAD_FILAMENT_2, extr_unload_1);
  4624. MENU_ITEM(function, MSG_UNLOAD_FILAMENT_3, extr_unload_2);
  4625. MENU_ITEM(function, MSG_UNLOAD_FILAMENT_4, extr_unload_3);
  4626. END_MENU();
  4627. }
  4628. static void change_extr_menu(){
  4629. START_MENU();
  4630. MENU_ITEM(back, MSG_MAIN, 0);
  4631. MENU_ITEM(function, MSG_EXTRUDER_1, extr_change_0);
  4632. MENU_ITEM(function, MSG_EXTRUDER_2, extr_change_1);
  4633. MENU_ITEM(function, MSG_EXTRUDER_3, extr_change_2);
  4634. MENU_ITEM(function, MSG_EXTRUDER_4, extr_change_3);
  4635. END_MENU();
  4636. }
  4637. #endif
  4638. static void lcd_farm_no()
  4639. {
  4640. char step = 0;
  4641. int enc_dif = 0;
  4642. int _farmno = farm_no;
  4643. int _ret = 0;
  4644. lcd_implementation_clear();
  4645. lcd.setCursor(0, 0);
  4646. lcd.print("Farm no");
  4647. do
  4648. {
  4649. if (abs((enc_dif - encoderDiff)) > 2) {
  4650. if (enc_dif > encoderDiff) {
  4651. switch (step) {
  4652. case(0): if (_farmno >= 100) _farmno -= 100; break;
  4653. case(1): if (_farmno % 100 >= 10) _farmno -= 10; break;
  4654. case(2): if (_farmno % 10 >= 1) _farmno--; break;
  4655. default: break;
  4656. }
  4657. }
  4658. if (enc_dif < encoderDiff) {
  4659. switch (step) {
  4660. case(0): if (_farmno < 900) _farmno += 100; break;
  4661. case(1): if (_farmno % 100 < 90) _farmno += 10; break;
  4662. case(2): if (_farmno % 10 <= 8)_farmno++; break;
  4663. default: break;
  4664. }
  4665. }
  4666. enc_dif = 0;
  4667. encoderDiff = 0;
  4668. }
  4669. lcd.setCursor(0, 2);
  4670. if (_farmno < 100) lcd.print("0");
  4671. if (_farmno < 10) lcd.print("0");
  4672. lcd.print(_farmno);
  4673. lcd.print(" ");
  4674. lcd.setCursor(0, 3);
  4675. lcd.print(" ");
  4676. lcd.setCursor(step, 3);
  4677. lcd.print("^");
  4678. delay(100);
  4679. if (lcd_clicked())
  4680. {
  4681. delay(200);
  4682. step++;
  4683. if(step == 3) {
  4684. _ret = 1;
  4685. farm_no = _farmno;
  4686. EEPROM_save_B(EEPROM_FARM_NUMBER, &farm_no);
  4687. prusa_statistics(20);
  4688. lcd_return_to_status();
  4689. }
  4690. }
  4691. manage_heater();
  4692. } while (_ret == 0);
  4693. }
  4694. unsigned char lcd_choose_color() {
  4695. //function returns index of currently chosen item
  4696. //following part can be modified from 2 to 255 items:
  4697. //-----------------------------------------------------
  4698. unsigned char items_no = 2;
  4699. const char *item[items_no];
  4700. item[0] = "Orange";
  4701. item[1] = "Black";
  4702. //-----------------------------------------------------
  4703. unsigned char active_rows;
  4704. static int first = 0;
  4705. int enc_dif = 0;
  4706. unsigned char cursor_pos = 1;
  4707. enc_dif = encoderDiff;
  4708. lcd_implementation_clear();
  4709. lcd.setCursor(0, 1);
  4710. lcd.print(">");
  4711. active_rows = items_no < 3 ? items_no : 3;
  4712. while (1) {
  4713. lcd_print_at_PGM(0, 0, PSTR("Choose color:"));
  4714. for (int i = 0; i < active_rows; i++) {
  4715. lcd.setCursor(1, i+1);
  4716. lcd.print(item[first + i]);
  4717. }
  4718. manage_heater();
  4719. manage_inactivity(true);
  4720. proc_commands();
  4721. if (abs((enc_dif - encoderDiff)) > 12) {
  4722. if (enc_dif > encoderDiff) {
  4723. cursor_pos--;
  4724. }
  4725. if (enc_dif < encoderDiff) {
  4726. cursor_pos++;
  4727. }
  4728. if (cursor_pos > active_rows) {
  4729. cursor_pos = active_rows;
  4730. if (first < items_no - active_rows) {
  4731. first++;
  4732. lcd_implementation_clear();
  4733. }
  4734. }
  4735. if (cursor_pos < 1) {
  4736. cursor_pos = 1;
  4737. if (first > 0) {
  4738. first--;
  4739. lcd_implementation_clear();
  4740. }
  4741. }
  4742. lcd.setCursor(0, 1);
  4743. lcd.print(" ");
  4744. lcd.setCursor(0, 2);
  4745. lcd.print(" ");
  4746. lcd.setCursor(0, 3);
  4747. lcd.print(" ");
  4748. lcd.setCursor(0, cursor_pos);
  4749. lcd.print(">");
  4750. enc_dif = encoderDiff;
  4751. delay(100);
  4752. }
  4753. if (lcd_clicked()) {
  4754. while (lcd_clicked());
  4755. delay(10);
  4756. while (lcd_clicked());
  4757. switch(cursor_pos + first - 1) {
  4758. case 0: return 1; break;
  4759. case 1: return 0; break;
  4760. default: return 99; break;
  4761. }
  4762. }
  4763. }
  4764. }
  4765. void lcd_confirm_print()
  4766. {
  4767. uint8_t filament_type;
  4768. int enc_dif = 0;
  4769. int cursor_pos = 1;
  4770. int _ret = 0;
  4771. int _t = 0;
  4772. enc_dif = encoderDiff;
  4773. lcd_implementation_clear();
  4774. lcd.setCursor(0, 0);
  4775. lcd.print("Print ok ?");
  4776. do
  4777. {
  4778. if (abs(enc_dif - encoderDiff) > 12) {
  4779. if (enc_dif > encoderDiff) {
  4780. cursor_pos--;
  4781. }
  4782. if (enc_dif < encoderDiff) {
  4783. cursor_pos++;
  4784. }
  4785. enc_dif = encoderDiff;
  4786. }
  4787. if (cursor_pos > 2) { cursor_pos = 2; }
  4788. if (cursor_pos < 1) { cursor_pos = 1; }
  4789. lcd.setCursor(0, 2); lcd.print(" ");
  4790. lcd.setCursor(0, 3); lcd.print(" ");
  4791. lcd.setCursor(2, 2);
  4792. lcd_printPGM(MSG_YES);
  4793. lcd.setCursor(2, 3);
  4794. lcd_printPGM(MSG_NO);
  4795. lcd.setCursor(0, 1 + cursor_pos);
  4796. lcd.print(">");
  4797. delay(100);
  4798. _t = _t + 1;
  4799. if (_t>100)
  4800. {
  4801. prusa_statistics(99);
  4802. _t = 0;
  4803. }
  4804. if (lcd_clicked())
  4805. {
  4806. if (cursor_pos == 1)
  4807. {
  4808. _ret = 1;
  4809. filament_type = lcd_choose_color();
  4810. prusa_statistics(4, filament_type);
  4811. no_response = true; //we need confirmation by recieving PRUSA thx
  4812. important_status = 4;
  4813. saved_filament_type = filament_type;
  4814. NcTime = millis();
  4815. }
  4816. if (cursor_pos == 2)
  4817. {
  4818. _ret = 2;
  4819. filament_type = lcd_choose_color();
  4820. prusa_statistics(5, filament_type);
  4821. no_response = true; //we need confirmation by recieving PRUSA thx
  4822. important_status = 5;
  4823. saved_filament_type = filament_type;
  4824. NcTime = millis();
  4825. }
  4826. }
  4827. manage_heater();
  4828. manage_inactivity();
  4829. proc_commands();
  4830. } while (_ret == 0);
  4831. }
  4832. extern bool saved_printing;
  4833. static void lcd_main_menu()
  4834. {
  4835. SDscrool = 0;
  4836. START_MENU();
  4837. // Majkl superawesome menu
  4838. MENU_ITEM(back, MSG_WATCH, 0);
  4839. #ifdef RESUME_DEBUG
  4840. if (!saved_printing)
  4841. MENU_ITEM(function, PSTR("tst - Save"), lcd_menu_test_save);
  4842. else
  4843. MENU_ITEM(function, PSTR("tst - Restore"), lcd_menu_test_restore);
  4844. #endif //RESUME_DEBUG
  4845. #ifdef TMC2130_DEBUG
  4846. MENU_ITEM(function, PSTR("recover print"), recover_print);
  4847. MENU_ITEM(function, PSTR("power panic"), uvlo_);
  4848. #endif //TMC2130_DEBUG
  4849. /* if (farm_mode && !IS_SD_PRINTING )
  4850. {
  4851. int tempScrool = 0;
  4852. if (lcdDrawUpdate == 0 && LCD_CLICKED == 0)
  4853. //delay(100);
  4854. return; // nothing to do (so don't thrash the SD card)
  4855. uint16_t fileCnt = card.getnrfilenames();
  4856. card.getWorkDirName();
  4857. if (card.filename[0] == '/')
  4858. {
  4859. #if SDCARDDETECT == -1
  4860. MENU_ITEM(function, MSG_REFRESH, lcd_sd_refresh);
  4861. #endif
  4862. } else {
  4863. MENU_ITEM(function, PSTR(LCD_STR_FOLDER ".."), lcd_sd_updir);
  4864. }
  4865. for (uint16_t i = 0; i < fileCnt; i++)
  4866. {
  4867. if (_menuItemNr == _lineNr)
  4868. {
  4869. #ifndef SDCARD_RATHERRECENTFIRST
  4870. card.getfilename(i);
  4871. #else
  4872. card.getfilename(fileCnt - 1 - i);
  4873. #endif
  4874. if (card.filenameIsDir)
  4875. {
  4876. MENU_ITEM(sddirectory, MSG_CARD_MENU, card.filename, card.longFilename);
  4877. } else {
  4878. MENU_ITEM(sdfile, MSG_CARD_MENU, card.filename, card.longFilename);
  4879. }
  4880. } else {
  4881. MENU_ITEM_DUMMY();
  4882. }
  4883. }
  4884. MENU_ITEM(back, PSTR("- - - - - - - - -"), 0);
  4885. }*/
  4886. if ( ( IS_SD_PRINTING || is_usb_printing || (lcd_commands_type == LCD_COMMAND_V2_CAL)) && (current_position[Z_AXIS] < Z_HEIGHT_HIDE_LIVE_ADJUST_MENU) && !homing_flag && !mesh_bed_leveling_flag)
  4887. {
  4888. MENU_ITEM(submenu, MSG_BABYSTEP_Z, lcd_babystep_z);//8
  4889. }
  4890. if ( moves_planned() || IS_SD_PRINTING || is_usb_printing || (lcd_commands_type == LCD_COMMAND_V2_CAL))
  4891. {
  4892. MENU_ITEM(submenu, MSG_TUNE, lcd_tune_menu);
  4893. } else
  4894. {
  4895. MENU_ITEM(submenu, MSG_PREHEAT, lcd_preheat_menu);
  4896. }
  4897. #ifdef SDSUPPORT
  4898. if (card.cardOK || lcd_commands_type == LCD_COMMAND_V2_CAL)
  4899. {
  4900. if (card.isFileOpen())
  4901. {
  4902. if (mesh_bed_leveling_flag == false && homing_flag == false) {
  4903. if (card.sdprinting)
  4904. {
  4905. MENU_ITEM(function, MSG_PAUSE_PRINT, lcd_sdcard_pause);
  4906. }
  4907. else
  4908. {
  4909. MENU_ITEM(function, MSG_RESUME_PRINT, lcd_sdcard_resume);
  4910. }
  4911. MENU_ITEM(submenu, MSG_STOP_PRINT, lcd_sdcard_stop);
  4912. }
  4913. }
  4914. else if (lcd_commands_type == LCD_COMMAND_V2_CAL && mesh_bed_leveling_flag == false && homing_flag == false) {
  4915. //MENU_ITEM(submenu, MSG_STOP_PRINT, lcd_sdcard_stop);
  4916. }
  4917. else
  4918. {
  4919. if (!is_usb_printing && (lcd_commands_type != LCD_COMMAND_V2_CAL))
  4920. {
  4921. //if (farm_mode) MENU_ITEM(submenu, MSG_FARM_CARD_MENU, lcd_farm_sdcard_menu);
  4922. /*else*/ MENU_ITEM(submenu, MSG_CARD_MENU, lcd_sdcard_menu);
  4923. }
  4924. #if SDCARDDETECT < 1
  4925. MENU_ITEM(gcode, MSG_CNG_SDCARD, PSTR("M21")); // SD-card changed by user
  4926. #endif
  4927. }
  4928. } else
  4929. {
  4930. MENU_ITEM(submenu, MSG_NO_CARD, lcd_sdcard_menu);
  4931. #if SDCARDDETECT < 1
  4932. MENU_ITEM(gcode, MSG_INIT_SDCARD, PSTR("M21")); // Manually initialize the SD-card via user interface
  4933. #endif
  4934. }
  4935. #endif
  4936. if (IS_SD_PRINTING || is_usb_printing || (lcd_commands_type == LCD_COMMAND_V2_CAL))
  4937. {
  4938. if (farm_mode)
  4939. {
  4940. MENU_ITEM(submenu, PSTR("Farm number"), lcd_farm_no);
  4941. }
  4942. }
  4943. else
  4944. {
  4945. #ifndef SNMM
  4946. #ifdef PAT9125
  4947. if ( ((filament_autoload_enabled == true) && (fsensor_enabled == true)))
  4948. MENU_ITEM(submenu, MSG_AUTOLOAD_FILAMENT, lcd_menu_AutoLoadFilament);
  4949. else
  4950. #endif //PAT9125
  4951. MENU_ITEM(function, MSG_LOAD_FILAMENT, lcd_LoadFilament);
  4952. MENU_ITEM(submenu, MSG_UNLOAD_FILAMENT, lcd_unLoadFilament);
  4953. #endif
  4954. #ifdef SNMM
  4955. MENU_ITEM(submenu, MSG_LOAD_FILAMENT, fil_load_menu);
  4956. MENU_ITEM(submenu, MSG_UNLOAD_FILAMENT, fil_unload_menu);
  4957. MENU_ITEM(submenu, MSG_CHANGE_EXTR, change_extr_menu);
  4958. #endif
  4959. MENU_ITEM(submenu, MSG_SETTINGS, lcd_settings_menu);
  4960. if(!isPrintPaused) MENU_ITEM(submenu, MSG_MENU_CALIBRATION, lcd_calibration_menu);
  4961. #ifdef EXPERIMENTAL_FEATURES
  4962. MENU_ITEM(submenu, PSTR("Experimantal"), lcd_experimantal_menu);
  4963. #endif //EXPERIMENTAL_FEATURES
  4964. }
  4965. if (!is_usb_printing && (lcd_commands_type != LCD_COMMAND_V2_CAL))
  4966. {
  4967. MENU_ITEM(submenu, MSG_STATISTICS, lcd_menu_statistics);
  4968. }
  4969. #if defined(TMC2130) || defined(PAT9125)
  4970. MENU_ITEM(submenu, PSTR("Fail stats"), lcd_menu_fails_stats);
  4971. #endif
  4972. MENU_ITEM(submenu, MSG_SUPPORT, lcd_support_menu);
  4973. END_MENU();
  4974. }
  4975. void stack_error() {
  4976. SET_OUTPUT(BEEPER);
  4977. WRITE(BEEPER, HIGH);
  4978. delay(1000);
  4979. WRITE(BEEPER, LOW);
  4980. lcd_display_message_fullscreen_P(MSG_STACK_ERROR);
  4981. //err_triggered = 1;
  4982. while (1) delay_keep_alive(1000);
  4983. }
  4984. #ifdef DEBUG_STEPPER_TIMER_MISSED
  4985. bool stepper_timer_overflow_state = false;
  4986. uint16_t stepper_timer_overflow_max = 0;
  4987. uint16_t stepper_timer_overflow_last = 0;
  4988. uint16_t stepper_timer_overflow_cnt = 0;
  4989. void stepper_timer_overflow() {
  4990. char msg[28];
  4991. sprintf_P(msg, PSTR("#%d %d max %d"), ++ stepper_timer_overflow_cnt, stepper_timer_overflow_last >> 1, stepper_timer_overflow_max >> 1);
  4992. lcd_setstatus(msg);
  4993. stepper_timer_overflow_state = false;
  4994. if (stepper_timer_overflow_last > stepper_timer_overflow_max)
  4995. stepper_timer_overflow_max = stepper_timer_overflow_last;
  4996. SERIAL_ECHOPGM("Stepper timer overflow: ");
  4997. MYSERIAL.print(msg);
  4998. SERIAL_ECHOLNPGM("");
  4999. WRITE(BEEPER, LOW);
  5000. }
  5001. #endif /* DEBUG_STEPPER_TIMER_MISSED */
  5002. #ifdef SDSUPPORT
  5003. static void lcd_autostart_sd()
  5004. {
  5005. card.lastnr = 0;
  5006. card.setroot();
  5007. card.checkautostart(true);
  5008. }
  5009. #endif
  5010. static void lcd_silent_mode_set_tune() {
  5011. switch (SilentModeMenu) {
  5012. #ifdef TMC2130
  5013. case SILENT_MODE_NORMAL: SilentModeMenu = SILENT_MODE_STEALTH; break;
  5014. case SILENT_MODE_STEALTH: SilentModeMenu = SILENT_MODE_NORMAL; break;
  5015. default: SilentModeMenu = SILENT_MODE_NORMAL; break; // (probably) not needed
  5016. #else
  5017. case SILENT_MODE_POWER: SilentModeMenu = SILENT_MODE_SILENT; break;
  5018. case SILENT_MODE_SILENT: SilentModeMenu = SILENT_MODE_AUTO; break;
  5019. case SILENT_MODE_AUTO: SilentModeMenu = SILENT_MODE_POWER; break;
  5020. default: SilentModeMenu = SILENT_MODE_POWER; break; // (probably) not needed
  5021. #endif //TMC2130
  5022. }
  5023. eeprom_update_byte((unsigned char *)EEPROM_SILENT, SilentModeMenu);
  5024. st_current_init();
  5025. menu_action_back();
  5026. }
  5027. static void lcd_colorprint_change() {
  5028. enquecommand_P(PSTR("M600"));
  5029. custom_message = true;
  5030. custom_message_type = 2; //just print status message
  5031. lcd_setstatuspgm(MSG_FINISHING_MOVEMENTS);
  5032. lcd_return_to_status();
  5033. lcdDrawUpdate = 3;
  5034. }
  5035. static void lcd_tune_menu()
  5036. {
  5037. if (menuData.tuneMenu.status == 0) {
  5038. // Menu was entered. Mark the menu as entered and save the current extrudemultiply value.
  5039. menuData.tuneMenu.status = 1;
  5040. menuData.tuneMenu.extrudemultiply = extrudemultiply;
  5041. } else if (menuData.tuneMenu.extrudemultiply != extrudemultiply) {
  5042. // extrudemultiply has been changed from the child menu. Apply the new value.
  5043. menuData.tuneMenu.extrudemultiply = extrudemultiply;
  5044. calculate_extruder_multipliers();
  5045. }
  5046. EEPROM_read(EEPROM_SILENT, (uint8_t*)&SilentModeMenu, sizeof(SilentModeMenu));
  5047. START_MENU();
  5048. MENU_ITEM(back, MSG_MAIN, 0); //1
  5049. MENU_ITEM_EDIT(int3, MSG_SPEED, &feedmultiply, 10, 999);//2
  5050. MENU_ITEM_EDIT(int3, MSG_NOZZLE, &target_temperature[0], 0, HEATER_0_MAXTEMP - 10);//3
  5051. MENU_ITEM_EDIT(int3, MSG_BED, &target_temperature_bed, 0, BED_MAXTEMP - 10);//4
  5052. MENU_ITEM_EDIT(int3, MSG_FAN_SPEED, &fanSpeed, 0, 255);//5
  5053. MENU_ITEM_EDIT(int3, MSG_FLOW, &extrudemultiply, 10, 999);//6
  5054. #ifdef FILAMENTCHANGEENABLE
  5055. MENU_ITEM(function, MSG_FILAMENTCHANGE, lcd_colorprint_change);//7
  5056. #endif
  5057. #ifndef DEBUG_DISABLE_FSENSORCHECK
  5058. #ifdef PAT9125
  5059. if (FSensorStateMenu == 0) {
  5060. MENU_ITEM(function, MSG_FSENSOR_OFF, lcd_fsensor_state_set);
  5061. }
  5062. else {
  5063. MENU_ITEM(function, MSG_FSENSOR_ON, lcd_fsensor_state_set);
  5064. }
  5065. #endif //PAT9125
  5066. #endif //DEBUG_DISABLE_FSENSORCHECK
  5067. #ifdef TMC2130
  5068. if(!farm_mode)
  5069. {
  5070. //*** MaR::180416_01b
  5071. if (SilentModeMenu == SILENT_MODE_NORMAL) MENU_ITEM(function, MSG_STEALTH_MODE_OFF, lcd_silent_mode_set);
  5072. else MENU_ITEM(function, MSG_STEALTH_MODE_ON, lcd_silent_mode_set);
  5073. if (SilentModeMenu == SILENT_MODE_NORMAL)
  5074. {
  5075. if (CrashDetectMenu == 0) MENU_ITEM(function, MSG_CRASHDETECT_OFF, lcd_crash_mode_set);
  5076. else MENU_ITEM(function, MSG_CRASHDETECT_ON, lcd_crash_mode_set);
  5077. }
  5078. else MENU_ITEM(submenu, MSG_CRASHDETECT_NA, lcd_crash_mode_info);
  5079. }
  5080. #else //TMC2130
  5081. if (!farm_mode) { //dont show in menu if we are in farm mode
  5082. switch (SilentModeMenu) {
  5083. case SILENT_MODE_POWER: MENU_ITEM(function, MSG_SILENT_MODE_OFF, lcd_silent_mode_set); break;
  5084. case SILENT_MODE_SILENT: MENU_ITEM(function, MSG_SILENT_MODE_ON, lcd_silent_mode_set); break;
  5085. case SILENT_MODE_AUTO: MENU_ITEM(function, MSG_AUTO_MODE_ON, lcd_silent_mode_set); break;
  5086. default: MENU_ITEM(function, MSG_SILENT_MODE_OFF, lcd_silent_mode_set); break; // (probably) not needed
  5087. }
  5088. }
  5089. #endif //TMC2130
  5090. END_MENU();
  5091. }
  5092. static void lcd_move_menu_01mm()
  5093. {
  5094. move_menu_scale = 0.1;
  5095. lcd_move_menu_axis();
  5096. }
  5097. static void lcd_control_temperature_menu()
  5098. {
  5099. #ifdef PIDTEMP
  5100. // set up temp variables - undo the default scaling
  5101. // raw_Ki = unscalePID_i(Ki);
  5102. // raw_Kd = unscalePID_d(Kd);
  5103. #endif
  5104. START_MENU();
  5105. MENU_ITEM(back, MSG_SETTINGS, 0);
  5106. #if TEMP_SENSOR_0 != 0
  5107. MENU_ITEM_EDIT(int3, MSG_NOZZLE, &target_temperature[0], 0, HEATER_0_MAXTEMP - 10);
  5108. #endif
  5109. #if TEMP_SENSOR_1 != 0
  5110. MENU_ITEM_EDIT(int3, MSG_NOZZLE1, &target_temperature[1], 0, HEATER_1_MAXTEMP - 10);
  5111. #endif
  5112. #if TEMP_SENSOR_2 != 0
  5113. MENU_ITEM_EDIT(int3, MSG_NOZZLE2, &target_temperature[2], 0, HEATER_2_MAXTEMP - 10);
  5114. #endif
  5115. #if TEMP_SENSOR_BED != 0
  5116. MENU_ITEM_EDIT(int3, MSG_BED, &target_temperature_bed, 0, BED_MAXTEMP - 3);
  5117. #endif
  5118. MENU_ITEM_EDIT(int3, MSG_FAN_SPEED, &fanSpeed, 0, 255);
  5119. #if defined AUTOTEMP && (TEMP_SENSOR_0 != 0)
  5120. MENU_ITEM_EDIT(bool, MSG_AUTOTEMP, &autotemp_enabled);
  5121. MENU_ITEM_EDIT(float3, MSG_MIN, &autotemp_min, 0, HEATER_0_MAXTEMP - 10);
  5122. MENU_ITEM_EDIT(float3, MSG_MAX, &autotemp_max, 0, HEATER_0_MAXTEMP - 10);
  5123. MENU_ITEM_EDIT(float32, MSG_FACTOR, &autotemp_factor, 0.0, 1.0);
  5124. #endif
  5125. END_MENU();
  5126. }
  5127. #if SDCARDDETECT == -1
  5128. static void lcd_sd_refresh()
  5129. {
  5130. card.initsd();
  5131. currentMenuViewOffset = 0;
  5132. }
  5133. #endif
  5134. static void lcd_sd_updir()
  5135. {
  5136. SDscrool = 0;
  5137. card.updir();
  5138. currentMenuViewOffset = 0;
  5139. }
  5140. void lcd_print_stop() {
  5141. cancel_heatup = true;
  5142. #ifdef MESH_BED_LEVELING
  5143. mbl.active = false;
  5144. #endif
  5145. // Stop the stoppers, update the position from the stoppers.
  5146. if (mesh_bed_leveling_flag == false && homing_flag == false) {
  5147. planner_abort_hard();
  5148. // Because the planner_abort_hard() initialized current_position[Z] from the stepper,
  5149. // Z baystep is no more applied. Reset it.
  5150. babystep_reset();
  5151. }
  5152. // Clean the input command queue.
  5153. cmdqueue_reset();
  5154. lcd_setstatuspgm(MSG_PRINT_ABORTED);
  5155. lcd_update(2);
  5156. card.sdprinting = false;
  5157. card.closefile();
  5158. stoptime = millis();
  5159. unsigned long t = (stoptime - starttime - pause_time) / 1000; //time in s
  5160. pause_time = 0;
  5161. save_statistics(total_filament_used, t);
  5162. lcd_return_to_status();
  5163. lcd_ignore_click(true);
  5164. lcd_commands_step = 0;
  5165. lcd_commands_type = LCD_COMMAND_STOP_PRINT;
  5166. // Turn off the print fan
  5167. SET_OUTPUT(FAN_PIN);
  5168. WRITE(FAN_PIN, 0);
  5169. fanSpeed = 0;
  5170. }
  5171. void lcd_sdcard_stop()
  5172. {
  5173. lcd.setCursor(0, 0);
  5174. lcd_printPGM(MSG_STOP_PRINT);
  5175. lcd.setCursor(2, 2);
  5176. lcd_printPGM(MSG_NO);
  5177. lcd.setCursor(2, 3);
  5178. lcd_printPGM(MSG_YES);
  5179. lcd.setCursor(0, 2); lcd.print(" ");
  5180. lcd.setCursor(0, 3); lcd.print(" ");
  5181. if ((int32_t)encoderPosition > 2) { encoderPosition = 2; }
  5182. if ((int32_t)encoderPosition < 1) { encoderPosition = 1; }
  5183. lcd.setCursor(0, 1 + encoderPosition);
  5184. lcd.print(">");
  5185. if (lcd_clicked())
  5186. {
  5187. if ((int32_t)encoderPosition == 1)
  5188. {
  5189. lcd_return_to_status();
  5190. }
  5191. if ((int32_t)encoderPosition == 2)
  5192. {
  5193. lcd_print_stop();
  5194. }
  5195. }
  5196. }
  5197. /*
  5198. void getFileDescription(char *name, char *description) {
  5199. // get file description, ie the REAL filenam, ie the second line
  5200. card.openFile(name, true);
  5201. int i = 0;
  5202. // skip the first line (which is the version line)
  5203. while (true) {
  5204. uint16_t readByte = card.get();
  5205. if (readByte == '\n') {
  5206. break;
  5207. }
  5208. }
  5209. // read the second line (which is the description line)
  5210. while (true) {
  5211. uint16_t readByte = card.get();
  5212. if (i == 0) {
  5213. // skip the first '^'
  5214. readByte = card.get();
  5215. }
  5216. description[i] = readByte;
  5217. i++;
  5218. if (readByte == '\n') {
  5219. break;
  5220. }
  5221. }
  5222. card.closefile();
  5223. description[i-1] = 0;
  5224. }
  5225. */
  5226. void lcd_sdcard_menu()
  5227. {
  5228. uint8_t sdSort = eeprom_read_byte((uint8_t*)EEPROM_SD_SORT);
  5229. int tempScrool = 0;
  5230. if (presort_flag == true) {
  5231. presort_flag = false;
  5232. card.presort();
  5233. }
  5234. if (lcdDrawUpdate == 0 && LCD_CLICKED == 0)
  5235. //delay(100);
  5236. return; // nothing to do (so don't thrash the SD card)
  5237. uint16_t fileCnt = card.getnrfilenames();
  5238. START_MENU();
  5239. MENU_ITEM(back, MSG_MAIN, 0);
  5240. card.getWorkDirName();
  5241. if (card.filename[0] == '/')
  5242. {
  5243. #if SDCARDDETECT == -1
  5244. MENU_ITEM(function, MSG_REFRESH, lcd_sd_refresh);
  5245. #endif
  5246. } else {
  5247. MENU_ITEM(function, PSTR(LCD_STR_FOLDER ".."), lcd_sd_updir);
  5248. }
  5249. for (uint16_t i = 0; i < fileCnt; i++)
  5250. {
  5251. if (_menuItemNr == _lineNr)
  5252. {
  5253. const uint16_t nr = ((sdSort == SD_SORT_NONE) || farm_mode || (sdSort == SD_SORT_TIME)) ? (fileCnt - 1 - i) : i;
  5254. /*#ifdef SDCARD_RATHERRECENTFIRST
  5255. #ifndef SDCARD_SORT_ALPHA
  5256. fileCnt - 1 -
  5257. #endif
  5258. #endif
  5259. i;*/
  5260. #ifdef SDCARD_SORT_ALPHA
  5261. if (sdSort == SD_SORT_NONE) card.getfilename(nr);
  5262. else card.getfilename_sorted(nr);
  5263. #else
  5264. card.getfilename(nr);
  5265. #endif
  5266. if (card.filenameIsDir)
  5267. MENU_ITEM(sddirectory, MSG_CARD_MENU, card.filename, card.longFilename);
  5268. else
  5269. MENU_ITEM(sdfile, MSG_CARD_MENU, card.filename, card.longFilename);
  5270. } else {
  5271. MENU_ITEM_DUMMY();
  5272. }
  5273. }
  5274. END_MENU();
  5275. }
  5276. //char description [10] [31];
  5277. /*void get_description() {
  5278. uint16_t fileCnt = card.getnrfilenames();
  5279. for (uint16_t i = 0; i < fileCnt; i++)
  5280. {
  5281. card.getfilename(fileCnt - 1 - i);
  5282. getFileDescription(card.filename, description[i]);
  5283. }
  5284. }*/
  5285. /*void lcd_farm_sdcard_menu()
  5286. {
  5287. static int i = 0;
  5288. if (i == 0) {
  5289. get_description();
  5290. i++;
  5291. }
  5292. //int j;
  5293. //char description[31];
  5294. int tempScrool = 0;
  5295. if (lcdDrawUpdate == 0 && LCD_CLICKED == 0)
  5296. //delay(100);
  5297. return; // nothing to do (so don't thrash the SD card)
  5298. uint16_t fileCnt = card.getnrfilenames();
  5299. START_MENU();
  5300. MENU_ITEM(back, MSG_MAIN, 0);
  5301. card.getWorkDirName();
  5302. if (card.filename[0] == '/')
  5303. {
  5304. #if SDCARDDETECT == -1
  5305. MENU_ITEM(function, MSG_REFRESH, lcd_sd_refresh);
  5306. #endif
  5307. }
  5308. else {
  5309. MENU_ITEM(function, PSTR(LCD_STR_FOLDER ".."), lcd_sd_updir);
  5310. }
  5311. for (uint16_t i = 0; i < fileCnt; i++)
  5312. {
  5313. if (_menuItemNr == _lineNr)
  5314. {
  5315. #ifndef SDCARD_RATHERRECENTFIRST
  5316. card.getfilename(i);
  5317. #else
  5318. card.getfilename(fileCnt - 1 - i);
  5319. #endif
  5320. if (card.filenameIsDir)
  5321. {
  5322. MENU_ITEM(sddirectory, MSG_CARD_MENU, card.filename, card.longFilename);
  5323. }
  5324. else {
  5325. MENU_ITEM(sdfile, MSG_CARD_MENU, card.filename, description[i]);
  5326. }
  5327. }
  5328. else {
  5329. MENU_ITEM_DUMMY();
  5330. }
  5331. }
  5332. END_MENU();
  5333. }*/
  5334. #define menu_edit_type(_type, _name, _strFunc, scale) \
  5335. void menu_edit_ ## _name () \
  5336. { \
  5337. if ((int32_t)encoderPosition < 0) encoderPosition = 0; \
  5338. if ((int32_t)encoderPosition > menuData.editMenuParentState.maxEditValue) encoderPosition = menuData.editMenuParentState.maxEditValue; \
  5339. if (lcdDrawUpdate) \
  5340. lcd_implementation_drawedit(menuData.editMenuParentState.editLabel, _strFunc(((_type)((int32_t)encoderPosition + menuData.editMenuParentState.minEditValue)) / scale)); \
  5341. if (LCD_CLICKED) \
  5342. { \
  5343. *((_type*)menuData.editMenuParentState.editValue) = ((_type)((int32_t)encoderPosition + menuData.editMenuParentState.minEditValue)) / scale; \
  5344. lcd_goto_menu(menuData.editMenuParentState.prevMenu, menuData.editMenuParentState.prevEncoderPosition, true, false); \
  5345. } \
  5346. } \
  5347. static void menu_action_setting_edit_ ## _name (const char* pstr, _type* ptr, _type minValue, _type maxValue) \
  5348. { \
  5349. asm("cli"); \
  5350. menuData.editMenuParentState.prevMenu = currentMenu; \
  5351. menuData.editMenuParentState.prevEncoderPosition = encoderPosition; \
  5352. asm("sei"); \
  5353. \
  5354. lcdDrawUpdate = 2; \
  5355. menuData.editMenuParentState.editLabel = pstr; \
  5356. menuData.editMenuParentState.editValue = ptr; \
  5357. menuData.editMenuParentState.minEditValue = minValue * scale; \
  5358. menuData.editMenuParentState.maxEditValue = maxValue * scale - menuData.editMenuParentState.minEditValue; \
  5359. lcd_goto_menu(menu_edit_ ## _name, (*ptr) * scale - menuData.editMenuParentState.minEditValue, true, false); \
  5360. \
  5361. }\
  5362. /*
  5363. void menu_edit_callback_ ## _name () { \
  5364. menu_edit_ ## _name (); \
  5365. if (LCD_CLICKED) (*callbackFunc)(); \
  5366. } \
  5367. static void menu_action_setting_edit_callback_ ## _name (const char* pstr, _type* ptr, _type minValue, _type maxValue, menuFunc_t callback) \
  5368. { \
  5369. menuData.editMenuParentState.prevMenu = currentMenu; \
  5370. menuData.editMenuParentState.prevEncoderPosition = encoderPosition; \
  5371. \
  5372. lcdDrawUpdate = 2; \
  5373. lcd_goto_menu(menu_edit_callback_ ## _name, (*ptr) * scale - menuData.editMenuParentState.minEditValue, true, false); \
  5374. \
  5375. menuData.editMenuParentState.editLabel = pstr; \
  5376. menuData.editMenuParentState.editValue = ptr; \
  5377. menuData.editMenuParentState.minEditValue = minValue * scale; \
  5378. menuData.editMenuParentState.maxEditValue = maxValue * scale - menuData.editMenuParentState.minEditValue; \
  5379. callbackFunc = callback;\
  5380. }
  5381. */
  5382. #ifdef TMC2130
  5383. extern char conv[8];
  5384. // Convert tmc2130 mres to string
  5385. char *mres_to_str3(const uint8_t &x)
  5386. {
  5387. return itostr3(256 >> x);
  5388. }
  5389. menu_edit_type(uint8_t, mres, mres_to_str3, 1)
  5390. // Convert tmc2130 wfac to string
  5391. char *wfac_to_str5(const uint8_t &x)
  5392. {
  5393. if (x >= TMC2130_WAVE_FAC1000_MIN)
  5394. {
  5395. conv[0] = '[';
  5396. ftostr43(((float)((uint16_t)x + 1000) / 1000), 1);
  5397. }
  5398. else strcpy_P(conv, MSG_EXTRUDER_CORRECTION_OFF);
  5399. conv[6] = ']';
  5400. conv[7] = ' ';
  5401. conv[8] = 0;
  5402. return conv;
  5403. }
  5404. menu_edit_type(uint8_t, wfac, wfac_to_str5, 1)
  5405. #endif //TMC2130
  5406. menu_edit_type(uint8_t, byte3, itostr3, 1)
  5407. menu_edit_type(int, int3, itostr3, 1)
  5408. menu_edit_type(float, float3, ftostr3, 1)
  5409. menu_edit_type(float, float32, ftostr32, 100)
  5410. menu_edit_type(float, float43, ftostr43, 1000)
  5411. menu_edit_type(float, float5, ftostr5, 0.01)
  5412. menu_edit_type(float, float51, ftostr51, 10)
  5413. menu_edit_type(float, float52, ftostr52, 100)
  5414. menu_edit_type(unsigned long, long5, ftostr5, 0.01)
  5415. static void lcd_selftest_v()
  5416. {
  5417. (void)lcd_selftest();
  5418. }
  5419. bool lcd_selftest()
  5420. {
  5421. int _progress = 0;
  5422. bool _result = true;
  5423. lcd_wait_for_cool_down();
  5424. lcd_implementation_clear();
  5425. lcd.setCursor(0, 0); lcd_printPGM(MSG_SELFTEST_START);
  5426. #ifdef TMC2130
  5427. FORCE_HIGH_POWER_START;
  5428. #endif // TMC2130
  5429. delay(2000);
  5430. KEEPALIVE_STATE(IN_HANDLER);
  5431. _progress = lcd_selftest_screen(-1, _progress, 3, true, 2000);
  5432. #if (defined(FANCHECK) && defined(TACH_0))
  5433. _result = lcd_selftest_fan_dialog(0);
  5434. #else //defined(TACH_0)
  5435. _result = lcd_selftest_manual_fan_check(0, false);
  5436. if (!_result)
  5437. {
  5438. const char *_err;
  5439. lcd_selftest_error(7, _err, _err); //extruder fan not spinning
  5440. }
  5441. #endif //defined(TACH_0)
  5442. if (_result)
  5443. {
  5444. _progress = lcd_selftest_screen(0, _progress, 3, true, 2000);
  5445. #if (defined(FANCHECK) && defined(TACH_1))
  5446. _result = lcd_selftest_fan_dialog(1);
  5447. #else //defined(TACH_1)
  5448. _result = lcd_selftest_manual_fan_check(1, false);
  5449. if (!_result)
  5450. {
  5451. const char *_err;
  5452. lcd_selftest_error(6, _err, _err); //print fan not spinning
  5453. }
  5454. #endif //defined(TACH_1)
  5455. }
  5456. if (_result)
  5457. {
  5458. _progress = lcd_selftest_screen(1, _progress, 3, true, 2000);
  5459. #ifndef TMC2130
  5460. _result = lcd_selfcheck_endstops();
  5461. #else
  5462. _result = true;
  5463. #endif
  5464. }
  5465. if (_result)
  5466. {
  5467. _progress = lcd_selftest_screen(3, _progress, 3, true, 1000);
  5468. _result = lcd_selfcheck_check_heater(false);
  5469. }
  5470. if (_result)
  5471. {
  5472. //current_position[Z_AXIS] += 15; //move Z axis higher to avoid false triggering of Z end stop in case that we are very low - just above heatbed
  5473. _progress = lcd_selftest_screen(4, _progress, 3, true, 2000);
  5474. #ifdef TMC2130
  5475. _result = lcd_selfcheck_axis_sg(X_AXIS);
  5476. #else
  5477. _result = lcd_selfcheck_axis(X_AXIS, X_MAX_POS);
  5478. #endif //TMC2130
  5479. }
  5480. if (_result)
  5481. {
  5482. _progress = lcd_selftest_screen(4, _progress, 3, true, 0);
  5483. #ifndef TMC2130
  5484. _result = lcd_selfcheck_pulleys(X_AXIS);
  5485. #endif
  5486. }
  5487. if (_result)
  5488. {
  5489. _progress = lcd_selftest_screen(5, _progress, 3, true, 1500);
  5490. #ifdef TMC2130
  5491. _result = lcd_selfcheck_axis_sg(Y_AXIS);
  5492. #else
  5493. _result = lcd_selfcheck_axis(Y_AXIS, Y_MAX_POS);
  5494. #endif // TMC2130
  5495. }
  5496. if (_result)
  5497. {
  5498. _progress = lcd_selftest_screen(5, _progress, 3, true, 0);
  5499. #ifndef TMC2130
  5500. _result = lcd_selfcheck_pulleys(Y_AXIS);
  5501. #endif // TMC2130
  5502. }
  5503. if (_result)
  5504. {
  5505. #ifdef TMC2130
  5506. tmc2130_home_exit();
  5507. enable_endstops(false);
  5508. current_position[X_AXIS] = current_position[X_AXIS] + 14;
  5509. current_position[Y_AXIS] = current_position[Y_AXIS] + 12;
  5510. #endif
  5511. //homeaxis(X_AXIS);
  5512. //homeaxis(Y_AXIS);
  5513. current_position[Z_AXIS] = current_position[Z_AXIS] + 10;
  5514. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5515. st_synchronize();
  5516. _progress = lcd_selftest_screen(6, _progress, 3, true, 1500);
  5517. _result = lcd_selfcheck_axis(2, Z_MAX_POS);
  5518. if (eeprom_read_byte((uint8_t*)EEPROM_WIZARD_ACTIVE) != 1) {
  5519. enquecommand_P(PSTR("G28 W"));
  5520. enquecommand_P(PSTR("G1 Z15 F1000"));
  5521. }
  5522. }
  5523. #ifdef TMC2130
  5524. if (_result)
  5525. {
  5526. current_position[Z_AXIS] = current_position[Z_AXIS] + 10;
  5527. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5528. st_synchronize();
  5529. _progress = lcd_selftest_screen(13, 0, 2, true, 0);
  5530. bool bres = tmc2130_home_calibrate(X_AXIS);
  5531. _progress = lcd_selftest_screen(13, 1, 2, true, 0);
  5532. bres &= tmc2130_home_calibrate(Y_AXIS);
  5533. _progress = lcd_selftest_screen(13, 2, 2, true, 0);
  5534. if (bres)
  5535. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_ENABLED, 1);
  5536. _result = bres;
  5537. }
  5538. #endif //TMC2130
  5539. if (_result)
  5540. {
  5541. _progress = lcd_selftest_screen(7, _progress, 3, true, 2000); //check bed
  5542. _result = lcd_selfcheck_check_heater(true);
  5543. }
  5544. if (_result)
  5545. {
  5546. _progress = lcd_selftest_screen(8, _progress, 3, true, 2000); //bed ok
  5547. #ifdef PAT9125
  5548. _progress = lcd_selftest_screen(9, _progress, 3, true, 2000); //check filaments sensor
  5549. _result = lcd_selftest_fsensor();
  5550. #endif // PAT9125
  5551. }
  5552. if (_result)
  5553. {
  5554. #ifdef PAT9125
  5555. _progress = lcd_selftest_screen(10, _progress, 3, true, 2000); //fil sensor OK
  5556. #endif // PAT9125
  5557. _progress = lcd_selftest_screen(11, _progress, 3, true, 5000); //all correct
  5558. }
  5559. else
  5560. {
  5561. _progress = lcd_selftest_screen(12, _progress, 3, true, 5000);
  5562. }
  5563. lcd_reset_alert_level();
  5564. enquecommand_P(PSTR("M84"));
  5565. lcd_implementation_clear();
  5566. lcd_next_update_millis = millis() + LCD_UPDATE_INTERVAL;
  5567. if (_result)
  5568. {
  5569. LCD_ALERTMESSAGERPGM(MSG_SELFTEST_OK);
  5570. }
  5571. else
  5572. {
  5573. LCD_ALERTMESSAGERPGM(MSG_SELFTEST_FAILED);
  5574. }
  5575. #ifdef TMC2130
  5576. FORCE_HIGH_POWER_END;
  5577. #endif // TMC2130
  5578. KEEPALIVE_STATE(NOT_BUSY);
  5579. return(_result);
  5580. }
  5581. #ifdef TMC2130
  5582. static void reset_crash_det(char axis) {
  5583. current_position[axis] += 10;
  5584. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5585. st_synchronize();
  5586. if (eeprom_read_byte((uint8_t*)EEPROM_CRASH_DET)) tmc2130_sg_stop_on_crash = true;
  5587. }
  5588. static bool lcd_selfcheck_axis_sg(char axis) {
  5589. // each axis length is measured twice
  5590. float axis_length, current_position_init, current_position_final;
  5591. float measured_axis_length[2];
  5592. float margin = 60;
  5593. float max_error_mm = 5;
  5594. switch (axis) {
  5595. case 0: axis_length = X_MAX_POS; break;
  5596. case 1: axis_length = Y_MAX_POS + 8; break;
  5597. default: axis_length = 210; break;
  5598. }
  5599. tmc2130_sg_stop_on_crash = false;
  5600. tmc2130_home_exit();
  5601. enable_endstops(true);
  5602. if (axis == X_AXIS) { //there is collision between cables and PSU cover in X axis if Z coordinate is too low
  5603. current_position[Z_AXIS] += 17;
  5604. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5605. tmc2130_home_enter(Z_AXIS_MASK);
  5606. st_synchronize();
  5607. tmc2130_home_exit();
  5608. }
  5609. // first axis length measurement begin
  5610. current_position[axis] -= (axis_length + margin);
  5611. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5612. st_synchronize();
  5613. tmc2130_sg_meassure_start(axis);
  5614. current_position_init = st_get_position_mm(axis);
  5615. current_position[axis] += 2 * margin;
  5616. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5617. st_synchronize();
  5618. current_position[axis] += axis_length;
  5619. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5620. st_synchronize();
  5621. uint16_t sg1 = tmc2130_sg_meassure_stop();
  5622. printf_P(PSTR("%c AXIS SG1=%d\n"), 'X'+axis, sg1);
  5623. eeprom_write_word(((uint16_t*)((axis == X_AXIS)?EEPROM_BELTSTATUS_X:EEPROM_BELTSTATUS_Y)), sg1);
  5624. current_position_final = st_get_position_mm(axis);
  5625. measured_axis_length[0] = abs(current_position_final - current_position_init);
  5626. // first measurement end and second measurement begin
  5627. current_position[axis] -= margin;
  5628. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5629. st_synchronize();
  5630. current_position[axis] -= (axis_length + margin);
  5631. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5632. st_synchronize();
  5633. current_position_init = st_get_position_mm(axis);
  5634. measured_axis_length[1] = abs(current_position_final - current_position_init);
  5635. //end of second measurement, now check for possible errors:
  5636. for(int i = 0; i < 2; i++){ //check if measured axis length corresponds to expected length
  5637. SERIAL_ECHOPGM("Measured axis length:");
  5638. MYSERIAL.println(measured_axis_length[i]);
  5639. if (abs(measured_axis_length[i] - axis_length) > max_error_mm) {
  5640. enable_endstops(false);
  5641. const char *_error_1;
  5642. const char *_error_2;
  5643. if (axis == X_AXIS) _error_1 = "X";
  5644. if (axis == Y_AXIS) _error_1 = "Y";
  5645. if (axis == Z_AXIS) _error_1 = "Z";
  5646. lcd_selftest_error(9, _error_1, _error_2);
  5647. current_position[axis] = 0;
  5648. plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
  5649. reset_crash_det(axis);
  5650. return false;
  5651. }
  5652. }
  5653. SERIAL_ECHOPGM("Axis length difference:");
  5654. MYSERIAL.println(abs(measured_axis_length[0] - measured_axis_length[1]));
  5655. if (abs(measured_axis_length[0] - measured_axis_length[1]) > 1) { //check if difference between first and second measurement is low
  5656. //loose pulleys
  5657. const char *_error_1;
  5658. const char *_error_2;
  5659. if (axis == X_AXIS) _error_1 = "X";
  5660. if (axis == Y_AXIS) _error_1 = "Y";
  5661. if (axis == Z_AXIS) _error_1 = "Z";
  5662. lcd_selftest_error(8, _error_1, _error_2);
  5663. current_position[axis] = 0;
  5664. plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
  5665. reset_crash_det(axis);
  5666. return false;
  5667. }
  5668. current_position[axis] = 0;
  5669. plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
  5670. reset_crash_det(axis);
  5671. return true;
  5672. }
  5673. #endif //TMC2130
  5674. //#ifndef TMC2130
  5675. static bool lcd_selfcheck_axis(int _axis, int _travel)
  5676. {
  5677. // printf_P(PSTR("lcd_selfcheck_axis %d, %d\n"), _axis, _travel);
  5678. bool _stepdone = false;
  5679. bool _stepresult = false;
  5680. int _progress = 0;
  5681. int _travel_done = 0;
  5682. int _err_endstop = 0;
  5683. int _lcd_refresh = 0;
  5684. _travel = _travel + (_travel / 10);
  5685. if (_axis == X_AXIS) {
  5686. current_position[Z_AXIS] += 17;
  5687. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5688. }
  5689. do {
  5690. current_position[_axis] = current_position[_axis] - 1;
  5691. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5692. st_synchronize();
  5693. #ifdef TMC2130
  5694. if ((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING == 1))
  5695. #else //TMC2130
  5696. if (((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ||
  5697. ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1) ||
  5698. ((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING) == 1))
  5699. #endif //TMC2130
  5700. {
  5701. if (_axis == 0)
  5702. {
  5703. _stepresult = ((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ? true : false;
  5704. _err_endstop = ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1) ? 1 : 2;
  5705. }
  5706. if (_axis == 1)
  5707. {
  5708. _stepresult = ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1) ? true : false;
  5709. _err_endstop = ((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ? 0 : 2;
  5710. }
  5711. if (_axis == 2)
  5712. {
  5713. _stepresult = ((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING) == 1) ? true : false;
  5714. _err_endstop = ((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ? 0 : 1;
  5715. printf_P(PSTR("lcd_selfcheck_axis %d, %d\n"), _stepresult, _err_endstop);
  5716. /*disable_x();
  5717. disable_y();
  5718. disable_z();*/
  5719. }
  5720. _stepdone = true;
  5721. }
  5722. if (_lcd_refresh < 6)
  5723. {
  5724. _lcd_refresh++;
  5725. }
  5726. else
  5727. {
  5728. _progress = lcd_selftest_screen(4 + _axis, _progress, 3, false, 0);
  5729. _lcd_refresh = 0;
  5730. }
  5731. manage_heater();
  5732. manage_inactivity(true);
  5733. //delay(100);
  5734. (_travel_done <= _travel) ? _travel_done++ : _stepdone = true;
  5735. } while (!_stepdone);
  5736. //current_position[_axis] = current_position[_axis] + 15;
  5737. //plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5738. if (!_stepresult)
  5739. {
  5740. const char *_error_1;
  5741. const char *_error_2;
  5742. if (_axis == X_AXIS) _error_1 = "X";
  5743. if (_axis == Y_AXIS) _error_1 = "Y";
  5744. if (_axis == Z_AXIS) _error_1 = "Z";
  5745. if (_err_endstop == 0) _error_2 = "X";
  5746. if (_err_endstop == 1) _error_2 = "Y";
  5747. if (_err_endstop == 2) _error_2 = "Z";
  5748. if (_travel_done >= _travel)
  5749. {
  5750. lcd_selftest_error(5, _error_1, _error_2);
  5751. }
  5752. else
  5753. {
  5754. lcd_selftest_error(4, _error_1, _error_2);
  5755. }
  5756. }
  5757. return _stepresult;
  5758. }
  5759. #ifndef TMC2130
  5760. static bool lcd_selfcheck_pulleys(int axis)
  5761. {
  5762. float tmp_motor_loud[3] = DEFAULT_PWM_MOTOR_CURRENT_LOUD;
  5763. float tmp_motor[3] = DEFAULT_PWM_MOTOR_CURRENT;
  5764. float current_position_init;
  5765. float move;
  5766. bool endstop_triggered = false;
  5767. int i;
  5768. unsigned long timeout_counter;
  5769. refresh_cmd_timeout();
  5770. manage_inactivity(true);
  5771. if (axis == 0) move = 50; //X_AXIS
  5772. else move = 50; //Y_AXIS
  5773. current_position_init = current_position[axis];
  5774. current_position[axis] += 2;
  5775. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5776. for (i = 0; i < 5; i++) {
  5777. refresh_cmd_timeout();
  5778. current_position[axis] = current_position[axis] + move;
  5779. st_current_set(0, 850); //set motor current higher
  5780. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], 200, active_extruder);
  5781. st_synchronize();
  5782. //*** MaR::180416_02
  5783. if (SilentModeMenu != SILENT_MODE_OFF) st_current_set(0, tmp_motor[0]); //set back to normal operation currents
  5784. else st_current_set(0, tmp_motor_loud[0]); //set motor current back
  5785. current_position[axis] = current_position[axis] - move;
  5786. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], 50, active_extruder);
  5787. st_synchronize();
  5788. if (((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ||
  5789. ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1)) {
  5790. lcd_selftest_error(8, (axis == 0) ? "X" : "Y", "");
  5791. return(false);
  5792. }
  5793. }
  5794. timeout_counter = millis() + 2500;
  5795. endstop_triggered = false;
  5796. manage_inactivity(true);
  5797. while (!endstop_triggered) {
  5798. if (((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ||
  5799. ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1)) {
  5800. endstop_triggered = true;
  5801. if (current_position_init - 1 <= current_position[axis] && current_position_init + 1 >= current_position[axis]) {
  5802. current_position[axis] += (axis == X_AXIS) ? 13 : 9;
  5803. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5804. st_synchronize();
  5805. return(true);
  5806. }
  5807. else {
  5808. lcd_selftest_error(8, (axis == 0) ? "X" : "Y", "");
  5809. return(false);
  5810. }
  5811. }
  5812. else {
  5813. current_position[axis] -= 1;
  5814. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5815. st_synchronize();
  5816. if (millis() > timeout_counter) {
  5817. lcd_selftest_error(8, (axis == 0) ? "X" : "Y", "");
  5818. return(false);
  5819. }
  5820. }
  5821. }
  5822. return(true);
  5823. }
  5824. #endif TMC2130
  5825. static bool lcd_selfcheck_endstops()
  5826. {
  5827. bool _result = true;
  5828. if (((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ||
  5829. ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1) ||
  5830. ((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING) == 1))
  5831. {
  5832. if ((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) current_position[0] += 10;
  5833. if ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1) current_position[1] += 10;
  5834. if ((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING) == 1) current_position[2] += 10;
  5835. }
  5836. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], manual_feedrate[0] / 60, active_extruder);
  5837. delay(500);
  5838. if (((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ||
  5839. ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1) ||
  5840. ((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING) == 1))
  5841. {
  5842. _result = false;
  5843. char _error[4] = "";
  5844. if ((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) strcat(_error, "X");
  5845. if ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1) strcat(_error, "Y");
  5846. if ((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING) == 1) strcat(_error, "Z");
  5847. lcd_selftest_error(3, _error, "");
  5848. }
  5849. manage_heater();
  5850. manage_inactivity(true);
  5851. return _result;
  5852. }
  5853. //#endif //not defined TMC2130
  5854. static bool lcd_selfcheck_check_heater(bool _isbed)
  5855. {
  5856. int _counter = 0;
  5857. int _progress = 0;
  5858. bool _stepresult = false;
  5859. bool _docycle = true;
  5860. int _checked_snapshot = (_isbed) ? degBed() : degHotend(0);
  5861. int _opposite_snapshot = (_isbed) ? degHotend(0) : degBed();
  5862. int _cycles = (_isbed) ? 180 : 60; //~ 90s / 30s
  5863. target_temperature[0] = (_isbed) ? 0 : 200;
  5864. target_temperature_bed = (_isbed) ? 100 : 0;
  5865. manage_heater();
  5866. manage_inactivity(true);
  5867. KEEPALIVE_STATE(NOT_BUSY); //we are sending temperatures on serial line, so no need to send host keepalive messages
  5868. do {
  5869. _counter++;
  5870. _docycle = (_counter < _cycles) ? true : false;
  5871. manage_heater();
  5872. manage_inactivity(true);
  5873. _progress = (_isbed) ? lcd_selftest_screen(7, _progress, 2, false, 400) : lcd_selftest_screen(3, _progress, 2, false, 400);
  5874. /*if (_isbed) {
  5875. MYSERIAL.print("Bed temp:");
  5876. MYSERIAL.println(degBed());
  5877. }
  5878. else {
  5879. MYSERIAL.print("Hotend temp:");
  5880. MYSERIAL.println(degHotend(0));
  5881. }*/
  5882. if(_counter%5 == 0) serialecho_temperatures(); //show temperatures once in two seconds
  5883. } while (_docycle);
  5884. target_temperature[0] = 0;
  5885. target_temperature_bed = 0;
  5886. manage_heater();
  5887. int _checked_result = (_isbed) ? degBed() - _checked_snapshot : degHotend(0) - _checked_snapshot;
  5888. int _opposite_result = (_isbed) ? degHotend(0) - _opposite_snapshot : degBed() - _opposite_snapshot;
  5889. /*
  5890. MYSERIAL.println("");
  5891. MYSERIAL.print("Checked result:");
  5892. MYSERIAL.println(_checked_result);
  5893. MYSERIAL.print("Opposite result:");
  5894. MYSERIAL.println(_opposite_result);
  5895. */
  5896. if (_opposite_result < ((_isbed) ? 10 : 3))
  5897. {
  5898. if (_checked_result >= ((_isbed) ? 3 : 10))
  5899. {
  5900. _stepresult = true;
  5901. }
  5902. else
  5903. {
  5904. lcd_selftest_error(1, "", "");
  5905. }
  5906. }
  5907. else
  5908. {
  5909. lcd_selftest_error(2, "", "");
  5910. }
  5911. manage_heater();
  5912. manage_inactivity(true);
  5913. KEEPALIVE_STATE(IN_HANDLER);
  5914. return _stepresult;
  5915. }
  5916. static void lcd_selftest_error(int _error_no, const char *_error_1, const char *_error_2)
  5917. {
  5918. lcd_implementation_quick_feedback();
  5919. target_temperature[0] = 0;
  5920. target_temperature_bed = 0;
  5921. manage_heater();
  5922. manage_inactivity();
  5923. lcd_implementation_clear();
  5924. lcd.setCursor(0, 0);
  5925. lcd_printPGM(MSG_SELFTEST_ERROR);
  5926. lcd.setCursor(0, 1);
  5927. lcd_printPGM(MSG_SELFTEST_PLEASECHECK);
  5928. switch (_error_no)
  5929. {
  5930. case 1:
  5931. lcd.setCursor(0, 2);
  5932. lcd_printPGM(MSG_SELFTEST_HEATERTHERMISTOR);
  5933. lcd.setCursor(0, 3);
  5934. lcd_printPGM(MSG_SELFTEST_NOTCONNECTED);
  5935. break;
  5936. case 2:
  5937. lcd.setCursor(0, 2);
  5938. lcd_printPGM(MSG_SELFTEST_BEDHEATER);
  5939. lcd.setCursor(0, 3);
  5940. lcd_printPGM(MSG_SELFTEST_WIRINGERROR);
  5941. break;
  5942. case 3:
  5943. lcd.setCursor(0, 2);
  5944. lcd_printPGM(MSG_SELFTEST_ENDSTOPS);
  5945. lcd.setCursor(0, 3);
  5946. lcd_printPGM(MSG_SELFTEST_WIRINGERROR);
  5947. lcd.setCursor(17, 3);
  5948. lcd.print(_error_1);
  5949. break;
  5950. case 4:
  5951. lcd.setCursor(0, 2);
  5952. lcd_printPGM(MSG_SELFTEST_MOTOR);
  5953. lcd.setCursor(18, 2);
  5954. lcd.print(_error_1);
  5955. lcd.setCursor(0, 3);
  5956. lcd_printPGM(MSG_SELFTEST_ENDSTOP);
  5957. lcd.setCursor(18, 3);
  5958. lcd.print(_error_2);
  5959. break;
  5960. case 5:
  5961. lcd.setCursor(0, 2);
  5962. lcd_printPGM(MSG_SELFTEST_ENDSTOP_NOTHIT);
  5963. lcd.setCursor(0, 3);
  5964. lcd_printPGM(MSG_SELFTEST_MOTOR);
  5965. lcd.setCursor(18, 3);
  5966. lcd.print(_error_1);
  5967. break;
  5968. case 6:
  5969. lcd.setCursor(0, 2);
  5970. lcd_printPGM(MSG_SELFTEST_COOLING_FAN);
  5971. lcd.setCursor(0, 3);
  5972. lcd_printPGM(MSG_SELFTEST_WIRINGERROR);
  5973. lcd.setCursor(18, 3);
  5974. lcd.print(_error_1);
  5975. break;
  5976. case 7:
  5977. lcd.setCursor(0, 2);
  5978. lcd_printPGM(MSG_SELFTEST_EXTRUDER_FAN);
  5979. lcd.setCursor(0, 3);
  5980. lcd_printPGM(MSG_SELFTEST_WIRINGERROR);
  5981. lcd.setCursor(18, 3);
  5982. lcd.print(_error_1);
  5983. break;
  5984. case 8:
  5985. lcd.setCursor(0, 2);
  5986. lcd_printPGM(MSG_LOOSE_PULLEY);
  5987. lcd.setCursor(0, 3);
  5988. lcd_printPGM(MSG_SELFTEST_MOTOR);
  5989. lcd.setCursor(18, 3);
  5990. lcd.print(_error_1);
  5991. break;
  5992. case 9:
  5993. lcd.setCursor(0, 2);
  5994. lcd_printPGM(MSG_SELFTEST_AXIS_LENGTH);
  5995. lcd.setCursor(0, 3);
  5996. lcd_printPGM(MSG_SELFTEST_AXIS);
  5997. lcd.setCursor(18, 3);
  5998. lcd.print(_error_1);
  5999. break;
  6000. case 10:
  6001. lcd.setCursor(0, 2);
  6002. lcd_printPGM(MSG_SELFTEST_FANS);
  6003. lcd.setCursor(0, 3);
  6004. lcd_printPGM(MSG_SELFTEST_SWAPPED);
  6005. lcd.setCursor(18, 3);
  6006. lcd.print(_error_1);
  6007. break;
  6008. case 11:
  6009. lcd.setCursor(0, 2);
  6010. lcd_printPGM(MSG_FILAMENT_SENSOR);
  6011. lcd.setCursor(0, 3);
  6012. lcd_printPGM(MSG_SELFTEST_WIRINGERROR);
  6013. break;
  6014. }
  6015. delay(1000);
  6016. lcd_implementation_quick_feedback();
  6017. do {
  6018. delay(100);
  6019. manage_heater();
  6020. manage_inactivity();
  6021. } while (!lcd_clicked());
  6022. LCD_ALERTMESSAGERPGM(MSG_SELFTEST_FAILED);
  6023. lcd_return_to_status();
  6024. }
  6025. #ifdef PAT9125
  6026. static bool lcd_selftest_fsensor() {
  6027. fsensor_init();
  6028. if (fsensor_not_responding)
  6029. {
  6030. const char *_err;
  6031. lcd_selftest_error(11, _err, _err);
  6032. }
  6033. return(!fsensor_not_responding);
  6034. }
  6035. #endif //PAT9125
  6036. static bool lcd_selftest_manual_fan_check(int _fan, bool check_opposite)
  6037. {
  6038. bool _result = check_opposite;
  6039. lcd_implementation_clear();
  6040. lcd.setCursor(0, 0); lcd_printPGM(MSG_SELFTEST_FAN);
  6041. switch (_fan)
  6042. {
  6043. case 0:
  6044. // extruder cooling fan
  6045. lcd.setCursor(0, 1);
  6046. if(check_opposite == true) lcd_printPGM(MSG_SELFTEST_COOLING_FAN);
  6047. else lcd_printPGM(MSG_SELFTEST_EXTRUDER_FAN);
  6048. SET_OUTPUT(EXTRUDER_0_AUTO_FAN_PIN);
  6049. WRITE(EXTRUDER_0_AUTO_FAN_PIN, 1);
  6050. break;
  6051. case 1:
  6052. // object cooling fan
  6053. lcd.setCursor(0, 1);
  6054. if (check_opposite == true) lcd_printPGM(MSG_SELFTEST_EXTRUDER_FAN);
  6055. else lcd_printPGM(MSG_SELFTEST_COOLING_FAN);
  6056. SET_OUTPUT(FAN_PIN);
  6057. analogWrite(FAN_PIN, 255);
  6058. break;
  6059. }
  6060. delay(500);
  6061. lcd.setCursor(1, 2); lcd_printPGM(MSG_SELFTEST_FAN_YES);
  6062. lcd.setCursor(0, 3); lcd.print(">");
  6063. lcd.setCursor(1, 3); lcd_printPGM(MSG_SELFTEST_FAN_NO);
  6064. int8_t enc_dif = 0;
  6065. KEEPALIVE_STATE(PAUSED_FOR_USER);
  6066. button_pressed = false;
  6067. do
  6068. {
  6069. switch (_fan)
  6070. {
  6071. case 0:
  6072. // extruder cooling fan
  6073. SET_OUTPUT(EXTRUDER_0_AUTO_FAN_PIN);
  6074. WRITE(EXTRUDER_0_AUTO_FAN_PIN, 1);
  6075. break;
  6076. case 1:
  6077. // object cooling fan
  6078. SET_OUTPUT(FAN_PIN);
  6079. analogWrite(FAN_PIN, 255);
  6080. break;
  6081. }
  6082. if (abs((enc_dif - encoderDiff)) > 2) {
  6083. if (enc_dif > encoderDiff) {
  6084. _result = !check_opposite;
  6085. lcd.setCursor(0, 2); lcd.print(">");
  6086. lcd.setCursor(1, 2); lcd_printPGM(MSG_SELFTEST_FAN_YES);
  6087. lcd.setCursor(0, 3); lcd.print(" ");
  6088. lcd.setCursor(1, 3); lcd_printPGM(MSG_SELFTEST_FAN_NO);
  6089. }
  6090. if (enc_dif < encoderDiff) {
  6091. _result = check_opposite;
  6092. lcd.setCursor(0, 2); lcd.print(" ");
  6093. lcd.setCursor(1, 2); lcd_printPGM(MSG_SELFTEST_FAN_YES);
  6094. lcd.setCursor(0, 3); lcd.print(">");
  6095. lcd.setCursor(1, 3); lcd_printPGM(MSG_SELFTEST_FAN_NO);
  6096. }
  6097. enc_dif = 0;
  6098. encoderDiff = 0;
  6099. }
  6100. manage_heater();
  6101. delay(100);
  6102. } while (!lcd_clicked());
  6103. KEEPALIVE_STATE(IN_HANDLER);
  6104. SET_OUTPUT(EXTRUDER_0_AUTO_FAN_PIN);
  6105. WRITE(EXTRUDER_0_AUTO_FAN_PIN, 0);
  6106. SET_OUTPUT(FAN_PIN);
  6107. analogWrite(FAN_PIN, 0);
  6108. fanSpeed = 0;
  6109. manage_heater();
  6110. return _result;
  6111. }
  6112. static bool lcd_selftest_fan_dialog(int _fan)
  6113. {
  6114. bool _result = true;
  6115. int _errno = 7;
  6116. switch (_fan) {
  6117. case 0:
  6118. fanSpeed = 0;
  6119. manage_heater(); //turn off fan
  6120. setExtruderAutoFanState(EXTRUDER_0_AUTO_FAN_PIN, 1); //extruder fan
  6121. delay(2000); //delay_keep_alive would turn off extruder fan, because temerature is too low
  6122. manage_heater(); //count average fan speed from 2s delay and turn off fans
  6123. if (!fan_speed[0]) _result = false;
  6124. //SERIAL_ECHOPGM("Extruder fan speed: ");
  6125. //MYSERIAL.println(fan_speed[0]);
  6126. //SERIAL_ECHOPGM("Print fan speed: ");
  6127. //MYSERIAL.print(fan_speed[1]);
  6128. break;
  6129. case 1:
  6130. //will it work with Thotend > 50 C ?
  6131. fanSpeed = 150; //print fan
  6132. for (uint8_t i = 0; i < 5; i++) {
  6133. delay_keep_alive(1000);
  6134. lcd.setCursor(18, 3);
  6135. lcd.print("-");
  6136. delay_keep_alive(1000);
  6137. lcd.setCursor(18, 3);
  6138. lcd.print("|");
  6139. }
  6140. fanSpeed = 0;
  6141. manage_heater(); //turn off fan
  6142. manage_inactivity(true); //to turn off print fan
  6143. if (!fan_speed[1]) {
  6144. _result = false; _errno = 6; //print fan not spinning
  6145. }
  6146. else if (fan_speed[1] < 34) { //fan is spinning, but measured RPM are too low for print fan, it must be left extruder fan
  6147. //check fans manually
  6148. _result = lcd_selftest_manual_fan_check(1, true); //turn on print fan and check that left extruder fan is not spinning
  6149. if (_result) {
  6150. _result = lcd_selftest_manual_fan_check(1, false); //print fan is stil turned on; check that it is spinning
  6151. if (!_result) _errno = 6; //print fan not spinning
  6152. }
  6153. else {
  6154. _errno = 10; //swapped fans
  6155. }
  6156. }
  6157. //SERIAL_ECHOPGM("Extruder fan speed: ");
  6158. //MYSERIAL.println(fan_speed[0]);
  6159. //SERIAL_ECHOPGM("Print fan speed: ");
  6160. //MYSERIAL.println(fan_speed[1]);
  6161. break;
  6162. }
  6163. if (!_result)
  6164. {
  6165. const char *_err;
  6166. lcd_selftest_error(_errno, _err, _err);
  6167. }
  6168. return _result;
  6169. }
  6170. static int lcd_selftest_screen(int _step, int _progress, int _progress_scale, bool _clear, int _delay)
  6171. {
  6172. lcd_next_update_millis = millis() + (LCD_UPDATE_INTERVAL * 10000);
  6173. int _step_block = 0;
  6174. const char *_indicator = (_progress > _progress_scale) ? "-" : "|";
  6175. if (_clear) lcd_implementation_clear();
  6176. lcd.setCursor(0, 0);
  6177. if (_step == -1) lcd_printPGM(MSG_SELFTEST_FAN);
  6178. if (_step == 0) lcd_printPGM(MSG_SELFTEST_FAN);
  6179. if (_step == 1) lcd_printPGM(MSG_SELFTEST_FAN);
  6180. if (_step == 2) lcd_printPGM(MSG_SELFTEST_CHECK_ENDSTOPS);
  6181. if (_step == 3) lcd_printPGM(MSG_SELFTEST_CHECK_HOTEND);
  6182. if (_step == 4) lcd_printPGM(MSG_SELFTEST_CHECK_X);
  6183. if (_step == 5) lcd_printPGM(MSG_SELFTEST_CHECK_Y);
  6184. if (_step == 6) lcd_printPGM(MSG_SELFTEST_CHECK_Z);
  6185. if (_step == 7) lcd_printPGM(MSG_SELFTEST_CHECK_BED);
  6186. if (_step == 8) lcd_printPGM(MSG_SELFTEST_CHECK_BED);
  6187. if (_step == 9) lcd_printPGM(MSG_SELFTEST_CHECK_FSENSOR);
  6188. if (_step == 10) lcd_printPGM(MSG_SELFTEST_CHECK_FSENSOR);
  6189. if (_step == 11) lcd_printPGM(MSG_SELFTEST_CHECK_ALLCORRECT);
  6190. if (_step == 12) lcd_printPGM(MSG_SELFTEST_FAILED);
  6191. if (_step == 13) lcd_printPGM(PSTR("Calibrating home"));
  6192. lcd.setCursor(0, 1);
  6193. lcd_printPGM(separator);
  6194. if ((_step >= -1) && (_step <= 1))
  6195. {
  6196. //SERIAL_ECHOLNPGM("Fan test");
  6197. lcd_print_at_PGM(0, 2, MSG_SELFTEST_EXTRUDER_FAN_SPEED);
  6198. lcd.setCursor(18, 2);
  6199. (_step < 0) ? lcd.print(_indicator) : lcd.print("OK");
  6200. lcd_print_at_PGM(0, 3, MSG_SELFTEST_PRINT_FAN_SPEED);
  6201. lcd.setCursor(18, 3);
  6202. (_step < 1) ? lcd.print(_indicator) : lcd.print("OK");
  6203. }
  6204. else if (_step >= 9 && _step <= 10)
  6205. {
  6206. lcd_print_at_PGM(0, 2, MSG_SELFTEST_FILAMENT_SENSOR);
  6207. lcd.setCursor(18, 2);
  6208. (_step == 9) ? lcd.print(_indicator) : lcd.print("OK");
  6209. }
  6210. else if (_step < 9)
  6211. {
  6212. //SERIAL_ECHOLNPGM("Other tests");
  6213. _step_block = 3;
  6214. lcd_selftest_screen_step(3, 9, ((_step == _step_block) ? 1 : (_step < _step_block) ? 0 : 2), "Hotend", _indicator);
  6215. _step_block = 4;
  6216. lcd_selftest_screen_step(2, 2, ((_step == _step_block) ? 1 : (_step < _step_block) ? 0 : 2), "X", _indicator);
  6217. _step_block = 5;
  6218. lcd_selftest_screen_step(2, 8, ((_step == _step_block) ? 1 : (_step < _step_block) ? 0 : 2), "Y", _indicator);
  6219. _step_block = 6;
  6220. lcd_selftest_screen_step(2, 14, ((_step == _step_block) ? 1 : (_step < _step_block) ? 0 : 2), "Z", _indicator);
  6221. _step_block = 7;
  6222. lcd_selftest_screen_step(3, 0, ((_step == _step_block) ? 1 : (_step < _step_block) ? 0 : 2), "Bed", _indicator);
  6223. }
  6224. if (_delay > 0) delay_keep_alive(_delay);
  6225. _progress++;
  6226. return (_progress > _progress_scale * 2) ? 0 : _progress;
  6227. }
  6228. static void lcd_selftest_screen_step(int _row, int _col, int _state, const char *_name, const char *_indicator)
  6229. {
  6230. lcd.setCursor(_col, _row);
  6231. switch (_state)
  6232. {
  6233. case 1:
  6234. lcd.print(_name);
  6235. lcd.setCursor(_col + strlen(_name), _row);
  6236. lcd.print(":");
  6237. lcd.setCursor(_col + strlen(_name) + 1, _row);
  6238. lcd.print(_indicator);
  6239. break;
  6240. case 2:
  6241. lcd.print(_name);
  6242. lcd.setCursor(_col + strlen(_name), _row);
  6243. lcd.print(":");
  6244. lcd.setCursor(_col + strlen(_name) + 1, _row);
  6245. lcd.print("OK");
  6246. break;
  6247. default:
  6248. lcd.print(_name);
  6249. }
  6250. }
  6251. /** End of menus **/
  6252. static void lcd_quick_feedback()
  6253. {
  6254. lcdDrawUpdate = 2;
  6255. button_pressed = false;
  6256. lcd_implementation_quick_feedback();
  6257. }
  6258. /** Menu action functions **/
  6259. /**
  6260. * @brief Go up in menu structure
  6261. * @param data one time action to be done before leaving menu e.g. saving data or 0
  6262. */
  6263. static void menu_action_back(menuFunc_t data)
  6264. {
  6265. if (data) data();
  6266. MenuStack::Record record = menuStack.pop();
  6267. lcd_goto_menu(record.menu);
  6268. encoderPosition = record.position;
  6269. }
  6270. /**
  6271. * @brief Go deeper into menu structure
  6272. * @param data nested menu
  6273. */
  6274. static void menu_action_submenu(menuFunc_t data) {
  6275. menuStack.push(currentMenu, encoderPosition);
  6276. lcd_goto_menu(data);
  6277. }
  6278. static void menu_action_gcode(const char* pgcode) {
  6279. enquecommand_P(pgcode);
  6280. }
  6281. static void menu_action_setlang(unsigned char lang) {
  6282. lcd_set_lang(lang);
  6283. }
  6284. static void menu_action_function(menuFunc_t data) {
  6285. (*data)();
  6286. }
  6287. static bool check_file(const char* filename) {
  6288. if (farm_mode) return true;
  6289. bool result = false;
  6290. uint32_t filesize;
  6291. card.openFile((char*)filename, true);
  6292. filesize = card.getFileSize();
  6293. if (filesize > END_FILE_SECTION) {
  6294. card.setIndex(filesize - END_FILE_SECTION);
  6295. }
  6296. while (!card.eof() && !result) {
  6297. card.sdprinting = true;
  6298. get_command();
  6299. result = check_commands();
  6300. }
  6301. card.printingHasFinished();
  6302. strncpy_P(lcd_status_message, WELCOME_MSG, LCD_WIDTH);
  6303. lcd_finishstatus();
  6304. return result;
  6305. }
  6306. static void menu_action_sdfile(const char* filename, char* longFilename)
  6307. {
  6308. loading_flag = false;
  6309. char cmd[30];
  6310. char* c;
  6311. bool result = true;
  6312. sprintf_P(cmd, PSTR("M23 %s"), filename);
  6313. for (c = &cmd[4]; *c; c++)
  6314. *c = tolower(*c);
  6315. for (int i = 0; i < 8; i++) {
  6316. eeprom_write_byte((uint8_t*)EEPROM_FILENAME + i, filename[i]);
  6317. }
  6318. uint8_t depth = (uint8_t)card.getWorkDirDepth();
  6319. eeprom_write_byte((uint8_t*)EEPROM_DIR_DEPTH, depth);
  6320. for (uint8_t i = 0; i < depth; i++) {
  6321. for (int j = 0; j < 8; j++) {
  6322. eeprom_write_byte((uint8_t*)EEPROM_DIRS + j + 8 * i, dir_names[i][j]);
  6323. }
  6324. }
  6325. if (!check_file(filename)) {
  6326. result = lcd_show_fullscreen_message_yes_no_and_wait_P(MSG_FILE_INCOMPLETE, false, false);
  6327. lcd_update_enable(true);
  6328. }
  6329. if (result) {
  6330. enquecommand(cmd);
  6331. enquecommand_P(PSTR("M24"));
  6332. }
  6333. lcd_return_to_status();
  6334. }
  6335. static void menu_action_sddirectory(const char* filename, char* longFilename)
  6336. {
  6337. uint8_t depth = (uint8_t)card.getWorkDirDepth();
  6338. strcpy(dir_names[depth], filename);
  6339. MYSERIAL.println(dir_names[depth]);
  6340. card.chdir(filename);
  6341. encoderPosition = 0;
  6342. }
  6343. static void menu_action_setting_edit_bool(const char* pstr, bool* ptr)
  6344. {
  6345. *ptr = !(*ptr);
  6346. }
  6347. /*
  6348. static void menu_action_setting_edit_callback_bool(const char* pstr, bool* ptr, menuFunc_t callback)
  6349. {
  6350. menu_action_setting_edit_bool(pstr, ptr);
  6351. (*callback)();
  6352. }
  6353. */
  6354. #endif//ULTIPANEL
  6355. /** LCD API **/
  6356. void lcd_init()
  6357. {
  6358. lcd_implementation_init();
  6359. #ifdef NEWPANEL
  6360. SET_INPUT(BTN_EN1);
  6361. SET_INPUT(BTN_EN2);
  6362. WRITE(BTN_EN1, HIGH);
  6363. WRITE(BTN_EN2, HIGH);
  6364. #if BTN_ENC > 0
  6365. SET_INPUT(BTN_ENC);
  6366. WRITE(BTN_ENC, HIGH);
  6367. #endif
  6368. #ifdef REPRAPWORLD_KEYPAD
  6369. pinMode(SHIFT_CLK, OUTPUT);
  6370. pinMode(SHIFT_LD, OUTPUT);
  6371. pinMode(SHIFT_OUT, INPUT);
  6372. WRITE(SHIFT_OUT, HIGH);
  6373. WRITE(SHIFT_LD, HIGH);
  6374. #endif
  6375. #else // Not NEWPANEL
  6376. #ifdef SR_LCD_2W_NL // Non latching 2 wire shift register
  6377. pinMode (SR_DATA_PIN, OUTPUT);
  6378. pinMode (SR_CLK_PIN, OUTPUT);
  6379. #elif defined(SHIFT_CLK)
  6380. pinMode(SHIFT_CLK, OUTPUT);
  6381. pinMode(SHIFT_LD, OUTPUT);
  6382. pinMode(SHIFT_EN, OUTPUT);
  6383. pinMode(SHIFT_OUT, INPUT);
  6384. WRITE(SHIFT_OUT, HIGH);
  6385. WRITE(SHIFT_LD, HIGH);
  6386. WRITE(SHIFT_EN, LOW);
  6387. #else
  6388. #ifdef ULTIPANEL
  6389. #error ULTIPANEL requires an encoder
  6390. #endif
  6391. #endif // SR_LCD_2W_NL
  6392. #endif//!NEWPANEL
  6393. #if defined (SDSUPPORT) && defined(SDCARDDETECT) && (SDCARDDETECT > 0)
  6394. pinMode(SDCARDDETECT, INPUT);
  6395. WRITE(SDCARDDETECT, HIGH);
  6396. lcd_oldcardstatus = IS_SD_INSERTED;
  6397. #endif//(SDCARDDETECT > 0)
  6398. #ifdef LCD_HAS_SLOW_BUTTONS
  6399. slow_buttons = 0;
  6400. #endif
  6401. lcd_buttons_update();
  6402. #ifdef ULTIPANEL
  6403. encoderDiff = 0;
  6404. #endif
  6405. }
  6406. //#include <avr/pgmspace.h>
  6407. static volatile bool lcd_update_enabled = true;
  6408. unsigned long lcd_timeoutToStatus = 0;
  6409. void lcd_update_enable(bool enabled)
  6410. {
  6411. if (lcd_update_enabled != enabled) {
  6412. lcd_update_enabled = enabled;
  6413. if (enabled) {
  6414. // Reset encoder position. This is equivalent to re-entering a menu.
  6415. encoderPosition = 0;
  6416. encoderDiff = 0;
  6417. // Enabling the normal LCD update procedure.
  6418. // Reset the timeout interval.
  6419. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  6420. // Force the keypad update now.
  6421. lcd_next_update_millis = millis() - 1;
  6422. // Full update.
  6423. lcd_implementation_clear();
  6424. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT)
  6425. lcd_set_custom_characters(currentMenu == lcd_status_screen);
  6426. #else
  6427. if (currentMenu == lcd_status_screen)
  6428. lcd_set_custom_characters_degree();
  6429. else
  6430. lcd_set_custom_characters_arrows();
  6431. #endif
  6432. lcd_update(2);
  6433. } else {
  6434. // Clear the LCD always, or let it to the caller?
  6435. }
  6436. }
  6437. }
  6438. void lcd_update(uint8_t lcdDrawUpdateOverride)
  6439. {
  6440. if (lcdDrawUpdate < lcdDrawUpdateOverride)
  6441. lcdDrawUpdate = lcdDrawUpdateOverride;
  6442. if (!lcd_update_enabled)
  6443. return;
  6444. #ifdef LCD_HAS_SLOW_BUTTONS
  6445. slow_buttons = lcd_implementation_read_slow_buttons(); // buttons which take too long to read in interrupt context
  6446. #endif
  6447. lcd_buttons_update();
  6448. #if (SDCARDDETECT > 0)
  6449. if ((IS_SD_INSERTED != lcd_oldcardstatus && lcd_detected()))
  6450. {
  6451. lcdDrawUpdate = 2;
  6452. lcd_oldcardstatus = IS_SD_INSERTED;
  6453. lcd_implementation_init( // to maybe revive the LCD if static electricity killed it.
  6454. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT)
  6455. currentMenu == lcd_status_screen
  6456. #endif
  6457. );
  6458. if (lcd_oldcardstatus)
  6459. {
  6460. card.initsd();
  6461. LCD_MESSAGERPGM(MSG_SD_INSERTED);
  6462. //get_description();
  6463. }
  6464. else
  6465. {
  6466. card.release();
  6467. LCD_MESSAGERPGM(MSG_SD_REMOVED);
  6468. }
  6469. }
  6470. #endif//CARDINSERTED
  6471. if (lcd_next_update_millis < millis())
  6472. {
  6473. #ifdef DEBUG_BLINK_ACTIVE
  6474. static bool active_led = false;
  6475. active_led = !active_led;
  6476. pinMode(LED_PIN, OUTPUT);
  6477. digitalWrite(LED_PIN, active_led?HIGH:LOW);
  6478. #endif //DEBUG_BLINK_ACTIVE
  6479. #ifdef ULTIPANEL
  6480. #ifdef REPRAPWORLD_KEYPAD
  6481. if (REPRAPWORLD_KEYPAD_MOVE_Z_UP) {
  6482. reprapworld_keypad_move_z_up();
  6483. }
  6484. if (REPRAPWORLD_KEYPAD_MOVE_Z_DOWN) {
  6485. reprapworld_keypad_move_z_down();
  6486. }
  6487. if (REPRAPWORLD_KEYPAD_MOVE_X_LEFT) {
  6488. reprapworld_keypad_move_x_left();
  6489. }
  6490. if (REPRAPWORLD_KEYPAD_MOVE_X_RIGHT) {
  6491. reprapworld_keypad_move_x_right();
  6492. }
  6493. if (REPRAPWORLD_KEYPAD_MOVE_Y_DOWN) {
  6494. reprapworld_keypad_move_y_down();
  6495. }
  6496. if (REPRAPWORLD_KEYPAD_MOVE_Y_UP) {
  6497. reprapworld_keypad_move_y_up();
  6498. }
  6499. if (REPRAPWORLD_KEYPAD_MOVE_HOME) {
  6500. reprapworld_keypad_move_home();
  6501. }
  6502. #endif
  6503. if (abs(encoderDiff) >= ENCODER_PULSES_PER_STEP)
  6504. {
  6505. if (lcdDrawUpdate == 0)
  6506. lcdDrawUpdate = 1;
  6507. encoderPosition += encoderDiff / ENCODER_PULSES_PER_STEP;
  6508. encoderDiff = 0;
  6509. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  6510. }
  6511. if (LCD_CLICKED) lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  6512. #endif//ULTIPANEL
  6513. (*currentMenu)();
  6514. #ifdef LCD_HAS_STATUS_INDICATORS
  6515. lcd_implementation_update_indicators();
  6516. #endif
  6517. #ifdef ULTIPANEL
  6518. if (lcd_timeoutToStatus < millis() && currentMenu != lcd_status_screen)
  6519. {
  6520. // Exiting a menu. Let's call the menu function the last time with menuExiting flag set to true
  6521. // to give it a chance to save its state.
  6522. // This is useful for example, when the babystep value has to be written into EEPROM.
  6523. if (currentMenu != NULL) {
  6524. menuExiting = true;
  6525. (*currentMenu)();
  6526. menuExiting = false;
  6527. }
  6528. lcd_implementation_clear();
  6529. lcd_return_to_status();
  6530. lcdDrawUpdate = 2;
  6531. }
  6532. #endif//ULTIPANEL
  6533. if (lcdDrawUpdate == 2) lcd_implementation_clear();
  6534. if (lcdDrawUpdate) lcdDrawUpdate--;
  6535. lcd_next_update_millis = millis() + LCD_UPDATE_INTERVAL;
  6536. }
  6537. if (!SdFatUtil::test_stack_integrity()) stack_error();
  6538. #ifdef DEBUG_STEPPER_TIMER_MISSED
  6539. if (stepper_timer_overflow_state) stepper_timer_overflow();
  6540. #endif /* DEBUG_STEPPER_TIMER_MISSED */
  6541. lcd_ping(); //check that we have received ping command if we are in farm mode
  6542. lcd_send_status();
  6543. if (lcd_commands_type == LCD_COMMAND_V2_CAL) lcd_commands();
  6544. }
  6545. void lcd_printer_connected() {
  6546. printer_connected = true;
  6547. }
  6548. static void lcd_send_status() {
  6549. if (farm_mode && no_response && ((millis() - NcTime) > (NC_TIME * 1000))) {
  6550. //send important status messages periodicaly
  6551. prusa_statistics(important_status, saved_filament_type);
  6552. NcTime = millis();
  6553. lcd_connect_printer();
  6554. }
  6555. }
  6556. static void lcd_connect_printer() {
  6557. lcd_update_enable(false);
  6558. lcd_implementation_clear();
  6559. bool pressed = false;
  6560. int i = 0;
  6561. int t = 0;
  6562. lcd_set_custom_characters_progress();
  6563. lcd_implementation_print_at(0, 0, "Connect printer to");
  6564. lcd_implementation_print_at(0, 1, "monitoring or hold");
  6565. lcd_implementation_print_at(0, 2, "the knob to continue");
  6566. while (no_response) {
  6567. i++;
  6568. t++;
  6569. delay_keep_alive(100);
  6570. proc_commands();
  6571. if (t == 10) {
  6572. prusa_statistics(important_status, saved_filament_type);
  6573. t = 0;
  6574. }
  6575. if (READ(BTN_ENC)) { //if button is not pressed
  6576. i = 0;
  6577. lcd_implementation_print_at(0, 3, " ");
  6578. }
  6579. if (i!=0) lcd_implementation_print_at((i * 20) / (NC_BUTTON_LONG_PRESS * 10), 3, "\x01");
  6580. if (i == NC_BUTTON_LONG_PRESS * 10) {
  6581. no_response = false;
  6582. }
  6583. }
  6584. lcd_set_custom_characters_degree();
  6585. lcd_update_enable(true);
  6586. lcd_update(2);
  6587. }
  6588. void lcd_ping() { //chceck if printer is connected to monitoring when in farm mode
  6589. if (farm_mode) {
  6590. bool empty = is_buffer_empty();
  6591. if ((millis() - PingTime) * 0.001 > (empty ? PING_TIME : PING_TIME_LONG)) { //if commands buffer is empty use shorter time period
  6592. //if there are comamnds in buffer, some long gcodes can delay execution of ping command
  6593. //therefore longer period is used
  6594. printer_connected = false;
  6595. //lcd_ping_allert(); //acustic signals
  6596. }
  6597. else {
  6598. lcd_printer_connected();
  6599. }
  6600. }
  6601. }
  6602. void lcd_ignore_click(bool b)
  6603. {
  6604. ignore_click = b;
  6605. wait_for_unclick = false;
  6606. }
  6607. void lcd_finishstatus() {
  6608. int len = strlen(lcd_status_message);
  6609. if (len > 0) {
  6610. while (len < LCD_WIDTH) {
  6611. lcd_status_message[len++] = ' ';
  6612. }
  6613. }
  6614. lcd_status_message[LCD_WIDTH] = '\0';
  6615. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT)
  6616. #if PROGRESS_MSG_EXPIRE > 0
  6617. messageTick =
  6618. #endif
  6619. progressBarTick = millis();
  6620. #endif
  6621. lcdDrawUpdate = 2;
  6622. #ifdef FILAMENT_LCD_DISPLAY
  6623. message_millis = millis(); //get status message to show up for a while
  6624. #endif
  6625. }
  6626. void lcd_setstatus(const char* message)
  6627. {
  6628. if (lcd_status_message_level > 0)
  6629. return;
  6630. strncpy(lcd_status_message, message, LCD_WIDTH);
  6631. lcd_finishstatus();
  6632. }
  6633. void lcd_setstatuspgm(const char* message)
  6634. {
  6635. if (lcd_status_message_level > 0)
  6636. return;
  6637. strncpy_P(lcd_status_message, message, LCD_WIDTH);
  6638. lcd_status_message[LCD_WIDTH] = 0;
  6639. lcd_finishstatus();
  6640. }
  6641. void lcd_setalertstatuspgm(const char* message)
  6642. {
  6643. lcd_setstatuspgm(message);
  6644. lcd_status_message_level = 1;
  6645. #ifdef ULTIPANEL
  6646. lcd_return_to_status();
  6647. #endif//ULTIPANEL
  6648. }
  6649. void lcd_reset_alert_level()
  6650. {
  6651. lcd_status_message_level = 0;
  6652. }
  6653. uint8_t get_message_level()
  6654. {
  6655. return lcd_status_message_level;
  6656. }
  6657. #ifdef DOGLCD
  6658. void lcd_setcontrast(uint8_t value)
  6659. {
  6660. lcd_contrast = value & 63;
  6661. u8g.setContrast(lcd_contrast);
  6662. }
  6663. #endif
  6664. #ifdef ULTIPANEL
  6665. /* Warning: This function is called from interrupt context */
  6666. void lcd_buttons_update()
  6667. {
  6668. static bool _lock = false;
  6669. if (_lock) return;
  6670. _lock = true;
  6671. #ifdef NEWPANEL
  6672. uint8_t newbutton = 0;
  6673. if (READ(BTN_EN1) == 0) newbutton |= EN_A;
  6674. if (READ(BTN_EN2) == 0) newbutton |= EN_B;
  6675. #if BTN_ENC > 0
  6676. if (lcd_update_enabled == true) { //if we are in non-modal mode, long press can be used and short press triggers with button release
  6677. if (READ(BTN_ENC) == 0) { //button is pressed
  6678. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  6679. if (millis() > button_blanking_time) {
  6680. button_blanking_time = millis() + BUTTON_BLANKING_TIME;
  6681. if (button_pressed == false && long_press_active == false) {
  6682. long_press_timer = millis();
  6683. button_pressed = true;
  6684. }
  6685. else {
  6686. if (millis() - long_press_timer > LONG_PRESS_TIME) { //long press activated
  6687. long_press_active = true;
  6688. move_menu_scale = 1.0;
  6689. menu_action_submenu(lcd_move_z);
  6690. }
  6691. }
  6692. }
  6693. }
  6694. else { //button not pressed
  6695. if (button_pressed) { //button was released
  6696. button_blanking_time = millis() + BUTTON_BLANKING_TIME;
  6697. if (long_press_active == false) { //button released before long press gets activated
  6698. newbutton |= EN_C;
  6699. }
  6700. else if (currentMenu == lcd_move_z) lcd_quick_feedback();
  6701. //button_pressed is set back to false via lcd_quick_feedback function
  6702. }
  6703. else {
  6704. long_press_active = false;
  6705. }
  6706. }
  6707. }
  6708. else { //we are in modal mode
  6709. if (READ(BTN_ENC) == 0)
  6710. newbutton |= EN_C;
  6711. }
  6712. #endif
  6713. buttons = newbutton;
  6714. #ifdef LCD_HAS_SLOW_BUTTONS
  6715. buttons |= slow_buttons;
  6716. #endif
  6717. #ifdef REPRAPWORLD_KEYPAD
  6718. // for the reprapworld_keypad
  6719. uint8_t newbutton_reprapworld_keypad = 0;
  6720. WRITE(SHIFT_LD, LOW);
  6721. WRITE(SHIFT_LD, HIGH);
  6722. for (int8_t i = 0; i < 8; i++) {
  6723. newbutton_reprapworld_keypad = newbutton_reprapworld_keypad >> 1;
  6724. if (READ(SHIFT_OUT))
  6725. newbutton_reprapworld_keypad |= (1 << 7);
  6726. WRITE(SHIFT_CLK, HIGH);
  6727. WRITE(SHIFT_CLK, LOW);
  6728. }
  6729. buttons_reprapworld_keypad = ~newbutton_reprapworld_keypad; //invert it, because a pressed switch produces a logical 0
  6730. #endif
  6731. #else //read it from the shift register
  6732. uint8_t newbutton = 0;
  6733. WRITE(SHIFT_LD, LOW);
  6734. WRITE(SHIFT_LD, HIGH);
  6735. unsigned char tmp_buttons = 0;
  6736. for (int8_t i = 0; i < 8; i++)
  6737. {
  6738. newbutton = newbutton >> 1;
  6739. if (READ(SHIFT_OUT))
  6740. newbutton |= (1 << 7);
  6741. WRITE(SHIFT_CLK, HIGH);
  6742. WRITE(SHIFT_CLK, LOW);
  6743. }
  6744. buttons = ~newbutton; //invert it, because a pressed switch produces a logical 0
  6745. #endif//!NEWPANEL
  6746. //manage encoder rotation
  6747. uint8_t enc = 0;
  6748. if (buttons & EN_A) enc |= B01;
  6749. if (buttons & EN_B) enc |= B10;
  6750. if (enc != lastEncoderBits)
  6751. {
  6752. switch (enc)
  6753. {
  6754. case encrot0:
  6755. if (lastEncoderBits == encrot3)
  6756. encoderDiff++;
  6757. else if (lastEncoderBits == encrot1)
  6758. encoderDiff--;
  6759. break;
  6760. case encrot1:
  6761. if (lastEncoderBits == encrot0)
  6762. encoderDiff++;
  6763. else if (lastEncoderBits == encrot2)
  6764. encoderDiff--;
  6765. break;
  6766. case encrot2:
  6767. if (lastEncoderBits == encrot1)
  6768. encoderDiff++;
  6769. else if (lastEncoderBits == encrot3)
  6770. encoderDiff--;
  6771. break;
  6772. case encrot3:
  6773. if (lastEncoderBits == encrot2)
  6774. encoderDiff++;
  6775. else if (lastEncoderBits == encrot0)
  6776. encoderDiff--;
  6777. break;
  6778. }
  6779. }
  6780. lastEncoderBits = enc;
  6781. _lock = false;
  6782. }
  6783. bool lcd_detected(void)
  6784. {
  6785. #if (defined(LCD_I2C_TYPE_MCP23017) || defined(LCD_I2C_TYPE_MCP23008)) && defined(DETECT_DEVICE)
  6786. return lcd.LcdDetected() == 1;
  6787. #else
  6788. return true;
  6789. #endif
  6790. }
  6791. void lcd_buzz(long duration, uint16_t freq)
  6792. {
  6793. #ifdef LCD_USE_I2C_BUZZER
  6794. lcd.buzz(duration, freq);
  6795. #endif
  6796. }
  6797. bool lcd_clicked()
  6798. {
  6799. bool clicked = LCD_CLICKED;
  6800. if(clicked) button_pressed = false;
  6801. return clicked;
  6802. }
  6803. #endif//ULTIPANEL
  6804. /********************************/
  6805. /** Float conversion utilities **/
  6806. /********************************/
  6807. // convert float to string with +123.4 format
  6808. char conv[8];
  6809. char *ftostr3(const float &x)
  6810. {
  6811. return itostr3((int)x);
  6812. }
  6813. char *itostr2(const uint8_t &x)
  6814. {
  6815. //sprintf(conv,"%5.1f",x);
  6816. int xx = x;
  6817. conv[0] = (xx / 10) % 10 + '0';
  6818. conv[1] = (xx) % 10 + '0';
  6819. conv[2] = 0;
  6820. return conv;
  6821. }
  6822. // Convert float to string with 123.4 format, dropping sign
  6823. char *ftostr31(const float &x)
  6824. {
  6825. int xx = x * 10;
  6826. conv[0] = (xx >= 0) ? '+' : '-';
  6827. xx = abs(xx);
  6828. conv[1] = (xx / 1000) % 10 + '0';
  6829. conv[2] = (xx / 100) % 10 + '0';
  6830. conv[3] = (xx / 10) % 10 + '0';
  6831. conv[4] = '.';
  6832. conv[5] = (xx) % 10 + '0';
  6833. conv[6] = 0;
  6834. return conv;
  6835. }
  6836. // Convert float to string with 123.4 format
  6837. char *ftostr31ns(const float &x)
  6838. {
  6839. int xx = x * 10;
  6840. //conv[0]=(xx>=0)?'+':'-';
  6841. xx = abs(xx);
  6842. conv[0] = (xx / 1000) % 10 + '0';
  6843. conv[1] = (xx / 100) % 10 + '0';
  6844. conv[2] = (xx / 10) % 10 + '0';
  6845. conv[3] = '.';
  6846. conv[4] = (xx) % 10 + '0';
  6847. conv[5] = 0;
  6848. return conv;
  6849. }
  6850. char *ftostr32(const float &x)
  6851. {
  6852. long xx = x * 100;
  6853. if (xx >= 0)
  6854. conv[0] = (xx / 10000) % 10 + '0';
  6855. else
  6856. conv[0] = '-';
  6857. xx = abs(xx);
  6858. conv[1] = (xx / 1000) % 10 + '0';
  6859. conv[2] = (xx / 100) % 10 + '0';
  6860. conv[3] = '.';
  6861. conv[4] = (xx / 10) % 10 + '0';
  6862. conv[5] = (xx) % 10 + '0';
  6863. conv[6] = 0;
  6864. return conv;
  6865. }
  6866. //// Convert float to rj string with 123.45 format
  6867. char *ftostr32ns(const float &x) {
  6868. long xx = abs(x);
  6869. conv[0] = xx >= 10000 ? (xx / 10000) % 10 + '0' : ' ';
  6870. conv[1] = xx >= 1000 ? (xx / 1000) % 10 + '0' : ' ';
  6871. conv[2] = xx >= 100 ? (xx / 100) % 10 + '0' : '0';
  6872. conv[3] = '.';
  6873. conv[4] = (xx / 10) % 10 + '0';
  6874. conv[5] = xx % 10 + '0';
  6875. return conv;
  6876. }
  6877. // Convert float to string with 1.234 format
  6878. char *ftostr43(const float &x, uint8_t offset)
  6879. {
  6880. const size_t maxOffset = sizeof(conv)/sizeof(conv[0]) - 6;
  6881. if (offset>maxOffset) offset = maxOffset;
  6882. long xx = x * 1000;
  6883. if (xx >= 0)
  6884. conv[offset] = (xx / 1000) % 10 + '0';
  6885. else
  6886. conv[offset] = '-';
  6887. xx = abs(xx);
  6888. conv[offset + 1] = '.';
  6889. conv[offset + 2] = (xx / 100) % 10 + '0';
  6890. conv[offset + 3] = (xx / 10) % 10 + '0';
  6891. conv[offset + 4] = (xx) % 10 + '0';
  6892. conv[offset + 5] = 0;
  6893. return conv;
  6894. }
  6895. //Float to string with 1.23 format
  6896. char *ftostr12ns(const float &x)
  6897. {
  6898. long xx = x * 100;
  6899. xx = abs(xx);
  6900. conv[0] = (xx / 100) % 10 + '0';
  6901. conv[1] = '.';
  6902. conv[2] = (xx / 10) % 10 + '0';
  6903. conv[3] = (xx) % 10 + '0';
  6904. conv[4] = 0;
  6905. return conv;
  6906. }
  6907. //Float to string with 1.234 format
  6908. char *ftostr13ns(const float &x)
  6909. {
  6910. long xx = x * 1000;
  6911. if (xx >= 0)
  6912. conv[0] = ' ';
  6913. else
  6914. conv[0] = '-';
  6915. xx = abs(xx);
  6916. conv[1] = (xx / 1000) % 10 + '0';
  6917. conv[2] = '.';
  6918. conv[3] = (xx / 100) % 10 + '0';
  6919. conv[4] = (xx / 10) % 10 + '0';
  6920. conv[5] = (xx) % 10 + '0';
  6921. conv[6] = 0;
  6922. return conv;
  6923. }
  6924. // convert float to space-padded string with -_23.4_ format
  6925. char *ftostr32sp(const float &x) {
  6926. long xx = abs(x * 100);
  6927. uint8_t dig;
  6928. if (x < 0) { // negative val = -_0
  6929. conv[0] = '-';
  6930. dig = (xx / 1000) % 10;
  6931. conv[1] = dig ? '0' + dig : ' ';
  6932. }
  6933. else { // positive val = __0
  6934. dig = (xx / 10000) % 10;
  6935. if (dig) {
  6936. conv[0] = '0' + dig;
  6937. conv[1] = '0' + (xx / 1000) % 10;
  6938. }
  6939. else {
  6940. conv[0] = ' ';
  6941. dig = (xx / 1000) % 10;
  6942. conv[1] = dig ? '0' + dig : ' ';
  6943. }
  6944. }
  6945. conv[2] = '0' + (xx / 100) % 10; // lsd always
  6946. dig = xx % 10;
  6947. if (dig) { // 2 decimal places
  6948. conv[5] = '0' + dig;
  6949. conv[4] = '0' + (xx / 10) % 10;
  6950. conv[3] = '.';
  6951. }
  6952. else { // 1 or 0 decimal place
  6953. dig = (xx / 10) % 10;
  6954. if (dig) {
  6955. conv[4] = '0' + dig;
  6956. conv[3] = '.';
  6957. }
  6958. else {
  6959. conv[3] = conv[4] = ' ';
  6960. }
  6961. conv[5] = ' ';
  6962. }
  6963. conv[6] = '\0';
  6964. return conv;
  6965. }
  6966. char *itostr31(const int &xx)
  6967. {
  6968. conv[0] = (xx >= 0) ? '+' : '-';
  6969. conv[1] = (xx / 1000) % 10 + '0';
  6970. conv[2] = (xx / 100) % 10 + '0';
  6971. conv[3] = (xx / 10) % 10 + '0';
  6972. conv[4] = '.';
  6973. conv[5] = (xx) % 10 + '0';
  6974. conv[6] = 0;
  6975. return conv;
  6976. }
  6977. // Convert int to rj string with 123 or -12 format
  6978. char *itostr3(const int &x)
  6979. {
  6980. int xx = x;
  6981. if (xx < 0) {
  6982. conv[0] = '-';
  6983. xx = -xx;
  6984. } else if (xx >= 100)
  6985. conv[0] = (xx / 100) % 10 + '0';
  6986. else
  6987. conv[0] = ' ';
  6988. if (xx >= 10)
  6989. conv[1] = (xx / 10) % 10 + '0';
  6990. else
  6991. conv[1] = ' ';
  6992. conv[2] = (xx) % 10 + '0';
  6993. conv[3] = 0;
  6994. return conv;
  6995. }
  6996. // Convert int to lj string with 123 format
  6997. char *itostr3left(const int &xx)
  6998. {
  6999. if (xx >= 100)
  7000. {
  7001. conv[0] = (xx / 100) % 10 + '0';
  7002. conv[1] = (xx / 10) % 10 + '0';
  7003. conv[2] = (xx) % 10 + '0';
  7004. conv[3] = 0;
  7005. }
  7006. else if (xx >= 10)
  7007. {
  7008. conv[0] = (xx / 10) % 10 + '0';
  7009. conv[1] = (xx) % 10 + '0';
  7010. conv[2] = 0;
  7011. }
  7012. else
  7013. {
  7014. conv[0] = (xx) % 10 + '0';
  7015. conv[1] = 0;
  7016. }
  7017. return conv;
  7018. }
  7019. // Convert int to rj string with 1234 format
  7020. char *itostr4(const int &xx) {
  7021. conv[0] = xx >= 1000 ? (xx / 1000) % 10 + '0' : ' ';
  7022. conv[1] = xx >= 100 ? (xx / 100) % 10 + '0' : ' ';
  7023. conv[2] = xx >= 10 ? (xx / 10) % 10 + '0' : ' ';
  7024. conv[3] = xx % 10 + '0';
  7025. conv[4] = 0;
  7026. return conv;
  7027. }
  7028. // Convert float to rj string with 12345 format
  7029. char *ftostr5(const float &x) {
  7030. long xx = abs(x);
  7031. conv[0] = xx >= 10000 ? (xx / 10000) % 10 + '0' : ' ';
  7032. conv[1] = xx >= 1000 ? (xx / 1000) % 10 + '0' : ' ';
  7033. conv[2] = xx >= 100 ? (xx / 100) % 10 + '0' : ' ';
  7034. conv[3] = xx >= 10 ? (xx / 10) % 10 + '0' : ' ';
  7035. conv[4] = xx % 10 + '0';
  7036. conv[5] = 0;
  7037. return conv;
  7038. }
  7039. // Convert float to string with +1234.5 format
  7040. char *ftostr51(const float &x)
  7041. {
  7042. long xx = x * 10;
  7043. conv[0] = (xx >= 0) ? '+' : '-';
  7044. xx = abs(xx);
  7045. conv[1] = (xx / 10000) % 10 + '0';
  7046. conv[2] = (xx / 1000) % 10 + '0';
  7047. conv[3] = (xx / 100) % 10 + '0';
  7048. conv[4] = (xx / 10) % 10 + '0';
  7049. conv[5] = '.';
  7050. conv[6] = (xx) % 10 + '0';
  7051. conv[7] = 0;
  7052. return conv;
  7053. }
  7054. // Convert float to string with +123.45 format
  7055. char *ftostr52(const float &x)
  7056. {
  7057. long xx = x * 100;
  7058. conv[0] = (xx >= 0) ? '+' : '-';
  7059. xx = abs(xx);
  7060. conv[1] = (xx / 10000) % 10 + '0';
  7061. conv[2] = (xx / 1000) % 10 + '0';
  7062. conv[3] = (xx / 100) % 10 + '0';
  7063. conv[4] = '.';
  7064. conv[5] = (xx / 10) % 10 + '0';
  7065. conv[6] = (xx) % 10 + '0';
  7066. conv[7] = 0;
  7067. return conv;
  7068. }
  7069. /*
  7070. // Callback for after editing PID i value
  7071. // grab the PID i value out of the temp variable; scale it; then update the PID driver
  7072. void copy_and_scalePID_i()
  7073. {
  7074. #ifdef PIDTEMP
  7075. Ki = scalePID_i(raw_Ki);
  7076. updatePID();
  7077. #endif
  7078. }
  7079. // Callback for after editing PID d value
  7080. // grab the PID d value out of the temp variable; scale it; then update the PID driver
  7081. void copy_and_scalePID_d()
  7082. {
  7083. #ifdef PIDTEMP
  7084. Kd = scalePID_d(raw_Kd);
  7085. updatePID();
  7086. #endif
  7087. }
  7088. */
  7089. #endif //ULTRA_LCD