ultralcd.cpp 236 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786378737883789379037913792379337943795379637973798379938003801380238033804380538063807380838093810381138123813381438153816381738183819382038213822382338243825382638273828382938303831383238333834383538363837383838393840384138423843384438453846384738483849385038513852385338543855385638573858385938603861386238633864386538663867386838693870387138723873387438753876387738783879388038813882388338843885388638873888388938903891389238933894389538963897389838993900390139023903390439053906390739083909391039113912391339143915391639173918391939203921392239233924392539263927392839293930393139323933393439353936393739383939394039413942394339443945394639473948394939503951395239533954395539563957395839593960396139623963396439653966396739683969397039713972397339743975397639773978397939803981398239833984398539863987398839893990399139923993399439953996399739983999400040014002400340044005400640074008400940104011401240134014401540164017401840194020402140224023402440254026402740284029403040314032403340344035403640374038403940404041404240434044404540464047404840494050405140524053405440554056405740584059406040614062406340644065406640674068406940704071407240734074407540764077407840794080408140824083408440854086408740884089409040914092409340944095409640974098409941004101410241034104410541064107410841094110411141124113411441154116411741184119412041214122412341244125412641274128412941304131413241334134413541364137413841394140414141424143414441454146414741484149415041514152415341544155415641574158415941604161416241634164416541664167416841694170417141724173417441754176417741784179418041814182418341844185418641874188418941904191419241934194419541964197419841994200420142024203420442054206420742084209421042114212421342144215421642174218421942204221422242234224422542264227422842294230423142324233423442354236423742384239424042414242424342444245424642474248424942504251425242534254425542564257425842594260426142624263426442654266426742684269427042714272427342744275427642774278427942804281428242834284428542864287428842894290429142924293429442954296429742984299430043014302430343044305430643074308430943104311431243134314431543164317431843194320432143224323432443254326432743284329433043314332433343344335433643374338433943404341434243434344434543464347434843494350435143524353435443554356435743584359436043614362436343644365436643674368436943704371437243734374437543764377437843794380438143824383438443854386438743884389439043914392439343944395439643974398439944004401440244034404440544064407440844094410441144124413441444154416441744184419442044214422442344244425442644274428442944304431443244334434443544364437443844394440444144424443444444454446444744484449445044514452445344544455445644574458445944604461446244634464446544664467446844694470447144724473447444754476447744784479448044814482448344844485448644874488448944904491449244934494449544964497449844994500450145024503450445054506450745084509451045114512451345144515451645174518451945204521452245234524452545264527452845294530453145324533453445354536453745384539454045414542454345444545454645474548454945504551455245534554455545564557455845594560456145624563456445654566456745684569457045714572457345744575457645774578457945804581458245834584458545864587458845894590459145924593459445954596459745984599460046014602460346044605460646074608460946104611461246134614461546164617461846194620462146224623462446254626462746284629463046314632463346344635463646374638463946404641464246434644464546464647464846494650465146524653465446554656465746584659466046614662466346644665466646674668466946704671467246734674467546764677467846794680468146824683468446854686468746884689469046914692469346944695469646974698469947004701470247034704470547064707470847094710471147124713471447154716471747184719472047214722472347244725472647274728472947304731473247334734473547364737473847394740474147424743474447454746474747484749475047514752475347544755475647574758475947604761476247634764476547664767476847694770477147724773477447754776477747784779478047814782478347844785478647874788478947904791479247934794479547964797479847994800480148024803480448054806480748084809481048114812481348144815481648174818481948204821482248234824482548264827482848294830483148324833483448354836483748384839484048414842484348444845484648474848484948504851485248534854485548564857485848594860486148624863486448654866486748684869487048714872487348744875487648774878487948804881488248834884488548864887488848894890489148924893489448954896489748984899490049014902490349044905490649074908490949104911491249134914491549164917491849194920492149224923492449254926492749284929493049314932493349344935493649374938493949404941494249434944494549464947494849494950495149524953495449554956495749584959496049614962496349644965496649674968496949704971497249734974497549764977497849794980498149824983498449854986498749884989499049914992499349944995499649974998499950005001500250035004500550065007500850095010501150125013501450155016501750185019502050215022502350245025502650275028502950305031503250335034503550365037503850395040504150425043504450455046504750485049505050515052505350545055505650575058505950605061506250635064506550665067506850695070507150725073507450755076507750785079508050815082508350845085508650875088508950905091509250935094509550965097509850995100510151025103510451055106510751085109511051115112511351145115511651175118511951205121512251235124512551265127512851295130513151325133513451355136513751385139514051415142514351445145514651475148514951505151515251535154515551565157515851595160516151625163516451655166516751685169517051715172517351745175517651775178517951805181518251835184518551865187518851895190519151925193519451955196519751985199520052015202520352045205520652075208520952105211521252135214521552165217521852195220522152225223522452255226522752285229523052315232523352345235523652375238523952405241524252435244524552465247524852495250525152525253525452555256525752585259526052615262526352645265526652675268526952705271527252735274527552765277527852795280528152825283528452855286528752885289529052915292529352945295529652975298529953005301530253035304530553065307530853095310531153125313531453155316531753185319532053215322532353245325532653275328532953305331533253335334533553365337533853395340534153425343534453455346534753485349535053515352535353545355535653575358535953605361536253635364536553665367536853695370537153725373537453755376537753785379538053815382538353845385538653875388538953905391539253935394539553965397539853995400540154025403540454055406540754085409541054115412541354145415541654175418541954205421542254235424542554265427542854295430543154325433543454355436543754385439544054415442544354445445544654475448544954505451545254535454545554565457545854595460546154625463546454655466546754685469547054715472547354745475547654775478547954805481548254835484548554865487548854895490549154925493549454955496549754985499550055015502550355045505550655075508550955105511551255135514551555165517551855195520552155225523552455255526552755285529553055315532553355345535553655375538553955405541554255435544554555465547554855495550555155525553555455555556555755585559556055615562556355645565556655675568556955705571557255735574557555765577557855795580558155825583558455855586558755885589559055915592559355945595559655975598559956005601560256035604560556065607560856095610561156125613561456155616561756185619562056215622562356245625562656275628562956305631563256335634563556365637563856395640564156425643564456455646564756485649565056515652565356545655565656575658565956605661566256635664566556665667566856695670567156725673567456755676567756785679568056815682568356845685568656875688568956905691569256935694569556965697569856995700570157025703570457055706570757085709571057115712571357145715571657175718571957205721572257235724572557265727572857295730573157325733573457355736573757385739574057415742574357445745574657475748574957505751575257535754575557565757575857595760576157625763576457655766576757685769577057715772577357745775577657775778577957805781578257835784578557865787578857895790579157925793579457955796579757985799580058015802580358045805580658075808580958105811581258135814581558165817581858195820582158225823582458255826582758285829583058315832583358345835583658375838583958405841584258435844584558465847584858495850585158525853585458555856585758585859586058615862586358645865586658675868586958705871587258735874587558765877587858795880588158825883588458855886588758885889589058915892589358945895589658975898589959005901590259035904590559065907590859095910591159125913591459155916591759185919592059215922592359245925592659275928592959305931593259335934593559365937593859395940594159425943594459455946594759485949595059515952595359545955595659575958595959605961596259635964596559665967596859695970597159725973597459755976597759785979598059815982598359845985598659875988598959905991599259935994599559965997599859996000600160026003600460056006600760086009601060116012601360146015601660176018601960206021602260236024602560266027602860296030603160326033603460356036603760386039604060416042604360446045604660476048604960506051605260536054605560566057605860596060606160626063606460656066606760686069607060716072607360746075607660776078607960806081608260836084608560866087608860896090609160926093609460956096609760986099610061016102610361046105610661076108610961106111611261136114611561166117611861196120612161226123612461256126612761286129613061316132613361346135613661376138613961406141614261436144614561466147614861496150615161526153615461556156615761586159616061616162616361646165616661676168616961706171617261736174617561766177617861796180618161826183618461856186618761886189619061916192619361946195619661976198619962006201620262036204620562066207620862096210621162126213621462156216621762186219622062216222622362246225622662276228622962306231623262336234623562366237623862396240624162426243624462456246624762486249625062516252625362546255625662576258625962606261626262636264626562666267626862696270627162726273627462756276627762786279628062816282628362846285628662876288628962906291629262936294629562966297629862996300630163026303630463056306630763086309631063116312631363146315631663176318631963206321632263236324632563266327632863296330633163326333633463356336633763386339634063416342634363446345634663476348634963506351635263536354635563566357635863596360636163626363636463656366636763686369637063716372637363746375637663776378637963806381638263836384638563866387638863896390639163926393639463956396639763986399640064016402640364046405640664076408640964106411641264136414641564166417641864196420642164226423642464256426642764286429643064316432643364346435643664376438643964406441644264436444644564466447644864496450645164526453645464556456645764586459646064616462646364646465646664676468646964706471647264736474647564766477647864796480648164826483648464856486648764886489649064916492649364946495649664976498649965006501650265036504650565066507650865096510651165126513651465156516651765186519652065216522652365246525652665276528652965306531653265336534653565366537653865396540654165426543654465456546654765486549655065516552655365546555655665576558655965606561656265636564656565666567656865696570657165726573657465756576657765786579658065816582658365846585658665876588658965906591659265936594659565966597659865996600660166026603660466056606660766086609661066116612661366146615661666176618661966206621662266236624662566266627662866296630663166326633663466356636663766386639664066416642664366446645664666476648664966506651665266536654665566566657665866596660666166626663666466656666666766686669667066716672667366746675667666776678667966806681668266836684668566866687668866896690669166926693669466956696669766986699670067016702670367046705670667076708670967106711671267136714671567166717671867196720672167226723672467256726672767286729673067316732673367346735673667376738673967406741674267436744674567466747674867496750675167526753675467556756675767586759676067616762676367646765676667676768676967706771677267736774677567766777677867796780678167826783678467856786678767886789679067916792679367946795679667976798679968006801680268036804680568066807680868096810681168126813681468156816681768186819682068216822682368246825682668276828682968306831683268336834683568366837683868396840684168426843684468456846684768486849685068516852685368546855685668576858685968606861686268636864686568666867686868696870687168726873687468756876687768786879688068816882688368846885688668876888688968906891689268936894689568966897689868996900690169026903690469056906690769086909691069116912691369146915691669176918691969206921692269236924692569266927692869296930693169326933693469356936693769386939694069416942694369446945694669476948694969506951695269536954695569566957695869596960696169626963696469656966696769686969697069716972697369746975697669776978697969806981698269836984698569866987698869896990699169926993699469956996699769986999700070017002700370047005700670077008700970107011701270137014701570167017701870197020702170227023702470257026702770287029703070317032703370347035703670377038703970407041704270437044704570467047704870497050705170527053705470557056705770587059706070617062706370647065706670677068706970707071707270737074707570767077707870797080708170827083708470857086708770887089709070917092709370947095709670977098709971007101710271037104710571067107710871097110711171127113711471157116711771187119712071217122712371247125712671277128712971307131713271337134713571367137713871397140714171427143714471457146714771487149715071517152715371547155715671577158715971607161716271637164716571667167716871697170717171727173717471757176717771787179718071817182718371847185718671877188718971907191719271937194719571967197719871997200720172027203720472057206720772087209721072117212721372147215721672177218721972207221722272237224722572267227722872297230723172327233723472357236723772387239724072417242724372447245724672477248724972507251725272537254725572567257725872597260726172627263726472657266726772687269727072717272727372747275727672777278727972807281728272837284728572867287728872897290729172927293729472957296729772987299730073017302730373047305730673077308730973107311731273137314731573167317731873197320732173227323732473257326732773287329733073317332733373347335733673377338733973407341734273437344734573467347734873497350735173527353735473557356735773587359736073617362736373647365736673677368736973707371737273737374737573767377737873797380738173827383738473857386738773887389739073917392739373947395739673977398739974007401740274037404740574067407740874097410741174127413741474157416741774187419742074217422742374247425742674277428742974307431743274337434743574367437743874397440744174427443744474457446744774487449745074517452745374547455745674577458745974607461746274637464746574667467746874697470747174727473747474757476747774787479748074817482748374847485748674877488748974907491749274937494749574967497749874997500750175027503750475057506750775087509751075117512751375147515751675177518751975207521752275237524752575267527752875297530753175327533753475357536753775387539754075417542754375447545754675477548754975507551755275537554755575567557755875597560756175627563756475657566756775687569757075717572757375747575757675777578757975807581758275837584758575867587758875897590759175927593759475957596759775987599760076017602760376047605760676077608760976107611761276137614761576167617761876197620762176227623762476257626762776287629763076317632763376347635763676377638763976407641764276437644764576467647764876497650765176527653765476557656765776587659766076617662766376647665766676677668766976707671767276737674767576767677767876797680768176827683768476857686768776887689769076917692769376947695769676977698769977007701770277037704770577067707770877097710771177127713771477157716771777187719772077217722772377247725772677277728772977307731773277337734773577367737773877397740774177427743774477457746774777487749775077517752775377547755775677577758775977607761776277637764776577667767776877697770777177727773777477757776777777787779778077817782778377847785778677877788778977907791779277937794779577967797779877997800780178027803780478057806780778087809781078117812781378147815781678177818781978207821782278237824782578267827782878297830783178327833783478357836783778387839784078417842784378447845784678477848784978507851785278537854785578567857785878597860786178627863786478657866786778687869787078717872787378747875787678777878787978807881788278837884788578867887788878897890789178927893789478957896789778987899790079017902790379047905790679077908790979107911791279137914791579167917791879197920792179227923792479257926792779287929793079317932793379347935793679377938793979407941794279437944794579467947794879497950795179527953795479557956795779587959796079617962796379647965796679677968796979707971797279737974797579767977797879797980798179827983798479857986798779887989799079917992799379947995799679977998799980008001800280038004800580068007800880098010801180128013801480158016801780188019802080218022802380248025802680278028802980308031803280338034803580368037803880398040804180428043804480458046804780488049805080518052805380548055805680578058805980608061806280638064806580668067806880698070807180728073807480758076807780788079808080818082808380848085808680878088808980908091809280938094809580968097809880998100810181028103810481058106810781088109811081118112811381148115811681178118811981208121812281238124812581268127812881298130813181328133813481358136813781388139814081418142814381448145814681478148814981508151815281538154815581568157815881598160816181628163816481658166816781688169817081718172817381748175817681778178817981808181818281838184818581868187818881898190819181928193819481958196819781988199820082018202820382048205820682078208820982108211821282138214821582168217821882198220822182228223822482258226822782288229823082318232823382348235823682378238823982408241824282438244824582468247
  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, _T(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(_i("Printer disconnected"));////MSG_PRINTER_DISCONNECTED c=20 r=1
  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(_T(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(_i("Print paused"));////MSG_PRINT_PAUSED c=20 r=1
  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(_T(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(_T(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(_T(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(_T(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(_T(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(_T(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(_T(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(_T(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(_T(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(_T(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(_i("PID cal. "));////MSG_PID_RUNNING c=20 r=1
  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(_i("PID cal. finished"));////MSG_PID_FINISHED c=20 r=1
  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(_T(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(_i("Nozzle FAN:"));////MSG_INFO_NOZZLE_FAN c=11 r=1
  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(_i("Print FAN: "));////MSG_INFO_PRINT_FAN c=11 r=1
  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, _T(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. #elif 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, _T(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, _T(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, _T(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, _T(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, _i("prusa3d.com"), 0);////MSG_PRUSA3D c=0 r=0
  1590. MENU_ITEM(back, _i("forum.prusa3d.com"), 0);////MSG_PRUSA3D_FORUM c=0 r=0
  1591. MENU_ITEM(back, _i("howto.prusa3d.com"), 0);////MSG_PRUSA3D_HOWTO c=0 r=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, _i("Date:"), 0);////MSG_DATE c=17 r=1
  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, _i("XYZ cal. details"), lcd_menu_xyz_y_min);////MSG_XYZ_DETAILS c=19 r=1
  1608. MENU_ITEM(submenu, _i("Extruder info"), lcd_menu_extruder_info);////MSG_INFO_EXTRUDER c=15 r=1
  1609. #ifdef TMC2130
  1610. MENU_ITEM(submenu, _i("Belt status"), lcd_menu_belt_status);////MSG_MENU_BELT_STATUS c=15 r=1
  1611. #endif //TMC2130
  1612. MENU_ITEM(submenu, _i("Temperatures"), lcd_menu_temperatures);////MSG_MENU_TEMPERATURES c=15 r=1
  1613. #if defined (VOLT_BED_PIN) || defined (VOLT_PWR_PIN)
  1614. MENU_ITEM(submenu, _i("Voltages"), lcd_menu_voltages);////MSG_MENU_VOLTAGES c=15 r=1
  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. }
  1631. void lcd_unLoadFilament()
  1632. {
  1633. if (degHotend0() > EXTRUDE_MINTEMP) {
  1634. enquecommand_P(PSTR("M702")); //unload filament
  1635. } else {
  1636. lcd_implementation_clear();
  1637. lcd.setCursor(0, 0);
  1638. lcd_printPGM(_T(MSG_ERROR));
  1639. lcd.setCursor(0, 2);
  1640. lcd_printPGM(_T(MSG_PREHEAT_NOZZLE));
  1641. delay(2000);
  1642. lcd_implementation_clear();
  1643. }
  1644. menu_action_back();
  1645. }
  1646. void lcd_change_filament() {
  1647. lcd_implementation_clear();
  1648. lcd.setCursor(0, 1);
  1649. lcd_printPGM(_i("Changing filament!"));////MSG_CHANGING_FILAMENT c=20 r=0
  1650. }
  1651. void lcd_wait_interact() {
  1652. lcd_implementation_clear();
  1653. lcd.setCursor(0, 1);
  1654. #ifdef SNMM
  1655. lcd_printPGM(_i("Prepare new filament"));////MSG_PREPARE_FILAMENT c=20 r=1
  1656. #else
  1657. lcd_printPGM(_i("Insert filament"));////MSG_INSERT_FILAMENT c=20 r=0
  1658. #endif
  1659. lcd.setCursor(0, 2);
  1660. lcd_printPGM(_i("and press the knob"));////MSG_PRESS c=20 r=0
  1661. }
  1662. void lcd_change_success() {
  1663. lcd_implementation_clear();
  1664. lcd.setCursor(0, 2);
  1665. lcd_printPGM(_i("Change success!"));////MSG_CHANGE_SUCCESS c=0 r=0
  1666. }
  1667. void lcd_loading_color() {
  1668. lcd_implementation_clear();
  1669. lcd.setCursor(0, 0);
  1670. lcd_printPGM(_i("Loading color"));////MSG_LOADING_COLOR c=0 r=0
  1671. lcd.setCursor(0, 2);
  1672. lcd_printPGM(_T(MSG_PLEASE_WAIT));
  1673. for (int i = 0; i < 20; i++) {
  1674. lcd.setCursor(i, 3);
  1675. lcd.print(".");
  1676. for (int j = 0; j < 10 ; j++) {
  1677. manage_heater();
  1678. manage_inactivity(true);
  1679. delay(85);
  1680. }
  1681. }
  1682. }
  1683. void lcd_loading_filament() {
  1684. lcd_implementation_clear();
  1685. lcd.setCursor(0, 0);
  1686. lcd_printPGM(_T(MSG_LOADING_FILAMENT));
  1687. lcd.setCursor(0, 2);
  1688. lcd_printPGM(_T(MSG_PLEASE_WAIT));
  1689. for (int i = 0; i < 20; i++) {
  1690. lcd.setCursor(i, 3);
  1691. lcd.print(".");
  1692. for (int j = 0; j < 10 ; j++) {
  1693. manage_heater();
  1694. manage_inactivity(true);
  1695. #ifdef SNMM
  1696. delay(153);
  1697. #else
  1698. delay(137);
  1699. #endif
  1700. }
  1701. }
  1702. }
  1703. void lcd_alright() {
  1704. int enc_dif = 0;
  1705. int cursor_pos = 1;
  1706. lcd_implementation_clear();
  1707. lcd.setCursor(0, 0);
  1708. lcd_printPGM(_i("Changed correctly?"));////MSG_CORRECTLY c=20 r=0
  1709. lcd.setCursor(1, 1);
  1710. lcd_printPGM(_T(MSG_YES));
  1711. lcd.setCursor(1, 2);
  1712. lcd_printPGM(_i("Filament not loaded"));////MSG_NOT_LOADED c=19 r=0
  1713. lcd.setCursor(1, 3);
  1714. lcd_printPGM(_i("Color not correct"));////MSG_NOT_COLOR c=0 r=0
  1715. lcd.setCursor(0, 1);
  1716. lcd.print(">");
  1717. enc_dif = encoderDiff;
  1718. while (lcd_change_fil_state == 0) {
  1719. manage_heater();
  1720. manage_inactivity(true);
  1721. if ( abs((enc_dif - encoderDiff)) > 4 ) {
  1722. if ( (abs(enc_dif - encoderDiff)) > 1 ) {
  1723. if (enc_dif > encoderDiff ) {
  1724. cursor_pos --;
  1725. }
  1726. if (enc_dif < encoderDiff ) {
  1727. cursor_pos ++;
  1728. }
  1729. if (cursor_pos > 3) {
  1730. cursor_pos = 3;
  1731. }
  1732. if (cursor_pos < 1) {
  1733. cursor_pos = 1;
  1734. }
  1735. lcd.setCursor(0, 1);
  1736. lcd.print(" ");
  1737. lcd.setCursor(0, 2);
  1738. lcd.print(" ");
  1739. lcd.setCursor(0, 3);
  1740. lcd.print(" ");
  1741. lcd.setCursor(0, cursor_pos);
  1742. lcd.print(">");
  1743. enc_dif = encoderDiff;
  1744. delay(100);
  1745. }
  1746. }
  1747. if (lcd_clicked()) {
  1748. lcd_change_fil_state = cursor_pos;
  1749. delay(500);
  1750. }
  1751. };
  1752. lcd_implementation_clear();
  1753. lcd_return_to_status();
  1754. }
  1755. #ifdef PAT9125
  1756. static void lcd_menu_AutoLoadFilament()
  1757. {
  1758. if (degHotend0() > EXTRUDE_MINTEMP)
  1759. {
  1760. uint8_t nlines;
  1761. lcd_display_message_fullscreen_nonBlocking_P(_i("Autoloading filament is active, just press the knob and insert filament..."),nlines);////MSG_AUTOLOADING_ENABLED c=20 r=4
  1762. }
  1763. else
  1764. {
  1765. Timer* ptimer = (Timer*)&(menuData.autoLoadFilamentMenu.dummy);
  1766. if (!ptimer->running()) ptimer->start();
  1767. lcd.setCursor(0, 0);
  1768. lcd_printPGM(_T(MSG_ERROR));
  1769. lcd.setCursor(0, 2);
  1770. lcd_printPGM(_T(MSG_PREHEAT_NOZZLE));
  1771. if (ptimer->expired(2000ul)) menu_action_back();
  1772. }
  1773. if (lcd_clicked()) menu_action_back();
  1774. }
  1775. #endif //PAT9125
  1776. static void lcd_LoadFilament()
  1777. {
  1778. if (degHotend0() > EXTRUDE_MINTEMP)
  1779. {
  1780. custom_message = true;
  1781. loading_flag = true;
  1782. enquecommand_P(PSTR("M701")); //load filament
  1783. SERIAL_ECHOLN("Loading filament");
  1784. lcd_return_to_status();
  1785. }
  1786. else
  1787. {
  1788. lcd_implementation_clear();
  1789. lcd.setCursor(0, 0);
  1790. lcd_printPGM(_T(MSG_ERROR));
  1791. lcd.setCursor(0, 2);
  1792. lcd_printPGM(_T(MSG_PREHEAT_NOZZLE));
  1793. delay(2000);
  1794. lcd_implementation_clear();
  1795. }
  1796. }
  1797. void lcd_menu_statistics()
  1798. {
  1799. if (IS_SD_PRINTING)
  1800. {
  1801. int _met = total_filament_used / 100000;
  1802. int _cm = (total_filament_used - (_met * 100000))/10;
  1803. int _t = (millis() - starttime) / 1000;
  1804. int _h = _t / 3600;
  1805. int _m = (_t - (_h * 3600)) / 60;
  1806. int _s = _t - ((_h * 3600) + (_m * 60));
  1807. lcd.setCursor(0, 0);
  1808. lcd_printPGM(_i("Filament used: "));////MSG_STATS_FILAMENTUSED c=20 r=0
  1809. lcd.setCursor(6, 1);
  1810. lcd.print(itostr3(_met));
  1811. lcd.print("m ");
  1812. lcd.print(ftostr32ns(_cm));
  1813. lcd.print("cm");
  1814. lcd.setCursor(0, 2);
  1815. lcd_printPGM(_i("Print time: "));////MSG_STATS_PRINTTIME c=20 r=0
  1816. lcd.setCursor(8, 3);
  1817. lcd.print(itostr2(_h));
  1818. lcd.print("h ");
  1819. lcd.print(itostr2(_m));
  1820. lcd.print("m ");
  1821. lcd.print(itostr2(_s));
  1822. lcd.print("s");
  1823. if (lcd_clicked())
  1824. {
  1825. lcd_quick_feedback();
  1826. menu_action_back();
  1827. }
  1828. }
  1829. else
  1830. {
  1831. unsigned long _filament = eeprom_read_dword((uint32_t *)EEPROM_FILAMENTUSED);
  1832. unsigned long _time = eeprom_read_dword((uint32_t *)EEPROM_TOTALTIME); //in minutes
  1833. uint8_t _hours, _minutes;
  1834. uint32_t _days;
  1835. float _filament_m = (float)_filament;
  1836. int _filament_km = (_filament >= 100000) ? _filament / 100000 : 0;
  1837. if (_filament_km > 0) _filament_m = _filament - (_filament_km * 100000);
  1838. _days = _time / 1440;
  1839. _hours = (_time - (_days * 1440)) / 60;
  1840. _minutes = _time - ((_days * 1440) + (_hours * 60));
  1841. lcd_implementation_clear();
  1842. lcd.setCursor(0, 0);
  1843. lcd_printPGM(_i("Total filament :"));////MSG_STATS_TOTALFILAMENT c=20 r=0
  1844. lcd.setCursor(17 - strlen(ftostr32ns(_filament_m)), 1);
  1845. lcd.print(ftostr32ns(_filament_m));
  1846. if (_filament_km > 0)
  1847. {
  1848. lcd.setCursor(17 - strlen(ftostr32ns(_filament_m)) - 3, 1);
  1849. lcd.print("km");
  1850. lcd.setCursor(17 - strlen(ftostr32ns(_filament_m)) - 8, 1);
  1851. lcd.print(itostr4(_filament_km));
  1852. }
  1853. lcd.setCursor(18, 1);
  1854. lcd.print("m");
  1855. lcd.setCursor(0, 2);
  1856. lcd_printPGM(_i("Total print time :"));;////MSG_STATS_TOTALPRINTTIME c=20 r=0
  1857. lcd.setCursor(18, 3);
  1858. lcd.print("m");
  1859. lcd.setCursor(14, 3);
  1860. lcd.print(itostr3(_minutes));
  1861. lcd.setCursor(14, 3);
  1862. lcd.print(":");
  1863. lcd.setCursor(12, 3);
  1864. lcd.print("h");
  1865. lcd.setCursor(9, 3);
  1866. lcd.print(itostr3(_hours));
  1867. lcd.setCursor(9, 3);
  1868. lcd.print(":");
  1869. lcd.setCursor(7, 3);
  1870. lcd.print("d");
  1871. lcd.setCursor(4, 3);
  1872. lcd.print(itostr3(_days));
  1873. KEEPALIVE_STATE(PAUSED_FOR_USER);
  1874. while (!lcd_clicked())
  1875. {
  1876. manage_heater();
  1877. manage_inactivity(true);
  1878. delay(100);
  1879. }
  1880. KEEPALIVE_STATE(NOT_BUSY);
  1881. lcd_quick_feedback();
  1882. menu_action_back();
  1883. }
  1884. }
  1885. static void _lcd_move(const char *name, int axis, int min, int max) {
  1886. if (!menuData._lcd_moveMenu.initialized)
  1887. {
  1888. menuData._lcd_moveMenu.endstopsEnabledPrevious = enable_endstops(false);
  1889. menuData._lcd_moveMenu.initialized = true;
  1890. }
  1891. if (encoderPosition != 0) {
  1892. refresh_cmd_timeout();
  1893. if (! planner_queue_full()) {
  1894. current_position[axis] += float((int)encoderPosition) * move_menu_scale;
  1895. if (min_software_endstops && current_position[axis] < min) current_position[axis] = min;
  1896. if (max_software_endstops && current_position[axis] > max) current_position[axis] = max;
  1897. encoderPosition = 0;
  1898. world2machine_clamp(current_position[X_AXIS], current_position[Y_AXIS]);
  1899. 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);
  1900. lcdDrawUpdate = 1;
  1901. }
  1902. }
  1903. if (lcdDrawUpdate) lcd_implementation_drawedit(name, ftostr31(current_position[axis]));
  1904. if (menuExiting || LCD_CLICKED) (void)enable_endstops(menuData._lcd_moveMenu.endstopsEnabledPrevious);
  1905. if (LCD_CLICKED) menu_action_back();
  1906. }
  1907. static void lcd_move_e()
  1908. {
  1909. if (degHotend0() > EXTRUDE_MINTEMP) {
  1910. if (encoderPosition != 0)
  1911. {
  1912. refresh_cmd_timeout();
  1913. if (! planner_queue_full()) {
  1914. current_position[E_AXIS] += float((int)encoderPosition) * move_menu_scale;
  1915. encoderPosition = 0;
  1916. 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);
  1917. lcdDrawUpdate = 1;
  1918. }
  1919. }
  1920. if (lcdDrawUpdate)
  1921. {
  1922. lcd_implementation_drawedit(PSTR("Extruder"), ftostr31(current_position[E_AXIS]));
  1923. }
  1924. if (LCD_CLICKED) menu_action_back();
  1925. }
  1926. else {
  1927. lcd_implementation_clear();
  1928. lcd.setCursor(0, 0);
  1929. lcd_printPGM(_T(MSG_ERROR));
  1930. lcd.setCursor(0, 2);
  1931. lcd_printPGM(_T(MSG_PREHEAT_NOZZLE));
  1932. delay(2000);
  1933. lcd_return_to_status();
  1934. }
  1935. }
  1936. /**
  1937. * @brief Show measured Y distance of front calibration points from Y_MIN_POS
  1938. *
  1939. * If those points are detected too close to edge of reachable area, their confidence is lowered.
  1940. * This functionality is applied more often for MK2 printers.
  1941. */
  1942. static void lcd_menu_xyz_y_min()
  1943. {
  1944. lcd.setCursor(0,0);
  1945. lcd_printPGM(_i("Y distance from min:"));////MSG_Y_DISTANCE_FROM_MIN c=20 r=1
  1946. lcd_print_at_PGM(0, 1, separator);
  1947. lcd_print_at_PGM(0, 2, _i("Left:"));////MSG_LEFT c=12 r=1
  1948. lcd_print_at_PGM(0, 3, _i("Right:"));////MSG_RIGHT c=12 r=1
  1949. float distanceMin[2];
  1950. count_xyz_details(distanceMin);
  1951. for (int i = 0; i < 2; i++) {
  1952. if(distanceMin[i] < 200) {
  1953. lcd_print_at_PGM(11, i + 2, PSTR(""));
  1954. lcd.print(distanceMin[i]);
  1955. lcd_print_at_PGM((distanceMin[i] < 0) ? 17 : 16, i + 2, PSTR("mm"));
  1956. } else lcd_print_at_PGM(11, i + 2, PSTR("N/A"));
  1957. }
  1958. if (lcd_clicked())
  1959. {
  1960. lcd_goto_menu(lcd_menu_xyz_skew);
  1961. }
  1962. }
  1963. /**
  1964. * @brief Show measured axis skewness
  1965. */
  1966. static void lcd_menu_xyz_skew()
  1967. {
  1968. float angleDiff;
  1969. angleDiff = eeprom_read_float((float*)(EEPROM_XYZ_CAL_SKEW));
  1970. lcd.setCursor(0,0);
  1971. lcd_printPGM(_i("Measured skew:"));////MSG_MEASURED_SKEW c=15 r=1
  1972. if (angleDiff < 100) {
  1973. lcd.setCursor(15, 0);
  1974. lcd.print(angleDiff * 180 / M_PI);
  1975. lcd.print(LCD_STR_DEGREE);
  1976. }else lcd_print_at_PGM(16, 0, PSTR("N/A"));
  1977. lcd_print_at_PGM(0, 1, separator);
  1978. lcd_print_at_PGM(0, 2, _i("Slight skew:"));////MSG_SLIGHT_SKEW c=15 r=1
  1979. lcd_print_at_PGM(15, 2, PSTR(""));
  1980. lcd.print(bed_skew_angle_mild * 180 / M_PI);
  1981. lcd.print(LCD_STR_DEGREE);
  1982. lcd_print_at_PGM(0, 3, _i("Severe skew:"));////MSG_SEVERE_SKEW c=15 r=1
  1983. lcd_print_at_PGM(15, 3, PSTR(""));
  1984. lcd.print(bed_skew_angle_extreme * 180 / M_PI);
  1985. lcd.print(LCD_STR_DEGREE);
  1986. if (lcd_clicked())
  1987. {
  1988. lcd_goto_menu(lcd_menu_xyz_offset);
  1989. }
  1990. }
  1991. /**
  1992. * @brief Show measured bed offset from expected position
  1993. */
  1994. static void lcd_menu_xyz_offset()
  1995. {
  1996. lcd.setCursor(0,0);
  1997. lcd_printPGM(_i("[0;0] point offset"));////MSG_MEASURED_OFFSET c=0 r=0
  1998. lcd_print_at_PGM(0, 1, separator);
  1999. lcd_print_at_PGM(0, 2, PSTR("X"));
  2000. lcd_print_at_PGM(0, 3, PSTR("Y"));
  2001. float vec_x[2];
  2002. float vec_y[2];
  2003. float cntr[2];
  2004. world2machine_read_valid(vec_x, vec_y, cntr);
  2005. for (int i = 0; i < 2; i++)
  2006. {
  2007. lcd_print_at_PGM(11, i + 2, PSTR(""));
  2008. lcd.print(cntr[i]);
  2009. lcd_print_at_PGM((cntr[i] < 0) ? 17 : 16, i + 2, PSTR("mm"));
  2010. }
  2011. if (lcd_clicked())
  2012. {
  2013. menu_action_back();
  2014. }
  2015. }
  2016. // Save a single axis babystep value.
  2017. void EEPROM_save_B(int pos, int* value)
  2018. {
  2019. union Data data;
  2020. data.value = *value;
  2021. eeprom_update_byte((unsigned char*)pos, data.b[0]);
  2022. eeprom_update_byte((unsigned char*)pos + 1, data.b[1]);
  2023. }
  2024. // Read a single axis babystep value.
  2025. void EEPROM_read_B(int pos, int* value)
  2026. {
  2027. union Data data;
  2028. data.b[0] = eeprom_read_byte((unsigned char*)pos);
  2029. data.b[1] = eeprom_read_byte((unsigned char*)pos + 1);
  2030. *value = data.value;
  2031. }
  2032. static void lcd_move_x() {
  2033. _lcd_move(PSTR("X"), X_AXIS, X_MIN_POS, X_MAX_POS);
  2034. }
  2035. static void lcd_move_y() {
  2036. _lcd_move(PSTR("Y"), Y_AXIS, Y_MIN_POS, Y_MAX_POS);
  2037. }
  2038. static void lcd_move_z() {
  2039. _lcd_move(PSTR("Z"), Z_AXIS, Z_MIN_POS, Z_MAX_POS);
  2040. }
  2041. /**
  2042. * @brief Adjust first layer offset from bed if axis is Z_AXIS
  2043. *
  2044. * If menu is left (button pushed or timed out), value is stored to EEPROM and
  2045. * if the axis is Z_AXIS, CALIBRATION_STATUS_CALIBRATED is also stored.
  2046. * Purpose of this function for other axis then Z is unknown.
  2047. *
  2048. * @param axis AxisEnum X_AXIS Y_AXIS Z_AXIS
  2049. * other value leads to storing Z_AXIS
  2050. * @param msg text to be displayed
  2051. */
  2052. static void _lcd_babystep(int axis, const char *msg)
  2053. {
  2054. if (menuData.babyStep.status == 0) {
  2055. // Menu was entered.
  2056. // Initialize its status.
  2057. menuData.babyStep.status = 1;
  2058. check_babystep();
  2059. EEPROM_read_B(EEPROM_BABYSTEP_X, &menuData.babyStep.babystepMem[0]);
  2060. EEPROM_read_B(EEPROM_BABYSTEP_Y, &menuData.babyStep.babystepMem[1]);
  2061. EEPROM_read_B(EEPROM_BABYSTEP_Z, &menuData.babyStep.babystepMem[2]);
  2062. menuData.babyStep.babystepMemMM[0] = menuData.babyStep.babystepMem[0]/axis_steps_per_unit[X_AXIS];
  2063. menuData.babyStep.babystepMemMM[1] = menuData.babyStep.babystepMem[1]/axis_steps_per_unit[Y_AXIS];
  2064. menuData.babyStep.babystepMemMM[2] = menuData.babyStep.babystepMem[2]/axis_steps_per_unit[Z_AXIS];
  2065. lcdDrawUpdate = 1;
  2066. //SERIAL_ECHO("Z baby step: ");
  2067. //SERIAL_ECHO(menuData.babyStep.babystepMem[2]);
  2068. // Wait 90 seconds before closing the live adjust dialog.
  2069. lcd_timeoutToStatus = millis() + 90000;
  2070. }
  2071. if (encoderPosition != 0)
  2072. {
  2073. if (homing_flag) encoderPosition = 0;
  2074. menuData.babyStep.babystepMem[axis] += (int)encoderPosition;
  2075. if (axis == 2) {
  2076. if (menuData.babyStep.babystepMem[axis] < Z_BABYSTEP_MIN) menuData.babyStep.babystepMem[axis] = Z_BABYSTEP_MIN; //-3999 -> -9.99 mm
  2077. else if (menuData.babyStep.babystepMem[axis] > Z_BABYSTEP_MAX) menuData.babyStep.babystepMem[axis] = Z_BABYSTEP_MAX; //0
  2078. else {
  2079. CRITICAL_SECTION_START
  2080. babystepsTodo[axis] += (int)encoderPosition;
  2081. CRITICAL_SECTION_END
  2082. }
  2083. }
  2084. menuData.babyStep.babystepMemMM[axis] = menuData.babyStep.babystepMem[axis]/axis_steps_per_unit[axis];
  2085. delay(50);
  2086. encoderPosition = 0;
  2087. lcdDrawUpdate = 1;
  2088. }
  2089. if (lcdDrawUpdate)
  2090. lcd_implementation_drawedit_2(msg, ftostr13ns(menuData.babyStep.babystepMemMM[axis]));
  2091. if (LCD_CLICKED || menuExiting) {
  2092. // Only update the EEPROM when leaving the menu.
  2093. EEPROM_save_B(
  2094. (axis == X_AXIS) ? EEPROM_BABYSTEP_X : ((axis == Y_AXIS) ? EEPROM_BABYSTEP_Y : EEPROM_BABYSTEP_Z),
  2095. &menuData.babyStep.babystepMem[axis]);
  2096. if(Z_AXIS == axis) calibration_status_store(CALIBRATION_STATUS_CALIBRATED);
  2097. }
  2098. if (LCD_CLICKED) menu_action_back();
  2099. }
  2100. static void lcd_babystep_x() {
  2101. _lcd_babystep(X_AXIS, (_i("Babystepping X")));////MSG_BABYSTEPPING_X c=0 r=0
  2102. }
  2103. static void lcd_babystep_y() {
  2104. _lcd_babystep(Y_AXIS, (_i("Babystepping Y")));////MSG_BABYSTEPPING_Y c=0 r=0
  2105. }
  2106. static void lcd_babystep_z() {
  2107. _lcd_babystep(Z_AXIS, (_i("Adjusting Z")));////MSG_BABYSTEPPING_Z c=20 r=0
  2108. }
  2109. static void lcd_adjust_bed();
  2110. /**
  2111. * @brief adjust bed reset menu item function
  2112. *
  2113. * To be used as MENU_ITEM(function,...) inside lcd_adjust_bed submenu. In such case lcd_goto_menu usage
  2114. * is correct and doesn't break menuStack.
  2115. * Because we did not leave the menu, the menuData did not reset.
  2116. * Force refresh of the bed leveling data.
  2117. */
  2118. static void lcd_adjust_bed_reset()
  2119. {
  2120. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_VALID, 1);
  2121. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_LEFT , 0);
  2122. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_RIGHT, 0);
  2123. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_FRONT, 0);
  2124. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_REAR , 0);
  2125. lcd_goto_menu(lcd_adjust_bed, 0, false); //doesn't break menuStack
  2126. menuData.adjustBed.status = 0;
  2127. }
  2128. void adjust_bed_reset() {
  2129. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_VALID, 1);
  2130. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_LEFT, 0);
  2131. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_RIGHT, 0);
  2132. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_FRONT, 0);
  2133. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_REAR, 0);
  2134. menuData.adjustBed.left = menuData.adjustBed.left2 = 0;
  2135. menuData.adjustBed.right = menuData.adjustBed.right2 = 0;
  2136. menuData.adjustBed.front = menuData.adjustBed.front2 = 0;
  2137. menuData.adjustBed.rear = menuData.adjustBed.rear2 = 0;
  2138. }
  2139. #define BED_ADJUSTMENT_UM_MAX 50
  2140. static void lcd_adjust_bed()
  2141. {
  2142. if (menuData.adjustBed.status == 0) {
  2143. // Menu was entered.
  2144. // Initialize its status.
  2145. menuData.adjustBed.status = 1;
  2146. bool valid = false;
  2147. menuData.adjustBed.left = menuData.adjustBed.left2 = eeprom_read_int8((unsigned char*)EEPROM_BED_CORRECTION_LEFT);
  2148. menuData.adjustBed.right = menuData.adjustBed.right2 = eeprom_read_int8((unsigned char*)EEPROM_BED_CORRECTION_RIGHT);
  2149. menuData.adjustBed.front = menuData.adjustBed.front2 = eeprom_read_int8((unsigned char*)EEPROM_BED_CORRECTION_FRONT);
  2150. menuData.adjustBed.rear = menuData.adjustBed.rear2 = eeprom_read_int8((unsigned char*)EEPROM_BED_CORRECTION_REAR);
  2151. if (eeprom_read_byte((unsigned char*)EEPROM_BED_CORRECTION_VALID) == 1 &&
  2152. menuData.adjustBed.left >= -BED_ADJUSTMENT_UM_MAX && menuData.adjustBed.left <= BED_ADJUSTMENT_UM_MAX &&
  2153. menuData.adjustBed.right >= -BED_ADJUSTMENT_UM_MAX && menuData.adjustBed.right <= BED_ADJUSTMENT_UM_MAX &&
  2154. menuData.adjustBed.front >= -BED_ADJUSTMENT_UM_MAX && menuData.adjustBed.front <= BED_ADJUSTMENT_UM_MAX &&
  2155. menuData.adjustBed.rear >= -BED_ADJUSTMENT_UM_MAX && menuData.adjustBed.rear <= BED_ADJUSTMENT_UM_MAX)
  2156. valid = true;
  2157. if (! valid) {
  2158. // Reset the values: simulate an edit.
  2159. menuData.adjustBed.left2 = 0;
  2160. menuData.adjustBed.right2 = 0;
  2161. menuData.adjustBed.front2 = 0;
  2162. menuData.adjustBed.rear2 = 0;
  2163. }
  2164. lcdDrawUpdate = 1;
  2165. eeprom_update_byte((unsigned char*)EEPROM_BED_CORRECTION_VALID, 1);
  2166. }
  2167. if (menuData.adjustBed.left != menuData.adjustBed.left2)
  2168. eeprom_update_int8((unsigned char*)EEPROM_BED_CORRECTION_LEFT, menuData.adjustBed.left = menuData.adjustBed.left2);
  2169. if (menuData.adjustBed.right != menuData.adjustBed.right2)
  2170. eeprom_update_int8((unsigned char*)EEPROM_BED_CORRECTION_RIGHT, menuData.adjustBed.right = menuData.adjustBed.right2);
  2171. if (menuData.adjustBed.front != menuData.adjustBed.front2)
  2172. eeprom_update_int8((unsigned char*)EEPROM_BED_CORRECTION_FRONT, menuData.adjustBed.front = menuData.adjustBed.front2);
  2173. if (menuData.adjustBed.rear != menuData.adjustBed.rear2)
  2174. eeprom_update_int8((unsigned char*)EEPROM_BED_CORRECTION_REAR, menuData.adjustBed.rear = menuData.adjustBed.rear2);
  2175. START_MENU();
  2176. MENU_ITEM(back, _T(MSG_SETTINGS), 0);
  2177. MENU_ITEM_EDIT(int3, _i("Left side [um]"), &menuData.adjustBed.left2, -BED_ADJUSTMENT_UM_MAX, BED_ADJUSTMENT_UM_MAX);////MSG_BED_CORRECTION_LEFT c=14 r=1
  2178. MENU_ITEM_EDIT(int3, _i("Right side[um]"), &menuData.adjustBed.right2, -BED_ADJUSTMENT_UM_MAX, BED_ADJUSTMENT_UM_MAX);////MSG_BED_CORRECTION_RIGHT c=14 r=1
  2179. MENU_ITEM_EDIT(int3, _i("Front side[um]"), &menuData.adjustBed.front2, -BED_ADJUSTMENT_UM_MAX, BED_ADJUSTMENT_UM_MAX);////MSG_BED_CORRECTION_FRONT c=14 r=1
  2180. MENU_ITEM_EDIT(int3, _i("Rear side [um]"), &menuData.adjustBed.rear2, -BED_ADJUSTMENT_UM_MAX, BED_ADJUSTMENT_UM_MAX);////MSG_BED_CORRECTION_REAR c=14 r=1
  2181. MENU_ITEM(function, _i("Reset"), lcd_adjust_bed_reset);////MSG_BED_CORRECTION_RESET c=0 r=0
  2182. END_MENU();
  2183. }
  2184. void pid_extruder() {
  2185. lcd_implementation_clear();
  2186. lcd.setCursor(1, 0);
  2187. lcd_printPGM(_i("Set temperature:"));////MSG_SET_TEMPERATURE c=19 r=1
  2188. pid_temp += int(encoderPosition);
  2189. if (pid_temp > HEATER_0_MAXTEMP) pid_temp = HEATER_0_MAXTEMP;
  2190. if (pid_temp < HEATER_0_MINTEMP) pid_temp = HEATER_0_MINTEMP;
  2191. encoderPosition = 0;
  2192. lcd.setCursor(1, 2);
  2193. lcd.print(ftostr3(pid_temp));
  2194. if (lcd_clicked()) {
  2195. lcd_commands_type = LCD_COMMAND_PID_EXTRUDER;
  2196. lcd_return_to_status();
  2197. lcd_update(2);
  2198. }
  2199. }
  2200. void lcd_adjust_z() {
  2201. int enc_dif = 0;
  2202. int cursor_pos = 1;
  2203. int fsm = 0;
  2204. lcd_implementation_clear();
  2205. lcd.setCursor(0, 0);
  2206. lcd_printPGM(_i("Auto adjust Z?"));////MSG_ADJUSTZ c=0 r=0
  2207. lcd.setCursor(1, 1);
  2208. lcd_printPGM(_T(MSG_YES));
  2209. lcd.setCursor(1, 2);
  2210. lcd_printPGM(_T(MSG_NO));
  2211. lcd.setCursor(0, 1);
  2212. lcd.print(">");
  2213. enc_dif = encoderDiff;
  2214. while (fsm == 0) {
  2215. manage_heater();
  2216. manage_inactivity(true);
  2217. if ( abs((enc_dif - encoderDiff)) > 4 ) {
  2218. if ( (abs(enc_dif - encoderDiff)) > 1 ) {
  2219. if (enc_dif > encoderDiff ) {
  2220. cursor_pos --;
  2221. }
  2222. if (enc_dif < encoderDiff ) {
  2223. cursor_pos ++;
  2224. }
  2225. if (cursor_pos > 2) {
  2226. cursor_pos = 2;
  2227. }
  2228. if (cursor_pos < 1) {
  2229. cursor_pos = 1;
  2230. }
  2231. lcd.setCursor(0, 1);
  2232. lcd.print(" ");
  2233. lcd.setCursor(0, 2);
  2234. lcd.print(" ");
  2235. lcd.setCursor(0, cursor_pos);
  2236. lcd.print(">");
  2237. enc_dif = encoderDiff;
  2238. delay(100);
  2239. }
  2240. }
  2241. if (lcd_clicked()) {
  2242. fsm = cursor_pos;
  2243. if (fsm == 1) {
  2244. int babystepLoadZ = 0;
  2245. EEPROM_read_B(EEPROM_BABYSTEP_Z, &babystepLoadZ);
  2246. CRITICAL_SECTION_START
  2247. babystepsTodo[Z_AXIS] = babystepLoadZ;
  2248. CRITICAL_SECTION_END
  2249. } else {
  2250. int zero = 0;
  2251. EEPROM_save_B(EEPROM_BABYSTEP_X, &zero);
  2252. EEPROM_save_B(EEPROM_BABYSTEP_Y, &zero);
  2253. EEPROM_save_B(EEPROM_BABYSTEP_Z, &zero);
  2254. }
  2255. delay(500);
  2256. }
  2257. };
  2258. lcd_implementation_clear();
  2259. lcd_return_to_status();
  2260. }
  2261. bool lcd_wait_for_pinda(float temp) {
  2262. lcd_set_custom_characters_degree();
  2263. setTargetHotend(0, 0);
  2264. setTargetBed(0);
  2265. Timer pinda_timeout;
  2266. pinda_timeout.start();
  2267. bool target_temp_reached = true;
  2268. while (current_temperature_pinda > temp){
  2269. lcd_display_message_fullscreen_P(_i("Waiting for PINDA probe cooling"));////MSG_WAITING_TEMP_PINDA c=20 r=3
  2270. lcd.setCursor(0, 4);
  2271. lcd.print(LCD_STR_THERMOMETER[0]);
  2272. lcd.print(ftostr3(current_temperature_pinda));
  2273. lcd.print("/");
  2274. lcd.print(ftostr3(temp));
  2275. lcd.print(LCD_STR_DEGREE);
  2276. delay_keep_alive(1000);
  2277. serialecho_temperatures();
  2278. if (pinda_timeout.expired(8 * 60 * 1000ul)) { //PINDA cooling from 60 C to 35 C takes about 7 minutes
  2279. target_temp_reached = false;
  2280. break;
  2281. }
  2282. }
  2283. lcd_set_custom_characters_arrows();
  2284. lcd_update_enable(true);
  2285. return(target_temp_reached);
  2286. }
  2287. void lcd_wait_for_heater() {
  2288. lcd_display_message_fullscreen_P(_T(MSG_WIZARD_HEATING));
  2289. lcd.setCursor(0, 4);
  2290. lcd.print(LCD_STR_THERMOMETER[0]);
  2291. lcd.print(ftostr3(degHotend(active_extruder)));
  2292. lcd.print("/");
  2293. lcd.print(ftostr3(degTargetHotend(active_extruder)));
  2294. lcd.print(LCD_STR_DEGREE);
  2295. }
  2296. void lcd_wait_for_cool_down() {
  2297. lcd_set_custom_characters_degree();
  2298. setTargetHotend(0,0);
  2299. setTargetBed(0);
  2300. while ((degHotend(0)>MAX_HOTEND_TEMP_CALIBRATION) || (degBed() > MAX_BED_TEMP_CALIBRATION)) {
  2301. lcd_display_message_fullscreen_P(_i("Waiting for nozzle and bed cooling"));////MSG_WAITING_TEMP c=20 r=3
  2302. lcd.setCursor(0, 4);
  2303. lcd.print(LCD_STR_THERMOMETER[0]);
  2304. lcd.print(ftostr3(degHotend(0)));
  2305. lcd.print("/0");
  2306. lcd.print(LCD_STR_DEGREE);
  2307. lcd.setCursor(9, 4);
  2308. lcd.print(LCD_STR_BEDTEMP[0]);
  2309. lcd.print(ftostr3(degBed()));
  2310. lcd.print("/0");
  2311. lcd.print(LCD_STR_DEGREE);
  2312. lcd_set_custom_characters();
  2313. delay_keep_alive(1000);
  2314. serialecho_temperatures();
  2315. }
  2316. lcd_set_custom_characters_arrows();
  2317. lcd_update_enable(true);
  2318. }
  2319. // Lets the user move the Z carriage up to the end stoppers.
  2320. // When done, it sets the current Z to Z_MAX_POS and returns true.
  2321. // Otherwise the Z calibration is not changed and false is returned.
  2322. #ifndef TMC2130
  2323. bool lcd_calibrate_z_end_stop_manual(bool only_z)
  2324. {
  2325. bool clean_nozzle_asked = false;
  2326. // 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.
  2327. current_position[Z_AXIS] = 0;
  2328. plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
  2329. // Until confirmed by the confirmation dialog.
  2330. for (;;) {
  2331. unsigned long previous_millis_cmd = millis();
  2332. const char *msg = only_z ? _i("Calibrating Z. Rotate the knob to move the Z carriage up to the end stoppers. Click when done.") : _i("Calibrating XYZ. Rotate the knob to move the Z carriage up to the end stoppers. Click when done.");////MSG_MOVE_CARRIAGE_TO_THE_TOP c=20 r=8////MSG_MOVE_CARRIAGE_TO_THE_TOP_Z c=20 r=8
  2333. const char *msg_next = lcd_display_message_fullscreen_P(msg);
  2334. const bool multi_screen = msg_next != NULL;
  2335. unsigned long previous_millis_msg = millis();
  2336. // Until the user finishes the z up movement.
  2337. encoderDiff = 0;
  2338. encoderPosition = 0;
  2339. for (;;) {
  2340. // if (millis() - previous_millis_cmd > LCD_TIMEOUT_TO_STATUS)
  2341. // goto canceled;
  2342. manage_heater();
  2343. manage_inactivity(true);
  2344. if (abs(encoderDiff) >= ENCODER_PULSES_PER_STEP) {
  2345. delay(50);
  2346. previous_millis_cmd = millis();
  2347. encoderPosition += abs(encoderDiff / ENCODER_PULSES_PER_STEP);
  2348. encoderDiff = 0;
  2349. if (! planner_queue_full()) {
  2350. // Only move up, whatever direction the user rotates the encoder.
  2351. current_position[Z_AXIS] += fabs(encoderPosition);
  2352. encoderPosition = 0;
  2353. 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);
  2354. }
  2355. }
  2356. if (lcd_clicked()) {
  2357. // Abort a move if in progress.
  2358. planner_abort_hard();
  2359. while (lcd_clicked()) ;
  2360. delay(10);
  2361. while (lcd_clicked()) ;
  2362. break;
  2363. }
  2364. if (multi_screen && millis() - previous_millis_msg > 5000) {
  2365. if (msg_next == NULL)
  2366. msg_next = msg;
  2367. msg_next = lcd_display_message_fullscreen_P(msg_next);
  2368. previous_millis_msg = millis();
  2369. }
  2370. }
  2371. if (! clean_nozzle_asked) {
  2372. lcd_show_fullscreen_message_and_wait_P(_T(MSG_CONFIRM_NOZZLE_CLEAN));
  2373. clean_nozzle_asked = true;
  2374. }
  2375. // Let the user confirm, that the Z carriage is at the top end stoppers.
  2376. int8_t result = lcd_show_fullscreen_message_yes_no_and_wait_P(_i("Are left and right Z~carriages all up?"), false);////MSG_CONFIRM_CARRIAGE_AT_THE_TOP c=20 r=2
  2377. if (result == -1)
  2378. goto canceled;
  2379. else if (result == 1)
  2380. goto calibrated;
  2381. // otherwise perform another round of the Z up dialog.
  2382. }
  2383. calibrated:
  2384. // Let the machine think the Z axis is a bit higher than it is, so it will not home into the bed
  2385. // during the search for the induction points.
  2386. current_position[Z_AXIS] = Z_MAX_POS-3.f;
  2387. plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
  2388. if(only_z){
  2389. lcd_display_message_fullscreen_P(_T(MSG_MEASURE_BED_REFERENCE_HEIGHT_LINE1));
  2390. lcd_implementation_print_at(0, 3, 1);
  2391. lcd_printPGM(_T(MSG_MEASURE_BED_REFERENCE_HEIGHT_LINE2));
  2392. }else{
  2393. //lcd_show_fullscreen_message_and_wait_P(_T(MSG_PAPER));
  2394. lcd_display_message_fullscreen_P(_T(MSG_FIND_BED_OFFSET_AND_SKEW_LINE1));
  2395. lcd_implementation_print_at(0, 2, 1);
  2396. lcd_printPGM(_T(MSG_FIND_BED_OFFSET_AND_SKEW_LINE2));
  2397. }
  2398. return true;
  2399. canceled:
  2400. return false;
  2401. }
  2402. #endif // TMC2130
  2403. static inline bool pgm_is_whitespace(const char *c_addr)
  2404. {
  2405. const char c = pgm_read_byte(c_addr);
  2406. return c == ' ' || c == '\t' || c == '\r' || c == '\n';
  2407. }
  2408. static inline bool pgm_is_interpunction(const char *c_addr)
  2409. {
  2410. const char c = pgm_read_byte(c_addr);
  2411. return c == '.' || c == ',' || c == ':'|| c == ';' || c == '?' || c == '!' || c == '/';
  2412. }
  2413. /**
  2414. * @brief show full screen message
  2415. *
  2416. * This function is non-blocking
  2417. * @param msg message to be displayed from PROGMEM
  2418. * @param nlines
  2419. * @return rest of the text (to be displayed on next page)
  2420. */
  2421. static const char* lcd_display_message_fullscreen_nonBlocking_P(const char *msg, uint8_t &nlines)
  2422. {
  2423. lcd.setCursor(0, 0);
  2424. const char *msgend = msg;
  2425. uint8_t row = 0;
  2426. bool multi_screen = false;
  2427. for (; row < 4; ++ row) {
  2428. while (pgm_is_whitespace(msg))
  2429. ++ msg;
  2430. if (pgm_read_byte(msg) == 0)
  2431. // End of the message.
  2432. break;
  2433. lcd.setCursor(0, row);
  2434. uint8_t linelen = min(strlen_P(msg), 20);
  2435. const char *msgend2 = msg + linelen;
  2436. msgend = msgend2;
  2437. if (row == 3 && linelen == 20) {
  2438. // Last line of the display, full line shall be displayed.
  2439. // Find out, whether this message will be split into multiple screens.
  2440. while (pgm_is_whitespace(msgend))
  2441. ++ msgend;
  2442. multi_screen = pgm_read_byte(msgend) != 0;
  2443. if (multi_screen)
  2444. msgend = (msgend2 -= 2);
  2445. }
  2446. if (pgm_read_byte(msgend) != 0 && ! pgm_is_whitespace(msgend) && ! pgm_is_interpunction(msgend)) {
  2447. // Splitting a word. Find the start of the current word.
  2448. while (msgend > msg && ! pgm_is_whitespace(msgend - 1))
  2449. -- msgend;
  2450. if (msgend == msg)
  2451. // Found a single long word, which cannot be split. Just cut it.
  2452. msgend = msgend2;
  2453. }
  2454. for (; msg < msgend; ++ msg) {
  2455. char c = char(pgm_read_byte(msg));
  2456. if (c == '~')
  2457. c = ' ';
  2458. lcd.print(c);
  2459. }
  2460. }
  2461. if (multi_screen) {
  2462. // Display the "next screen" indicator character.
  2463. // lcd_set_custom_characters_arrows();
  2464. lcd_set_custom_characters_nextpage();
  2465. lcd.setCursor(19, 3);
  2466. // Display the down arrow.
  2467. lcd.print(char(1));
  2468. }
  2469. nlines = row;
  2470. return multi_screen ? msgend : NULL;
  2471. }
  2472. const char* lcd_display_message_fullscreen_P(const char *msg, uint8_t &nlines)
  2473. {
  2474. // Disable update of the screen by the usual lcd_update() routine.
  2475. lcd_update_enable(false);
  2476. lcd_implementation_clear();
  2477. return lcd_display_message_fullscreen_nonBlocking_P(msg, nlines);
  2478. }
  2479. /**
  2480. * @brief show full screen message and wait
  2481. *
  2482. * This function is blocking.
  2483. * @param msg message to be displayed from PROGMEM
  2484. */
  2485. void lcd_show_fullscreen_message_and_wait_P(const char *msg)
  2486. {
  2487. const char *msg_next = lcd_display_message_fullscreen_P(msg);
  2488. bool multi_screen = msg_next != NULL;
  2489. lcd_set_custom_characters_nextpage();
  2490. KEEPALIVE_STATE(PAUSED_FOR_USER);
  2491. // Until confirmed by a button click.
  2492. for (;;) {
  2493. if (!multi_screen) {
  2494. lcd.setCursor(19, 3);
  2495. // Display the confirm char.
  2496. lcd.print(char(2));
  2497. }
  2498. // Wait for 5 seconds before displaying the next text.
  2499. for (uint8_t i = 0; i < 100; ++ i) {
  2500. delay_keep_alive(50);
  2501. if (lcd_clicked()) {
  2502. while (lcd_clicked()) ;
  2503. delay(10);
  2504. while (lcd_clicked()) ;
  2505. if (msg_next == NULL) {
  2506. KEEPALIVE_STATE(IN_HANDLER);
  2507. lcd_set_custom_characters();
  2508. lcd_update_enable(true);
  2509. lcd_update(2);
  2510. return;
  2511. }
  2512. else {
  2513. break;
  2514. }
  2515. }
  2516. }
  2517. if (multi_screen) {
  2518. if (msg_next == NULL)
  2519. msg_next = msg;
  2520. msg_next = lcd_display_message_fullscreen_P(msg_next);
  2521. if (msg_next == NULL) {
  2522. lcd.setCursor(19, 3);
  2523. // Display the confirm char.
  2524. lcd.print(char(2));
  2525. }
  2526. }
  2527. }
  2528. }
  2529. void lcd_wait_for_click()
  2530. {
  2531. KEEPALIVE_STATE(PAUSED_FOR_USER);
  2532. for (;;) {
  2533. manage_heater();
  2534. manage_inactivity(true);
  2535. if (lcd_clicked()) {
  2536. while (lcd_clicked()) ;
  2537. delay(10);
  2538. while (lcd_clicked()) ;
  2539. KEEPALIVE_STATE(IN_HANDLER);
  2540. return;
  2541. }
  2542. }
  2543. }
  2544. 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)
  2545. {
  2546. const char *msg_next = lcd_display_message_fullscreen_P(msg);
  2547. bool multi_screen = msg_next != NULL;
  2548. bool yes = default_yes ? true : false;
  2549. // Wait for user confirmation or a timeout.
  2550. unsigned long previous_millis_cmd = millis();
  2551. int8_t enc_dif = encoderDiff;
  2552. //KEEPALIVE_STATE(PAUSED_FOR_USER);
  2553. for (;;) {
  2554. for (uint8_t i = 0; i < 100; ++i) {
  2555. delay_keep_alive(50);
  2556. if (allow_timeouting && millis() - previous_millis_cmd > LCD_TIMEOUT_TO_STATUS)
  2557. return -1;
  2558. manage_heater();
  2559. manage_inactivity(true);
  2560. if (abs(enc_dif - encoderDiff) > 4) {
  2561. if (msg_next == NULL) {
  2562. lcd.setCursor(0, 3);
  2563. if (enc_dif < encoderDiff && yes) {
  2564. lcd_printPGM((PSTR(" ")));
  2565. lcd.setCursor(7, 3);
  2566. lcd_printPGM((PSTR(">")));
  2567. yes = false;
  2568. }
  2569. else if (enc_dif > encoderDiff && !yes) {
  2570. lcd_printPGM((PSTR(">")));
  2571. lcd.setCursor(7, 3);
  2572. lcd_printPGM((PSTR(" ")));
  2573. yes = true;
  2574. }
  2575. enc_dif = encoderDiff;
  2576. }
  2577. else {
  2578. break; //turning knob skips waiting loop
  2579. }
  2580. }
  2581. if (lcd_clicked()) {
  2582. while (lcd_clicked());
  2583. delay(10);
  2584. while (lcd_clicked());
  2585. if (msg_next == NULL) {
  2586. //KEEPALIVE_STATE(IN_HANDLER);
  2587. lcd_set_custom_characters();
  2588. return yes;
  2589. }
  2590. else break;
  2591. }
  2592. }
  2593. if (multi_screen) {
  2594. if (msg_next == NULL) {
  2595. msg_next = msg;
  2596. }
  2597. msg_next = lcd_display_message_fullscreen_P(msg_next);
  2598. }
  2599. if (msg_next == NULL) {
  2600. lcd.setCursor(0, 3);
  2601. if (yes) lcd_printPGM(PSTR(">"));
  2602. lcd.setCursor(1, 3);
  2603. lcd_printPGM(_T(MSG_YES));
  2604. lcd.setCursor(7, 3);
  2605. if (!yes) lcd_printPGM(PSTR(">"));
  2606. lcd.setCursor(8, 3);
  2607. lcd_printPGM(_T(MSG_NO));
  2608. }
  2609. }
  2610. }
  2611. int8_t lcd_show_fullscreen_message_yes_no_and_wait_P(const char *msg, bool allow_timeouting, bool default_yes)
  2612. {
  2613. lcd_display_message_fullscreen_P(msg);
  2614. if (default_yes) {
  2615. lcd.setCursor(0, 2);
  2616. lcd_printPGM(PSTR(">"));
  2617. lcd_printPGM(_T(MSG_YES));
  2618. lcd.setCursor(1, 3);
  2619. lcd_printPGM(_T(MSG_NO));
  2620. }
  2621. else {
  2622. lcd.setCursor(1, 2);
  2623. lcd_printPGM(_T(MSG_YES));
  2624. lcd.setCursor(0, 3);
  2625. lcd_printPGM(PSTR(">"));
  2626. lcd_printPGM(_T(MSG_NO));
  2627. }
  2628. bool yes = default_yes ? true : false;
  2629. // Wait for user confirmation or a timeout.
  2630. unsigned long previous_millis_cmd = millis();
  2631. int8_t enc_dif = encoderDiff;
  2632. KEEPALIVE_STATE(PAUSED_FOR_USER);
  2633. for (;;) {
  2634. if (allow_timeouting && millis() - previous_millis_cmd > LCD_TIMEOUT_TO_STATUS)
  2635. return -1;
  2636. manage_heater();
  2637. manage_inactivity(true);
  2638. if (abs(enc_dif - encoderDiff) > 4) {
  2639. lcd.setCursor(0, 2);
  2640. if (enc_dif < encoderDiff && yes) {
  2641. lcd_printPGM((PSTR(" ")));
  2642. lcd.setCursor(0, 3);
  2643. lcd_printPGM((PSTR(">")));
  2644. yes = false;
  2645. }
  2646. else if (enc_dif > encoderDiff && !yes) {
  2647. lcd_printPGM((PSTR(">")));
  2648. lcd.setCursor(0, 3);
  2649. lcd_printPGM((PSTR(" ")));
  2650. yes = true;
  2651. }
  2652. enc_dif = encoderDiff;
  2653. }
  2654. if (lcd_clicked()) {
  2655. while (lcd_clicked());
  2656. delay(10);
  2657. while (lcd_clicked());
  2658. KEEPALIVE_STATE(IN_HANDLER);
  2659. return yes;
  2660. }
  2661. }
  2662. }
  2663. void lcd_bed_calibration_show_result(BedSkewOffsetDetectionResultType result, uint8_t point_too_far_mask)
  2664. {
  2665. const char *msg = NULL;
  2666. if (result == BED_SKEW_OFFSET_DETECTION_POINT_NOT_FOUND) {
  2667. lcd_show_fullscreen_message_and_wait_P(_i("XYZ calibration failed. Bed calibration point was not found."));////MSG_BED_SKEW_OFFSET_DETECTION_POINT_NOT_FOUND c=20 r=8
  2668. } else if (result == BED_SKEW_OFFSET_DETECTION_FITTING_FAILED) {
  2669. if (point_too_far_mask == 0)
  2670. msg = _T(MSG_BED_SKEW_OFFSET_DETECTION_FITTING_FAILED);
  2671. else if (point_too_far_mask == 2 || point_too_far_mask == 7)
  2672. // Only the center point or all the three front points.
  2673. msg = _i("XYZ calibration failed. Front calibration points not reachable.");////MSG_BED_SKEW_OFFSET_DETECTION_FAILED_FRONT_BOTH_FAR c=20 r=8
  2674. else if (point_too_far_mask & 1 == 0)
  2675. // The right and maybe the center point out of reach.
  2676. msg = _i("XYZ calibration failed. Right front calibration point not reachable.");////MSG_BED_SKEW_OFFSET_DETECTION_FAILED_FRONT_RIGHT_FAR c=20 r=8
  2677. else
  2678. // The left and maybe the center point out of reach.
  2679. msg = _i("XYZ calibration failed. Left front calibration point not reachable.");////MSG_BED_SKEW_OFFSET_DETECTION_FAILED_FRONT_LEFT_FAR c=20 r=8
  2680. lcd_show_fullscreen_message_and_wait_P(msg);
  2681. } else {
  2682. if (point_too_far_mask != 0) {
  2683. if (point_too_far_mask == 2 || point_too_far_mask == 7)
  2684. // Only the center point or all the three front points.
  2685. msg = _i("XYZ calibration compromised. Front calibration points not reachable.");////MSG_BED_SKEW_OFFSET_DETECTION_WARNING_FRONT_BOTH_FAR c=20 r=8
  2686. else if (point_too_far_mask & 1 == 0)
  2687. // The right and maybe the center point out of reach.
  2688. msg = _i("XYZ calibration compromised. Right front calibration point not reachable.");////MSG_BED_SKEW_OFFSET_DETECTION_WARNING_FRONT_RIGHT_FAR c=20 r=8
  2689. else
  2690. // The left and maybe the center point out of reach.
  2691. msg = _i("XYZ calibration compromised. Left front calibration point not reachable.");////MSG_BED_SKEW_OFFSET_DETECTION_WARNING_FRONT_LEFT_FAR c=20 r=8
  2692. lcd_show_fullscreen_message_and_wait_P(msg);
  2693. }
  2694. if (point_too_far_mask == 0 || result > 0) {
  2695. switch (result) {
  2696. default:
  2697. // should not happen
  2698. msg = _T(MSG_BED_SKEW_OFFSET_DETECTION_FITTING_FAILED);
  2699. break;
  2700. case BED_SKEW_OFFSET_DETECTION_PERFECT:
  2701. msg = _i("XYZ calibration ok. X/Y axes are perpendicular. Congratulations!");////MSG_BED_SKEW_OFFSET_DETECTION_PERFECT c=20 r=8
  2702. break;
  2703. case BED_SKEW_OFFSET_DETECTION_SKEW_MILD:
  2704. msg = _i("XYZ calibration all right. X/Y axes are slightly skewed. Good job!");////MSG_BED_SKEW_OFFSET_DETECTION_SKEW_MILD c=20 r=8
  2705. break;
  2706. case BED_SKEW_OFFSET_DETECTION_SKEW_EXTREME:
  2707. msg = _i("XYZ calibration all right. Skew will be corrected automatically.");////MSG_BED_SKEW_OFFSET_DETECTION_SKEW_EXTREME c=20 r=8
  2708. break;
  2709. }
  2710. lcd_show_fullscreen_message_and_wait_P(msg);
  2711. }
  2712. }
  2713. }
  2714. void lcd_temp_cal_show_result(bool result) {
  2715. custom_message_type = 0;
  2716. custom_message = false;
  2717. disable_x();
  2718. disable_y();
  2719. disable_z();
  2720. disable_e0();
  2721. disable_e1();
  2722. disable_e2();
  2723. setTargetBed(0); //set bed target temperature back to 0
  2724. if (result == true) {
  2725. eeprom_update_byte((uint8_t*)EEPROM_CALIBRATION_STATUS_PINDA, 1);
  2726. SERIAL_ECHOLNPGM("Temperature calibration done. Continue with pressing the knob.");
  2727. lcd_show_fullscreen_message_and_wait_P(_T(MSG_TEMP_CALIBRATION_DONE));
  2728. temp_cal_active = true;
  2729. eeprom_update_byte((unsigned char *)EEPROM_TEMP_CAL_ACTIVE, 1);
  2730. }
  2731. else {
  2732. eeprom_update_byte((uint8_t*)EEPROM_CALIBRATION_STATUS_PINDA, 0);
  2733. SERIAL_ECHOLNPGM("Temperature calibration failed. Continue with pressing the knob.");
  2734. lcd_show_fullscreen_message_and_wait_P(_i("Temperature calibration failed"));////MSG_TEMP_CAL_FAILED c=20 r=8
  2735. temp_cal_active = false;
  2736. eeprom_update_byte((unsigned char *)EEPROM_TEMP_CAL_ACTIVE, 0);
  2737. }
  2738. lcd_update_enable(true);
  2739. lcd_update(2);
  2740. }
  2741. static void lcd_show_end_stops() {
  2742. lcd.setCursor(0, 0);
  2743. lcd_printPGM((PSTR("End stops diag")));
  2744. lcd.setCursor(0, 1);
  2745. lcd_printPGM((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING == 1) ? (PSTR("X1")) : (PSTR("X0")));
  2746. lcd.setCursor(0, 2);
  2747. lcd_printPGM((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING == 1) ? (PSTR("Y1")) : (PSTR("Y0")));
  2748. lcd.setCursor(0, 3);
  2749. lcd_printPGM((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING == 1) ? (PSTR("Z1")) : (PSTR("Z0")));
  2750. }
  2751. static void menu_show_end_stops() {
  2752. lcd_show_end_stops();
  2753. if (LCD_CLICKED) menu_action_back();
  2754. }
  2755. // Lets the user move the Z carriage up to the end stoppers.
  2756. // When done, it sets the current Z to Z_MAX_POS and returns true.
  2757. // Otherwise the Z calibration is not changed and false is returned.
  2758. void lcd_diag_show_end_stops()
  2759. {
  2760. int enc_dif = encoderDiff;
  2761. lcd_implementation_clear();
  2762. for (;;) {
  2763. manage_heater();
  2764. manage_inactivity(true);
  2765. lcd_show_end_stops();
  2766. if (lcd_clicked()) {
  2767. while (lcd_clicked()) ;
  2768. delay(10);
  2769. while (lcd_clicked()) ;
  2770. break;
  2771. }
  2772. }
  2773. lcd_implementation_clear();
  2774. lcd_return_to_status();
  2775. }
  2776. void prusa_statistics(int _message, uint8_t _fil_nr) {
  2777. #ifdef DEBUG_DISABLE_PRUSA_STATISTICS
  2778. return;
  2779. #endif //DEBUG_DISABLE_PRUSA_STATISTICS
  2780. switch (_message)
  2781. {
  2782. case 0: // default message
  2783. if (IS_SD_PRINTING)
  2784. {
  2785. SERIAL_ECHO("{");
  2786. prusa_stat_printerstatus(4);
  2787. prusa_stat_farm_number();
  2788. prusa_stat_printinfo();
  2789. SERIAL_ECHOLN("}");
  2790. status_number = 4;
  2791. }
  2792. else
  2793. {
  2794. SERIAL_ECHO("{");
  2795. prusa_stat_printerstatus(1);
  2796. prusa_stat_farm_number();
  2797. SERIAL_ECHOLN("}");
  2798. status_number = 1;
  2799. }
  2800. break;
  2801. case 1: // 1 heating
  2802. farm_status = 2;
  2803. SERIAL_ECHO("{");
  2804. prusa_stat_printerstatus(2);
  2805. prusa_stat_farm_number();
  2806. SERIAL_ECHOLN("}");
  2807. status_number = 2;
  2808. farm_timer = 1;
  2809. break;
  2810. case 2: // heating done
  2811. farm_status = 3;
  2812. SERIAL_ECHO("{");
  2813. prusa_stat_printerstatus(3);
  2814. prusa_stat_farm_number();
  2815. SERIAL_ECHOLN("}");
  2816. status_number = 3;
  2817. farm_timer = 1;
  2818. if (IS_SD_PRINTING)
  2819. {
  2820. farm_status = 4;
  2821. SERIAL_ECHO("{");
  2822. prusa_stat_printerstatus(4);
  2823. prusa_stat_farm_number();
  2824. SERIAL_ECHOLN("}");
  2825. status_number = 4;
  2826. }
  2827. else
  2828. {
  2829. SERIAL_ECHO("{");
  2830. prusa_stat_printerstatus(3);
  2831. prusa_stat_farm_number();
  2832. SERIAL_ECHOLN("}");
  2833. status_number = 3;
  2834. }
  2835. farm_timer = 1;
  2836. break;
  2837. case 3: // filament change
  2838. break;
  2839. case 4: // print succesfull
  2840. SERIAL_ECHO("{[RES:1][FIL:");
  2841. MYSERIAL.print(int(_fil_nr));
  2842. SERIAL_ECHO("]");
  2843. prusa_stat_printerstatus(status_number);
  2844. prusa_stat_farm_number();
  2845. SERIAL_ECHOLN("}");
  2846. farm_timer = 2;
  2847. break;
  2848. case 5: // print not succesfull
  2849. SERIAL_ECHO("{[RES:0][FIL:");
  2850. MYSERIAL.print(int(_fil_nr));
  2851. SERIAL_ECHO("]");
  2852. prusa_stat_printerstatus(status_number);
  2853. prusa_stat_farm_number();
  2854. SERIAL_ECHOLN("}");
  2855. farm_timer = 2;
  2856. break;
  2857. case 6: // print done
  2858. SERIAL_ECHO("{[PRN:8]");
  2859. prusa_stat_farm_number();
  2860. SERIAL_ECHOLN("}");
  2861. status_number = 8;
  2862. farm_timer = 2;
  2863. break;
  2864. case 7: // print done - stopped
  2865. SERIAL_ECHO("{[PRN:9]");
  2866. prusa_stat_farm_number();
  2867. SERIAL_ECHOLN("}");
  2868. status_number = 9;
  2869. farm_timer = 2;
  2870. break;
  2871. case 8: // printer started
  2872. SERIAL_ECHO("{[PRN:0][PFN:");
  2873. status_number = 0;
  2874. SERIAL_ECHO(farm_no);
  2875. SERIAL_ECHOLN("]}");
  2876. farm_timer = 2;
  2877. break;
  2878. case 20: // echo farm no
  2879. SERIAL_ECHO("{");
  2880. prusa_stat_printerstatus(status_number);
  2881. prusa_stat_farm_number();
  2882. SERIAL_ECHOLN("}");
  2883. farm_timer = 4;
  2884. break;
  2885. case 21: // temperatures
  2886. SERIAL_ECHO("{");
  2887. prusa_stat_temperatures();
  2888. prusa_stat_farm_number();
  2889. prusa_stat_printerstatus(status_number);
  2890. SERIAL_ECHOLN("}");
  2891. break;
  2892. case 22: // waiting for filament change
  2893. SERIAL_ECHO("{[PRN:5]");
  2894. prusa_stat_farm_number();
  2895. SERIAL_ECHOLN("}");
  2896. status_number = 5;
  2897. break;
  2898. case 90: // Error - Thermal Runaway
  2899. SERIAL_ECHO("{[ERR:1]");
  2900. prusa_stat_farm_number();
  2901. SERIAL_ECHOLN("}");
  2902. break;
  2903. case 91: // Error - Thermal Runaway Preheat
  2904. SERIAL_ECHO("{[ERR:2]");
  2905. prusa_stat_farm_number();
  2906. SERIAL_ECHOLN("}");
  2907. break;
  2908. case 92: // Error - Min temp
  2909. SERIAL_ECHO("{[ERR:3]");
  2910. prusa_stat_farm_number();
  2911. SERIAL_ECHOLN("}");
  2912. break;
  2913. case 93: // Error - Max temp
  2914. SERIAL_ECHO("{[ERR:4]");
  2915. prusa_stat_farm_number();
  2916. SERIAL_ECHOLN("}");
  2917. break;
  2918. case 99: // heartbeat
  2919. SERIAL_ECHO("{[PRN:99]");
  2920. prusa_stat_temperatures();
  2921. SERIAL_ECHO("[PFN:");
  2922. SERIAL_ECHO(farm_no);
  2923. SERIAL_ECHO("]");
  2924. SERIAL_ECHOLN("}");
  2925. break;
  2926. }
  2927. }
  2928. static void prusa_stat_printerstatus(int _status)
  2929. {
  2930. SERIAL_ECHO("[PRN:");
  2931. SERIAL_ECHO(_status);
  2932. SERIAL_ECHO("]");
  2933. }
  2934. static void prusa_stat_farm_number() {
  2935. SERIAL_ECHO("[PFN:");
  2936. SERIAL_ECHO(farm_no);
  2937. SERIAL_ECHO("]");
  2938. }
  2939. static void prusa_stat_temperatures()
  2940. {
  2941. SERIAL_ECHO("[ST0:");
  2942. SERIAL_ECHO(target_temperature[0]);
  2943. SERIAL_ECHO("][STB:");
  2944. SERIAL_ECHO(target_temperature_bed);
  2945. SERIAL_ECHO("][AT0:");
  2946. SERIAL_ECHO(current_temperature[0]);
  2947. SERIAL_ECHO("][ATB:");
  2948. SERIAL_ECHO(current_temperature_bed);
  2949. SERIAL_ECHO("]");
  2950. }
  2951. static void prusa_stat_printinfo()
  2952. {
  2953. SERIAL_ECHO("[TFU:");
  2954. SERIAL_ECHO(total_filament_used);
  2955. SERIAL_ECHO("][PCD:");
  2956. SERIAL_ECHO(itostr3(card.percentDone()));
  2957. SERIAL_ECHO("][FEM:");
  2958. SERIAL_ECHO(itostr3(feedmultiply));
  2959. SERIAL_ECHO("][FNM:");
  2960. SERIAL_ECHO(longFilenameOLD);
  2961. SERIAL_ECHO("][TIM:");
  2962. if (starttime != 0)
  2963. {
  2964. SERIAL_ECHO(millis() / 1000 - starttime / 1000);
  2965. }
  2966. else
  2967. {
  2968. SERIAL_ECHO(0);
  2969. }
  2970. SERIAL_ECHO("][FWR:");
  2971. SERIAL_ECHO(FW_VERSION);
  2972. SERIAL_ECHO("]");
  2973. }
  2974. /*
  2975. void lcd_pick_babystep(){
  2976. int enc_dif = 0;
  2977. int cursor_pos = 1;
  2978. int fsm = 0;
  2979. lcd_implementation_clear();
  2980. lcd.setCursor(0, 0);
  2981. lcd_printPGM(_i("Pick print"));////MSG_PICK_Z c=0 r=0
  2982. lcd.setCursor(3, 2);
  2983. lcd.print("1");
  2984. lcd.setCursor(3, 3);
  2985. lcd.print("2");
  2986. lcd.setCursor(12, 2);
  2987. lcd.print("3");
  2988. lcd.setCursor(12, 3);
  2989. lcd.print("4");
  2990. lcd.setCursor(1, 2);
  2991. lcd.print(">");
  2992. enc_dif = encoderDiff;
  2993. while (fsm == 0) {
  2994. manage_heater();
  2995. manage_inactivity(true);
  2996. if ( abs((enc_dif - encoderDiff)) > 4 ) {
  2997. if ( (abs(enc_dif - encoderDiff)) > 1 ) {
  2998. if (enc_dif > encoderDiff ) {
  2999. cursor_pos --;
  3000. }
  3001. if (enc_dif < encoderDiff ) {
  3002. cursor_pos ++;
  3003. }
  3004. if (cursor_pos > 4) {
  3005. cursor_pos = 4;
  3006. }
  3007. if (cursor_pos < 1) {
  3008. cursor_pos = 1;
  3009. }
  3010. lcd.setCursor(1, 2);
  3011. lcd.print(" ");
  3012. lcd.setCursor(1, 3);
  3013. lcd.print(" ");
  3014. lcd.setCursor(10, 2);
  3015. lcd.print(" ");
  3016. lcd.setCursor(10, 3);
  3017. lcd.print(" ");
  3018. if (cursor_pos < 3) {
  3019. lcd.setCursor(1, cursor_pos+1);
  3020. lcd.print(">");
  3021. }else{
  3022. lcd.setCursor(10, cursor_pos-1);
  3023. lcd.print(">");
  3024. }
  3025. enc_dif = encoderDiff;
  3026. delay(100);
  3027. }
  3028. }
  3029. if (lcd_clicked()) {
  3030. fsm = cursor_pos;
  3031. int babyStepZ;
  3032. EEPROM_read_B(EEPROM_BABYSTEP_Z0+((fsm-1)*2),&babyStepZ);
  3033. EEPROM_save_B(EEPROM_BABYSTEP_Z,&babyStepZ);
  3034. calibration_status_store(CALIBRATION_STATUS_CALIBRATED);
  3035. delay(500);
  3036. }
  3037. };
  3038. lcd_implementation_clear();
  3039. lcd_return_to_status();
  3040. }
  3041. */
  3042. void lcd_move_menu_axis()
  3043. {
  3044. START_MENU();
  3045. MENU_ITEM(back, _T(MSG_SETTINGS), 0);
  3046. MENU_ITEM(submenu, _i("Move X"), lcd_move_x);////MSG_MOVE_X c=0 r=0
  3047. MENU_ITEM(submenu, _i("Move Y"), lcd_move_y);////MSG_MOVE_Y c=0 r=0
  3048. MENU_ITEM(submenu, _i("Move Z"), lcd_move_z);////MSG_MOVE_Z c=0 r=0
  3049. MENU_ITEM(submenu, _i("Extruder"), lcd_move_e);////MSG_MOVE_E c=0 r=0
  3050. END_MENU();
  3051. }
  3052. static void lcd_move_menu_1mm()
  3053. {
  3054. move_menu_scale = 1.0;
  3055. lcd_move_menu_axis();
  3056. }
  3057. void EEPROM_save(int pos, uint8_t* value, uint8_t size)
  3058. {
  3059. do
  3060. {
  3061. eeprom_write_byte((unsigned char*)pos, *value);
  3062. pos++;
  3063. value++;
  3064. } while (--size);
  3065. }
  3066. void EEPROM_read(int pos, uint8_t* value, uint8_t size)
  3067. {
  3068. do
  3069. {
  3070. *value = eeprom_read_byte((unsigned char*)pos);
  3071. pos++;
  3072. value++;
  3073. } while (--size);
  3074. }
  3075. #ifdef SDCARD_SORT_ALPHA
  3076. static void lcd_sort_type_set() {
  3077. uint8_t sdSort;
  3078. EEPROM_read(EEPROM_SD_SORT, (uint8_t*)&sdSort, sizeof(sdSort));
  3079. switch (sdSort) {
  3080. case SD_SORT_TIME: sdSort = SD_SORT_ALPHA; break;
  3081. case SD_SORT_ALPHA: sdSort = SD_SORT_NONE; break;
  3082. default: sdSort = SD_SORT_TIME;
  3083. }
  3084. eeprom_update_byte((unsigned char *)EEPROM_SD_SORT, sdSort);
  3085. presort_flag = true;
  3086. lcd_goto_menu(lcd_settings_menu); //doesn't break menuStack
  3087. }
  3088. #endif //SDCARD_SORT_ALPHA
  3089. #ifdef TMC2130
  3090. static void lcd_crash_mode_info()
  3091. {
  3092. lcd_update_enable(true);
  3093. static uint32_t tim = 0;
  3094. if ((tim + 1000) < millis())
  3095. {
  3096. fputs_P(_i("\x1b[2JCrash detection can\x1b[1;0Hbe turned on only in\x1b[2;0HNormal mode"), lcdout);////MSG_CRASH_DET_ONLY_IN_NORMAL c=20 r=4
  3097. tim = millis();
  3098. }
  3099. if (lcd_clicked())
  3100. menu_action_back();
  3101. }
  3102. static void lcd_crash_mode_info2()
  3103. {
  3104. lcd_update_enable(true);
  3105. static uint32_t tim = 0;
  3106. if ((tim + 1000) < millis())
  3107. {
  3108. fputs_P(_i("\x1b[2JWARNING:\x1b[1;0HCrash detection\x1b[2;0Hdisabled in\x1b[3;0HStealth mode"), lcdout);////MSG_CRASH_DET_STEALTH_FORCE_OFF c=20 r=4
  3109. tim = millis();
  3110. }
  3111. if (lcd_clicked())
  3112. menu_action_back();
  3113. }
  3114. #endif //TMC2130
  3115. #ifdef PAT9125
  3116. static void lcd_filament_autoload_info()
  3117. {
  3118. uint8_t nlines;
  3119. lcd_update_enable(true);
  3120. static uint32_t tim = 0;
  3121. if ((tim + 1000) < millis())
  3122. {
  3123. lcd_display_message_fullscreen_nonBlocking_P(_i("Autoloading filament available only when filament sensor is turned on..."), nlines); ////MSG_AUTOLOADING_ONLY_IF_FSENS_ON c=20 r=4
  3124. tim = millis();
  3125. }
  3126. if (lcd_clicked())
  3127. menu_action_back();
  3128. }
  3129. static void lcd_fsensor_fail()
  3130. {
  3131. uint8_t nlines;
  3132. lcd_update_enable(true);
  3133. static uint32_t tim = 0;
  3134. if ((tim + 1000) < millis())
  3135. {
  3136. lcd_display_message_fullscreen_nonBlocking_P(_i("ERROR: Filament sensor is not responding, please check connection."), nlines);////MSG_FSENS_NOT_RESPONDING c=20 r=4
  3137. tim = millis();
  3138. }
  3139. if (lcd_clicked())
  3140. menu_action_back();
  3141. }
  3142. #endif //PAT9125
  3143. static void lcd_silent_mode_set() {
  3144. switch (SilentModeMenu) {
  3145. #ifdef TMC2130
  3146. case SILENT_MODE_NORMAL: SilentModeMenu = SILENT_MODE_STEALTH; break;
  3147. case SILENT_MODE_STEALTH: SilentModeMenu = SILENT_MODE_NORMAL; break;
  3148. default: SilentModeMenu = SILENT_MODE_NORMAL; break; // (probably) not needed
  3149. #else
  3150. case SILENT_MODE_POWER: SilentModeMenu = SILENT_MODE_SILENT; break;
  3151. case SILENT_MODE_SILENT: SilentModeMenu = SILENT_MODE_AUTO; break;
  3152. case SILENT_MODE_AUTO: SilentModeMenu = SILENT_MODE_POWER; break;
  3153. default: SilentModeMenu = SILENT_MODE_POWER; break; // (probably) not needed
  3154. #endif //TMC2130
  3155. }
  3156. eeprom_update_byte((unsigned char *)EEPROM_SILENT, SilentModeMenu);
  3157. #ifdef TMC2130
  3158. // Wait until the planner queue is drained and the stepper routine achieves
  3159. // an idle state.
  3160. st_synchronize();
  3161. if (tmc2130_wait_standstill_xy(1000)) {}
  3162. // MYSERIAL.print("standstill OK");
  3163. // else
  3164. // MYSERIAL.print("standstill NG!");
  3165. cli();
  3166. tmc2130_mode = (SilentModeMenu != SILENT_MODE_NORMAL)?TMC2130_MODE_SILENT:TMC2130_MODE_NORMAL;
  3167. tmc2130_init();
  3168. // We may have missed a stepper timer interrupt due to the time spent in tmc2130_init.
  3169. // Be safe than sorry, reset the stepper timer before re-enabling interrupts.
  3170. st_reset_timer();
  3171. sei();
  3172. #endif //TMC2130
  3173. st_current_init();
  3174. #ifdef TMC2130
  3175. if (CrashDetectMenu && (SilentModeMenu != SILENT_MODE_NORMAL))
  3176. menu_action_submenu(lcd_crash_mode_info2);
  3177. #endif //TMC2130
  3178. }
  3179. #ifdef TMC2130
  3180. static void lcd_crash_mode_set()
  3181. {
  3182. CrashDetectMenu = !CrashDetectMenu; //set also from crashdet_enable() and crashdet_disable()
  3183. if (CrashDetectMenu==0) {
  3184. crashdet_disable();
  3185. }else{
  3186. crashdet_enable();
  3187. }
  3188. if (IS_SD_PRINTING || is_usb_printing || (lcd_commands_type == LCD_COMMAND_V2_CAL)) lcd_goto_menu(lcd_tune_menu, 9);
  3189. else lcd_goto_menu(lcd_settings_menu, 9);
  3190. }
  3191. #endif //TMC2130
  3192. static void lcd_set_lang(unsigned char lang)
  3193. {
  3194. lang_select(lang);
  3195. /*
  3196. lang_selected = lang;
  3197. firstrun = 1;
  3198. eeprom_update_byte((unsigned char *)EEPROM_LANG, lang);
  3199. // langsel=0;
  3200. if (langsel == LANGSEL_MODAL)
  3201. // From modal mode to an active mode? This forces the menu to return to the setup menu.
  3202. langsel = LANGSEL_ACTIVE;
  3203. */
  3204. }
  3205. #ifdef PAT9125
  3206. static void lcd_fsensor_state_set()
  3207. {
  3208. FSensorStateMenu = !FSensorStateMenu; //set also from fsensor_enable() and fsensor_disable()
  3209. if (!FSensorStateMenu) {
  3210. fsensor_disable();
  3211. if (filament_autoload_enabled)
  3212. menu_action_submenu(lcd_filament_autoload_info);
  3213. }else{
  3214. fsensor_enable();
  3215. if (fsensor_not_responding)
  3216. menu_action_submenu(lcd_fsensor_fail);
  3217. }
  3218. }
  3219. #endif //PAT9125
  3220. #if !SDSORT_USES_RAM
  3221. void lcd_set_degree() {
  3222. lcd_set_custom_characters_degree();
  3223. }
  3224. void lcd_set_progress() {
  3225. lcd_set_custom_characters_progress();
  3226. }
  3227. #endif
  3228. void lcd_force_language_selection() {
  3229. eeprom_update_byte((unsigned char *)EEPROM_LANG, LANG_ID_FORCE_SELECTION);
  3230. }
  3231. #if (LANG_MODE != 0)
  3232. static void lcd_language_menu()
  3233. {
  3234. START_MENU();
  3235. if (langsel == LANGSEL_OFF)
  3236. MENU_ITEM(back, _T(MSG_SETTINGS), 0);
  3237. else if (langsel == LANGSEL_ACTIVE)
  3238. MENU_ITEM(back, _T(MSG_WATCH), 0);
  3239. MENU_ITEM(setlang, lang_get_name_by_code(lang_get_code(0)), 0);
  3240. // MENU_ITEM(setlang, lang_get_name_by_code(lang_get_code(1)), 1);
  3241. for (int i = 2; i < lang_get_count(); i++)
  3242. MENU_ITEM(setlang, lang_get_name_by_code(lang_get_code(i)), i);
  3243. END_MENU();
  3244. }
  3245. #endif //(LANG_MODE != 0)
  3246. void lcd_mesh_bedleveling()
  3247. {
  3248. mesh_bed_run_from_menu = true;
  3249. enquecommand_P(PSTR("G80"));
  3250. lcd_return_to_status();
  3251. }
  3252. void lcd_mesh_calibration()
  3253. {
  3254. enquecommand_P(PSTR("M45"));
  3255. lcd_return_to_status();
  3256. }
  3257. void lcd_mesh_calibration_z()
  3258. {
  3259. enquecommand_P(PSTR("M45 Z"));
  3260. lcd_return_to_status();
  3261. }
  3262. void lcd_pinda_calibration_menu()
  3263. {
  3264. START_MENU();
  3265. MENU_ITEM(back, _T(MSG_MENU_CALIBRATION), 0);
  3266. MENU_ITEM(submenu, _i("Calibrate"), lcd_calibrate_pinda);////MSG_CALIBRATE_PINDA c=17 r=1
  3267. END_MENU();
  3268. }
  3269. void lcd_temp_calibration_set() {
  3270. temp_cal_active = !temp_cal_active;
  3271. eeprom_update_byte((unsigned char *)EEPROM_TEMP_CAL_ACTIVE, temp_cal_active);
  3272. st_current_init();
  3273. lcd_goto_menu(lcd_settings_menu); //doesn't break menuStack
  3274. }
  3275. #ifdef HAS_SECOND_SERIAL_PORT
  3276. void lcd_second_serial_set() {
  3277. if(selectedSerialPort == 1) selectedSerialPort = 0;
  3278. else selectedSerialPort = 1;
  3279. eeprom_update_byte((unsigned char *)EEPROM_SECOND_SERIAL_ACTIVE, selectedSerialPort);
  3280. MYSERIAL.begin(BAUDRATE);
  3281. lcd_goto_menu(lcd_settings_menu);//doesn't break menuStack
  3282. }
  3283. #endif //HAS_SECOND_SERIAL_PORT
  3284. void lcd_calibrate_pinda() {
  3285. enquecommand_P(PSTR("G76"));
  3286. lcd_return_to_status();
  3287. }
  3288. #ifndef SNMM
  3289. /*void lcd_calibrate_extruder() {
  3290. if (degHotend0() > EXTRUDE_MINTEMP)
  3291. {
  3292. current_position[E_AXIS] = 0; //set initial position to zero
  3293. plan_set_e_position(current_position[E_AXIS]);
  3294. //long steps_start = st_get_position(E_AXIS);
  3295. long steps_final;
  3296. float e_steps_per_unit;
  3297. 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)
  3298. 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
  3299. const char *msg_e_cal_knob = _i("Rotate knob until mark reaches extruder body. Click when done.");////MSG_E_CAL_KNOB c=20 r=8
  3300. const char *msg_next_e_cal_knob = lcd_display_message_fullscreen_P(msg_e_cal_knob);
  3301. const bool multi_screen = msg_next_e_cal_knob != NULL;
  3302. unsigned long msg_millis;
  3303. lcd_show_fullscreen_message_and_wait_P(_i("Mark filament 100mm from extruder body. Click when done."));////MSG_MARK_FIL c=20 r=8
  3304. lcd_implementation_clear();
  3305. lcd.setCursor(0, 1); lcd_printPGM(_T(MSG_PLEASE_WAIT));
  3306. current_position[E_AXIS] += e_shift_calibration;
  3307. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], feedrate, active_extruder);
  3308. st_synchronize();
  3309. lcd_display_message_fullscreen_P(msg_e_cal_knob);
  3310. msg_millis = millis();
  3311. while (!LCD_CLICKED) {
  3312. if (multi_screen && millis() - msg_millis > 5000) {
  3313. if (msg_next_e_cal_knob == NULL)
  3314. msg_next_e_cal_knob = msg_e_cal_knob;
  3315. msg_next_e_cal_knob = lcd_display_message_fullscreen_P(msg_next_e_cal_knob);
  3316. msg_millis = millis();
  3317. }
  3318. //manage_inactivity(true);
  3319. manage_heater();
  3320. if (abs(encoderDiff) >= ENCODER_PULSES_PER_STEP) { //adjusting mark by knob rotation
  3321. delay_keep_alive(50);
  3322. //previous_millis_cmd = millis();
  3323. encoderPosition += (encoderDiff / ENCODER_PULSES_PER_STEP);
  3324. encoderDiff = 0;
  3325. if (!planner_queue_full()) {
  3326. current_position[E_AXIS] += float(abs((int)encoderPosition)) * 0.01; //0.05
  3327. encoderPosition = 0;
  3328. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], feedrate, active_extruder);
  3329. }
  3330. }
  3331. }
  3332. steps_final = current_position[E_AXIS] * axis_steps_per_unit[E_AXIS];
  3333. //steps_final = st_get_position(E_AXIS);
  3334. lcdDrawUpdate = 1;
  3335. e_steps_per_unit = ((float)(steps_final)) / 100.0f;
  3336. if (e_steps_per_unit < MIN_E_STEPS_PER_UNIT) e_steps_per_unit = MIN_E_STEPS_PER_UNIT;
  3337. if (e_steps_per_unit > MAX_E_STEPS_PER_UNIT) e_steps_per_unit = MAX_E_STEPS_PER_UNIT;
  3338. lcd_implementation_clear();
  3339. axis_steps_per_unit[E_AXIS] = e_steps_per_unit;
  3340. enquecommand_P(PSTR("M500")); //store settings to eeprom
  3341. //lcd_implementation_drawedit(PSTR("Result"), ftostr31(axis_steps_per_unit[E_AXIS]));
  3342. //delay_keep_alive(2000);
  3343. delay_keep_alive(500);
  3344. lcd_show_fullscreen_message_and_wait_P(_i("E calibration finished. Please clean the nozzle. Click when done."));////MSG_CLEAN_NOZZLE_E c=20 r=8
  3345. lcd_update_enable(true);
  3346. lcdDrawUpdate = 2;
  3347. }
  3348. else
  3349. {
  3350. lcd_implementation_clear();
  3351. lcd.setCursor(0, 0);
  3352. lcd_printPGM(_T(MSG_ERROR));
  3353. lcd.setCursor(0, 2);
  3354. lcd_printPGM(_T(MSG_PREHEAT_NOZZLE));
  3355. delay(2000);
  3356. lcd_implementation_clear();
  3357. }
  3358. lcd_return_to_status();
  3359. }
  3360. void lcd_extr_cal_reset() {
  3361. float tmp1[] = DEFAULT_AXIS_STEPS_PER_UNIT;
  3362. axis_steps_per_unit[E_AXIS] = tmp1[3];
  3363. //extrudemultiply = 100;
  3364. enquecommand_P(PSTR("M500"));
  3365. }*/
  3366. #endif
  3367. void lcd_toshiba_flash_air_compatibility_toggle()
  3368. {
  3369. card.ToshibaFlashAir_enable(! card.ToshibaFlashAir_isEnabled());
  3370. eeprom_update_byte((uint8_t*)EEPROM_TOSHIBA_FLASH_AIR_COMPATIBLITY, card.ToshibaFlashAir_isEnabled());
  3371. }
  3372. void lcd_v2_calibration() {
  3373. bool loaded = lcd_show_fullscreen_message_yes_no_and_wait_P(_i("Is PLA filament loaded?"), false, true);////MSG_PLA_FILAMENT_LOADED c=20 r=2
  3374. if (loaded) {
  3375. lcd_commands_type = LCD_COMMAND_V2_CAL;
  3376. }
  3377. else {
  3378. lcd_display_message_fullscreen_P(_i("Please load PLA filament first."));////MSG_PLEASE_LOAD_PLA c=20 r=4
  3379. for (int i = 0; i < 20; i++) { //wait max. 2s
  3380. delay_keep_alive(100);
  3381. if (lcd_clicked()) {
  3382. while (lcd_clicked());
  3383. delay(10);
  3384. while (lcd_clicked());
  3385. break;
  3386. }
  3387. }
  3388. }
  3389. lcd_return_to_status();
  3390. lcd_update_enable(true);
  3391. }
  3392. void lcd_wizard() {
  3393. bool result = true;
  3394. if (calibration_status() != CALIBRATION_STATUS_ASSEMBLED) {
  3395. result = lcd_show_multiscreen_message_yes_no_and_wait_P(_i("Running Wizard will delete current calibration results and start from the beginning. Continue?"), false, false);////MSG_WIZARD_RERUN c=20 r=7
  3396. }
  3397. if (result) {
  3398. calibration_status_store(CALIBRATION_STATUS_ASSEMBLED);
  3399. lcd_wizard(0);
  3400. }
  3401. else {
  3402. lcd_return_to_status();
  3403. lcd_update_enable(true);
  3404. lcd_update(2);
  3405. }
  3406. }
  3407. void lcd_wizard(int state) {
  3408. bool end = false;
  3409. int wizard_event;
  3410. const char *msg = NULL;
  3411. while (!end) {
  3412. switch (state) {
  3413. case 0: // run wizard?
  3414. wizard_event = lcd_show_multiscreen_message_yes_no_and_wait_P(_i("Hi, I am your Original Prusa i3 printer. Would you like me to guide you through the setup process?"), false, true);////MSG_WIZARD_WELCOME c=20 r=7
  3415. if (wizard_event) {
  3416. state = 1;
  3417. eeprom_write_byte((uint8_t*)EEPROM_WIZARD_ACTIVE, 1);
  3418. }
  3419. else {
  3420. eeprom_write_byte((uint8_t*)EEPROM_WIZARD_ACTIVE, 0);
  3421. end = true;
  3422. }
  3423. break;
  3424. case 1: // restore calibration status
  3425. switch (calibration_status()) {
  3426. case CALIBRATION_STATUS_ASSEMBLED: state = 2; break; //run selftest
  3427. case CALIBRATION_STATUS_XYZ_CALIBRATION: state = 3; break; //run xyz cal.
  3428. case CALIBRATION_STATUS_Z_CALIBRATION: state = 4; break; //run z cal.
  3429. case CALIBRATION_STATUS_LIVE_ADJUST: state = 5; break; //run live adjust
  3430. case CALIBRATION_STATUS_CALIBRATED: end = true; eeprom_write_byte((uint8_t*)EEPROM_WIZARD_ACTIVE, 0); break;
  3431. default: state = 2; break; //if calibration status is unknown, run wizard from the beginning
  3432. }
  3433. break;
  3434. case 2: //selftest
  3435. lcd_show_fullscreen_message_and_wait_P(_i("First, I will run the selftest to check most common assembly problems."));////MSG_WIZARD_SELFTEST c=20 r=8
  3436. wizard_event = lcd_selftest();
  3437. if (wizard_event) {
  3438. calibration_status_store(CALIBRATION_STATUS_XYZ_CALIBRATION);
  3439. state = 3;
  3440. }
  3441. else end = true;
  3442. break;
  3443. case 3: //xyz cal.
  3444. lcd_show_fullscreen_message_and_wait_P(_i("I will run xyz calibration now. It will take approx. 12 mins."));////MSG_WIZARD_XYZ_CAL c=20 r=8
  3445. wizard_event = gcode_M45(false, 0);
  3446. if (wizard_event) state = 5;
  3447. else end = true;
  3448. break;
  3449. case 4: //z cal.
  3450. lcd_show_fullscreen_message_and_wait_P(_i("I will run z calibration now."));////MSG_WIZARD_Z_CAL c=20 r=8
  3451. wizard_event = lcd_show_fullscreen_message_yes_no_and_wait_P(_T(MSG_STEEL_SHEET_CHECK), false, false);
  3452. if (!wizard_event) lcd_show_fullscreen_message_and_wait_P(_T(MSG_PLACE_STEEL_SHEET));
  3453. wizard_event = gcode_M45(true, 0);
  3454. if (wizard_event) state = 11; //shipped, no need to set first layer, go to final message directly
  3455. else end = true;
  3456. break;
  3457. case 5: //is filament loaded?
  3458. //start to preheat nozzle and bed to save some time later
  3459. setTargetHotend(PLA_PREHEAT_HOTEND_TEMP, 0);
  3460. setTargetBed(PLA_PREHEAT_HPB_TEMP);
  3461. wizard_event = lcd_show_fullscreen_message_yes_no_and_wait_P(_i("Is filament loaded?"), false);////MSG_WIZARD_FILAMENT_LOADED c=20 r=2
  3462. if (wizard_event) state = 8;
  3463. else state = 6;
  3464. break;
  3465. case 6: //waiting for preheat nozzle for PLA;
  3466. #ifndef SNMM
  3467. lcd_display_message_fullscreen_P(_i("Now I will preheat nozzle for PLA."));////MSG_WIZARD_WILL_PREHEAT c=20 r=4
  3468. current_position[Z_AXIS] = 100; //move in z axis to make space for loading filament
  3469. 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);
  3470. delay_keep_alive(2000);
  3471. lcd_display_message_fullscreen_P(_T(MSG_WIZARD_HEATING));
  3472. while (abs(degHotend(0) - PLA_PREHEAT_HOTEND_TEMP) > 3) {
  3473. lcd_display_message_fullscreen_P(_T(MSG_WIZARD_HEATING));
  3474. lcd.setCursor(0, 4);
  3475. lcd.print(LCD_STR_THERMOMETER[0]);
  3476. lcd.print(ftostr3(degHotend(0)));
  3477. lcd.print("/");
  3478. lcd.print(PLA_PREHEAT_HOTEND_TEMP);
  3479. lcd.print(LCD_STR_DEGREE);
  3480. lcd_set_custom_characters();
  3481. delay_keep_alive(1000);
  3482. }
  3483. #endif //not SNMM
  3484. state = 7;
  3485. break;
  3486. case 7: //load filament
  3487. #ifdef PAT9125
  3488. fsensor_block();
  3489. #endif //PAT9125
  3490. lcd_show_fullscreen_message_and_wait_P(_i("Please insert PLA filament to the extruder, then press knob to load it."));////MSG_WIZARD_LOAD_FILAMENT c=20 r=8
  3491. lcd_update_enable(false);
  3492. lcd_implementation_clear();
  3493. lcd_print_at_PGM(0, 2, _T(MSG_LOADING_FILAMENT));
  3494. #ifdef SNMM
  3495. change_extr(0);
  3496. #endif
  3497. gcode_M701();
  3498. #ifdef PAT9125
  3499. fsensor_unblock();
  3500. #endif //PAT9125
  3501. state = 9;
  3502. break;
  3503. case 8:
  3504. wizard_event = lcd_show_fullscreen_message_yes_no_and_wait_P(_i("Is it PLA filament?"), false, true);////MSG_WIZARD_PLA_FILAMENT c=20 r=2
  3505. if (wizard_event) state = 9;
  3506. else end = true;
  3507. break;
  3508. case 9:
  3509. lcd_show_fullscreen_message_and_wait_P(_i("Now I will calibrate distance between tip of the nozzle and heatbed surface."));////MSG_WIZARD_V2_CAL c=20 r=8
  3510. lcd_show_fullscreen_message_and_wait_P(_i("I will start to print line and you will gradually lower the nozzle by rotating the knob, until you reach optimal height. Check the pictures in our handbook in chapter Calibration."));////MSG_WIZARD_V2_CAL_2 c=20 r=12
  3511. lcd_commands_type = LCD_COMMAND_V2_CAL;
  3512. end = true;
  3513. break;
  3514. case 10: //repeat first layer cal.?
  3515. wizard_event = lcd_show_multiscreen_message_yes_no_and_wait_P(_i("Do you want to repeat last step to readjust distance between nozzle and heatbed?"), false);////MSG_WIZARD_REPEAT_V2_CAL c=20 r=7
  3516. if (wizard_event) {
  3517. lcd_show_fullscreen_message_and_wait_P(_i("Please clean heatbed and then press the knob."));////MSG_WIZARD_CLEAN_HEATBED c=20 r=8
  3518. state = 9;
  3519. }
  3520. else {
  3521. state = 11;
  3522. }
  3523. break;
  3524. case 11: //we are finished
  3525. eeprom_write_byte((uint8_t*)EEPROM_WIZARD_ACTIVE, 0);
  3526. end = true;
  3527. break;
  3528. default: break;
  3529. }
  3530. }
  3531. SERIAL_ECHOPGM("State: ");
  3532. MYSERIAL.println(state);
  3533. switch (state) { //final message
  3534. case 0: //user dont want to use wizard
  3535. msg = _T(MSG_WIZARD_QUIT);
  3536. break;
  3537. case 1: //printer was already calibrated
  3538. msg = _T(MSG_WIZARD_DONE);
  3539. break;
  3540. case 2: //selftest
  3541. msg = _T(MSG_WIZARD_CALIBRATION_FAILED);
  3542. break;
  3543. case 3: //xyz cal.
  3544. msg = _T(MSG_WIZARD_CALIBRATION_FAILED);
  3545. break;
  3546. case 4: //z cal.
  3547. msg = _T(MSG_WIZARD_CALIBRATION_FAILED);
  3548. break;
  3549. case 8:
  3550. msg = _i("Please load PLA filament and then resume Wizard by rebooting the printer.");////MSG_WIZARD_INSERT_CORRECT_FILAMENT c=20 r=8
  3551. break;
  3552. case 9: break; //exit wizard for v2 calibration, which is implemted in lcd_commands (we need lcd_update running)
  3553. case 11: //we are finished
  3554. msg = _T(MSG_WIZARD_DONE);
  3555. lcd_reset_alert_level();
  3556. lcd_setstatuspgm(_T(WELCOME_MSG));
  3557. break;
  3558. default:
  3559. msg = _T(MSG_WIZARD_QUIT);
  3560. break;
  3561. }
  3562. if (state != 9) lcd_show_fullscreen_message_and_wait_P(msg);
  3563. lcd_update_enable(true);
  3564. lcd_return_to_status();
  3565. lcd_update(2);
  3566. }
  3567. static void lcd_settings_menu()
  3568. {
  3569. EEPROM_read(EEPROM_SILENT, (uint8_t*)&SilentModeMenu, sizeof(SilentModeMenu));
  3570. START_MENU();
  3571. MENU_ITEM(back, _T(MSG_MAIN), lcd_settings_menu_back);
  3572. MENU_ITEM(submenu, _i("Temperature"), lcd_control_temperature_menu);////MSG_TEMPERATURE c=0 r=0
  3573. if (!homing_flag)
  3574. {
  3575. MENU_ITEM(submenu, _i("Move axis"), lcd_move_menu_1mm);////MSG_MOVE_AXIS c=0 r=0
  3576. }
  3577. if (!isPrintPaused)
  3578. {
  3579. MENU_ITEM(gcode, _i("Disable steppers"), PSTR("M84"));////MSG_DISABLE_STEPPERS c=0 r=0
  3580. }
  3581. #ifndef TMC2130
  3582. if (!farm_mode) { //dont show in menu if we are in farm mode
  3583. switch (SilentModeMenu) {
  3584. case SILENT_MODE_POWER: MENU_ITEM(function, _T(MSG_SILENT_MODE_OFF), lcd_silent_mode_set); break;
  3585. case SILENT_MODE_SILENT: MENU_ITEM(function, _T(MSG_SILENT_MODE_ON), lcd_silent_mode_set); break;
  3586. case SILENT_MODE_AUTO: MENU_ITEM(function, _T(MSG_AUTO_MODE_ON), lcd_silent_mode_set); break;
  3587. default: MENU_ITEM(function, _T(MSG_SILENT_MODE_OFF), lcd_silent_mode_set); break; // (probably) not needed
  3588. }
  3589. }
  3590. #endif //TMC2130
  3591. #ifdef PAT9125
  3592. #ifndef DEBUG_DISABLE_FSENSORCHECK
  3593. if (FSensorStateMenu == 0) {
  3594. if (fsensor_not_responding){
  3595. // Filament sensor not working
  3596. MENU_ITEM(function, _i("Fil. sensor [N/A]"), lcd_fsensor_state_set);////MSG_FSENSOR_NA c=0 r=0
  3597. MENU_ITEM(submenu, _T(MSG_FSENS_AUTOLOAD_NA), lcd_fsensor_fail);
  3598. }
  3599. else{
  3600. // Filament sensor turned off, working, no problems
  3601. MENU_ITEM(function, _T(MSG_FSENSOR_OFF), lcd_fsensor_state_set);
  3602. MENU_ITEM(submenu,_T(MSG_FSENS_AUTOLOAD_NA), lcd_filament_autoload_info);
  3603. }
  3604. } else {
  3605. // Filament sensor turned on, working, no problems
  3606. MENU_ITEM(function, _T(MSG_FSENSOR_ON), lcd_fsensor_state_set);
  3607. if (filament_autoload_enabled) {
  3608. MENU_ITEM(function, _i("F. autoload [on]"), lcd_set_filament_autoload);////MSG_FSENS_AUTOLOAD_ON c=17 r=1
  3609. }
  3610. else {
  3611. MENU_ITEM(function, _i("F. autoload [off]"), lcd_set_filament_autoload);////MSG_FSENS_AUTOLOAD_OFF c=17 r=1
  3612. }
  3613. }
  3614. #endif //DEBUG_DISABLE_FSENSORCHECK
  3615. #endif //PAT9125
  3616. if (fans_check_enabled == true) {
  3617. MENU_ITEM(function, _i("Fans check [on]"), lcd_set_fan_check);////MSG_FANS_CHECK_ON c=17 r=1
  3618. }
  3619. else {
  3620. MENU_ITEM(function, _i("Fans check [off]"), lcd_set_fan_check);////MSG_FANS_CHECK_OFF c=17 r=1
  3621. }
  3622. #ifdef TMC2130
  3623. if(!farm_mode)
  3624. {
  3625. //*** MaR::180416_01a
  3626. if (SilentModeMenu == SILENT_MODE_NORMAL) MENU_ITEM(function, _T(MSG_STEALTH_MODE_OFF), lcd_silent_mode_set);
  3627. else MENU_ITEM(function, _T(MSG_STEALTH_MODE_ON), lcd_silent_mode_set);
  3628. if (SilentModeMenu == SILENT_MODE_NORMAL)
  3629. {
  3630. if (CrashDetectMenu == 0) MENU_ITEM(function, _T(MSG_CRASHDETECT_OFF), lcd_crash_mode_set);
  3631. else MENU_ITEM(function, _T(MSG_CRASHDETECT_ON), lcd_crash_mode_set);
  3632. }
  3633. else MENU_ITEM(submenu, _T(MSG_CRASHDETECT_NA), lcd_crash_mode_info);
  3634. }
  3635. #ifdef TMC2130_LINEARITY_CORRECTION_XYZ
  3636. MENU_ITEM_EDIT(wfac, _i("X-correct"), &tmc2130_wave_fac[X_AXIS], TMC2130_WAVE_FAC1000_MIN-TMC2130_WAVE_FAC1000_STP, TMC2130_WAVE_FAC1000_MAX);////MSG_EXTRUDER_CORRECTION c=9 r=0
  3637. MENU_ITEM_EDIT(wfac, _i("Y-correct"), &tmc2130_wave_fac[Y_AXIS], TMC2130_WAVE_FAC1000_MIN-TMC2130_WAVE_FAC1000_STP, TMC2130_WAVE_FAC1000_MAX);////MSG_EXTRUDER_CORRECTION c=9 r=0
  3638. MENU_ITEM_EDIT(wfac, _i("Z-correct"), &tmc2130_wave_fac[Z_AXIS], TMC2130_WAVE_FAC1000_MIN-TMC2130_WAVE_FAC1000_STP, TMC2130_WAVE_FAC1000_MAX);////MSG_EXTRUDER_CORRECTION c=9 r=0
  3639. #endif //TMC2130_LINEARITY_CORRECTION_XYZ
  3640. MENU_ITEM_EDIT(wfac, _i("E-correct"), &tmc2130_wave_fac[E_AXIS], TMC2130_WAVE_FAC1000_MIN-TMC2130_WAVE_FAC1000_STP, TMC2130_WAVE_FAC1000_MAX);////MSG_EXTRUDER_CORRECTION c=9 r=0
  3641. #endif //TMC2130
  3642. if (temp_cal_active == false) {
  3643. MENU_ITEM(function, _i("Temp. cal. [off]"), lcd_temp_calibration_set);////MSG_TEMP_CALIBRATION_OFF c=20 r=1
  3644. }
  3645. else {
  3646. MENU_ITEM(function, _i("Temp. cal. [on]"), lcd_temp_calibration_set);////MSG_TEMP_CALIBRATION_ON c=20 r=1
  3647. }
  3648. #ifdef HAS_SECOND_SERIAL_PORT
  3649. if (selectedSerialPort == 0) {
  3650. MENU_ITEM(function, _i("RPi port [off]"), lcd_second_serial_set);////MSG_SECOND_SERIAL_OFF c=17 r=1
  3651. }
  3652. else {
  3653. MENU_ITEM(function, _i("RPi port [on]"), lcd_second_serial_set);////MSG_SECOND_SERIAL_ON c=17 r=1
  3654. }
  3655. #endif //HAS_SECOND_SERIAL
  3656. if (!isPrintPaused && !homing_flag)
  3657. {
  3658. MENU_ITEM(submenu, _T(MSG_BABYSTEP_Z), lcd_babystep_z);
  3659. }
  3660. #if (LANG_MODE != 0)
  3661. MENU_ITEM(submenu, _i("Select language"), lcd_language_menu);////MSG_LANGUAGE_SELECT c=0 r=0
  3662. #endif //(LANG_MODE != 0)
  3663. if (card.ToshibaFlashAir_isEnabled()) {
  3664. MENU_ITEM(function, _i("SD card [FlshAir]"), lcd_toshiba_flash_air_compatibility_toggle);////MSG_TOSHIBA_FLASH_AIR_COMPATIBILITY_ON c=19 r=1
  3665. } else {
  3666. MENU_ITEM(function, _i("SD card [normal]"), lcd_toshiba_flash_air_compatibility_toggle);////MSG_TOSHIBA_FLASH_AIR_COMPATIBILITY_OFF c=19 r=1
  3667. }
  3668. #ifdef SDCARD_SORT_ALPHA
  3669. if (!farm_mode) {
  3670. uint8_t sdSort;
  3671. EEPROM_read(EEPROM_SD_SORT, (uint8_t*)&sdSort, sizeof(sdSort));
  3672. switch (sdSort) {
  3673. case SD_SORT_TIME: MENU_ITEM(function, _i("Sort: [Time]"), lcd_sort_type_set); break;////MSG_SORT_TIME c=17 r=1
  3674. case SD_SORT_ALPHA: MENU_ITEM(function, _i("Sort: [Alphabet]"), lcd_sort_type_set); break;////MSG_SORT_ALPHA c=17 r=1
  3675. default: MENU_ITEM(function, _i("Sort: [None]"), lcd_sort_type_set);////MSG_SORT_NONE c=17 r=1
  3676. }
  3677. }
  3678. #endif // SDCARD_SORT_ALPHA
  3679. if (farm_mode)
  3680. {
  3681. MENU_ITEM(submenu, PSTR("Farm number"), lcd_farm_no);
  3682. MENU_ITEM(function, PSTR("Disable farm mode"), lcd_disable_farm_mode);
  3683. }
  3684. END_MENU();
  3685. }
  3686. static void lcd_selftest_()
  3687. {
  3688. lcd_selftest();
  3689. }
  3690. #ifdef TMC2130
  3691. static void lcd_ustep_linearity_menu_save()
  3692. {
  3693. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_WAVE_X_FAC, tmc2130_wave_fac[X_AXIS]);
  3694. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_WAVE_Y_FAC, tmc2130_wave_fac[Y_AXIS]);
  3695. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_WAVE_Z_FAC, tmc2130_wave_fac[Z_AXIS]);
  3696. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_WAVE_E_FAC, tmc2130_wave_fac[E_AXIS]);
  3697. }
  3698. #endif //TMC2130
  3699. static void lcd_settings_menu_back()
  3700. {
  3701. #ifdef TMC2130
  3702. bool changed = false;
  3703. if (tmc2130_wave_fac[X_AXIS] < TMC2130_WAVE_FAC1000_MIN) tmc2130_wave_fac[X_AXIS] = 0;
  3704. if (tmc2130_wave_fac[Y_AXIS] < TMC2130_WAVE_FAC1000_MIN) tmc2130_wave_fac[Y_AXIS] = 0;
  3705. if (tmc2130_wave_fac[Z_AXIS] < TMC2130_WAVE_FAC1000_MIN) tmc2130_wave_fac[Z_AXIS] = 0;
  3706. if (tmc2130_wave_fac[E_AXIS] < TMC2130_WAVE_FAC1000_MIN) tmc2130_wave_fac[E_AXIS] = 0;
  3707. changed |= (eeprom_read_byte((uint8_t*)EEPROM_TMC2130_WAVE_X_FAC) != tmc2130_wave_fac[X_AXIS]);
  3708. changed |= (eeprom_read_byte((uint8_t*)EEPROM_TMC2130_WAVE_Y_FAC) != tmc2130_wave_fac[Y_AXIS]);
  3709. changed |= (eeprom_read_byte((uint8_t*)EEPROM_TMC2130_WAVE_Z_FAC) != tmc2130_wave_fac[Z_AXIS]);
  3710. changed |= (eeprom_read_byte((uint8_t*)EEPROM_TMC2130_WAVE_E_FAC) != tmc2130_wave_fac[E_AXIS]);
  3711. lcd_ustep_linearity_menu_save();
  3712. if (changed) tmc2130_init();
  3713. #endif //TMC2130
  3714. currentMenu = lcd_main_menu;
  3715. lcd_main_menu();
  3716. }
  3717. #ifdef EXPERIMENTAL_FEATURES
  3718. static void lcd_experimantal_menu();
  3719. static void lcd_homing_accuracy_menu();
  3720. static void lcd_accurate_home_set()
  3721. {
  3722. tmc2130_home_enabled = tmc2130_home_enabled?0:1;
  3723. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_ENABLED, tmc2130_home_enabled);
  3724. }
  3725. static void lcd_homing_accuracy_menu_advanced_reset()
  3726. {
  3727. tmc2130_home_bsteps[X_AXIS] = 48;
  3728. tmc2130_home_fsteps[X_AXIS] = 48;
  3729. tmc2130_home_bsteps[Y_AXIS] = 48;
  3730. tmc2130_home_fsteps[Y_AXIS] = 48;
  3731. }
  3732. static void lcd_homing_accuracy_menu_advanced_save()
  3733. {
  3734. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_X_ORIGIN, tmc2130_home_origin[X_AXIS]);
  3735. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_X_BSTEPS, tmc2130_home_bsteps[X_AXIS]);
  3736. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_X_FSTEPS, tmc2130_home_fsteps[X_AXIS]);
  3737. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_Y_ORIGIN, tmc2130_home_origin[Y_AXIS]);
  3738. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_Y_BSTEPS, tmc2130_home_bsteps[Y_AXIS]);
  3739. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_Y_FSTEPS, tmc2130_home_fsteps[Y_AXIS]);
  3740. }
  3741. static void lcd_homing_accuracy_menu_advanced_back()
  3742. {
  3743. lcd_homing_accuracy_menu_advanced_save();
  3744. currentMenu = lcd_homing_accuracy_menu;
  3745. lcd_homing_accuracy_menu();
  3746. }
  3747. static void lcd_homing_accuracy_menu_advanced()
  3748. {
  3749. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  3750. START_MENU();
  3751. MENU_ITEM(back, PSTR("Homing accuracy"), lcd_homing_accuracy_menu_advanced_back);
  3752. MENU_ITEM(function, PSTR("Reset def. steps"), lcd_homing_accuracy_menu_advanced_reset);
  3753. MENU_ITEM_EDIT(byte3, PSTR("X-origin"), &tmc2130_home_origin[X_AXIS], 0, 63);
  3754. MENU_ITEM_EDIT(byte3, PSTR("Y-origin"), &tmc2130_home_origin[Y_AXIS], 0, 63);
  3755. MENU_ITEM_EDIT(byte3, PSTR("X-bsteps"), &tmc2130_home_bsteps[X_AXIS], 0, 128);
  3756. MENU_ITEM_EDIT(byte3, PSTR("Y-bsteps"), &tmc2130_home_bsteps[Y_AXIS], 0, 128);
  3757. MENU_ITEM_EDIT(byte3, PSTR("X-fsteps"), &tmc2130_home_fsteps[X_AXIS], 0, 128);
  3758. MENU_ITEM_EDIT(byte3, PSTR("Y-fsteps"), &tmc2130_home_fsteps[Y_AXIS], 0, 128);
  3759. END_MENU();
  3760. }
  3761. static void lcd_homing_accuracy_menu()
  3762. {
  3763. START_MENU();
  3764. MENU_ITEM(back, PSTR("Experimental"), 0);
  3765. MENU_ITEM(function, tmc2130_home_enabled?PSTR("Accur. homing On"):PSTR("Accur. homing Off"), lcd_accurate_home_set);
  3766. MENU_ITEM(gcode, PSTR("Calibrate X"), PSTR("G28XC"));
  3767. MENU_ITEM(gcode, PSTR("Calibrate Y"), PSTR("G28YC"));
  3768. MENU_ITEM(submenu, PSTR("Advanced"), lcd_homing_accuracy_menu_advanced);
  3769. END_MENU();
  3770. }
  3771. static void lcd_ustep_resolution_menu_save()
  3772. {
  3773. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_X_MRES, tmc2130_mres[X_AXIS]);
  3774. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_Y_MRES, tmc2130_mres[Y_AXIS]);
  3775. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_Z_MRES, tmc2130_mres[Z_AXIS]);
  3776. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_E_MRES, tmc2130_mres[E_AXIS]);
  3777. }
  3778. static void lcd_ustep_resolution_menu_back()
  3779. {
  3780. float tmp1[]=DEFAULT_AXIS_STEPS_PER_UNIT;
  3781. bool changed = false;
  3782. if (tmc2130_mres[X_AXIS] != eeprom_read_byte((uint8_t*)EEPROM_TMC2130_X_MRES))
  3783. {
  3784. axis_steps_per_unit[X_AXIS] = tmp1[X_AXIS] * tmc2130_mres2usteps(tmc2130_mres[X_AXIS]) / TMC2130_USTEPS_XY;
  3785. changed = true;
  3786. }
  3787. if (tmc2130_mres[Y_AXIS] != eeprom_read_byte((uint8_t*)EEPROM_TMC2130_Y_MRES))
  3788. {
  3789. axis_steps_per_unit[Y_AXIS] = tmp1[Y_AXIS] * tmc2130_mres2usteps(tmc2130_mres[Y_AXIS]) / TMC2130_USTEPS_XY;
  3790. changed = true;
  3791. }
  3792. if (tmc2130_mres[Z_AXIS] != eeprom_read_byte((uint8_t*)EEPROM_TMC2130_Z_MRES))
  3793. {
  3794. axis_steps_per_unit[Z_AXIS] = tmp1[Z_AXIS] * tmc2130_mres2usteps(tmc2130_mres[Z_AXIS]) / TMC2130_USTEPS_Z;
  3795. changed = true;
  3796. }
  3797. if (tmc2130_mres[E_AXIS] != eeprom_read_byte((uint8_t*)EEPROM_TMC2130_E_MRES))
  3798. {
  3799. axis_steps_per_unit[E_AXIS] = tmp1[E_AXIS] * tmc2130_mres2usteps(tmc2130_mres[E_AXIS]) / TMC2130_USTEPS_E;
  3800. changed = true;
  3801. }
  3802. if (changed)
  3803. {
  3804. lcd_ustep_resolution_menu_save();
  3805. Config_StoreSettings(EEPROM_OFFSET);
  3806. tmc2130_init();
  3807. }
  3808. currentMenu = lcd_experimantal_menu;
  3809. lcd_experimantal_menu();
  3810. }
  3811. static void lcd_ustep_resolution_reset_def_xyze()
  3812. {
  3813. tmc2130_mres[X_AXIS] = tmc2130_usteps2mres(TMC2130_USTEPS_XY);
  3814. tmc2130_mres[Y_AXIS] = tmc2130_usteps2mres(TMC2130_USTEPS_XY);
  3815. tmc2130_mres[Z_AXIS] = tmc2130_usteps2mres(TMC2130_USTEPS_Z);
  3816. tmc2130_mres[E_AXIS] = tmc2130_usteps2mres(TMC2130_USTEPS_E);
  3817. float tmp1[]=DEFAULT_AXIS_STEPS_PER_UNIT;
  3818. axis_steps_per_unit[X_AXIS] = tmp1[X_AXIS];
  3819. axis_steps_per_unit[Y_AXIS] = tmp1[Y_AXIS];
  3820. axis_steps_per_unit[Z_AXIS] = tmp1[Z_AXIS];
  3821. axis_steps_per_unit[E_AXIS] = tmp1[E_AXIS];
  3822. }
  3823. static void lcd_ustep_resolution_menu()
  3824. {
  3825. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  3826. START_MENU();
  3827. MENU_ITEM(back, PSTR("Experimental"), lcd_ustep_resolution_menu_back);
  3828. MENU_ITEM(function, PSTR("Reset defaults"), lcd_ustep_resolution_reset_def_xyze);
  3829. MENU_ITEM_EDIT(mres, PSTR("X-resolution"), &tmc2130_mres[X_AXIS], 4, 4);
  3830. MENU_ITEM_EDIT(mres, PSTR("Y-resolution"), &tmc2130_mres[Y_AXIS], 4, 4);
  3831. MENU_ITEM_EDIT(mres, PSTR("Z-resolution"), &tmc2130_mres[Z_AXIS], 4, 4);
  3832. MENU_ITEM_EDIT(mres, PSTR("E-resolution"), &tmc2130_mres[E_AXIS], 2, 5);
  3833. END_MENU();
  3834. }
  3835. static void lcd_ustep_linearity_menu_back()
  3836. {
  3837. bool changed = false;
  3838. if (tmc2130_wave_fac[X_AXIS] < TMC2130_WAVE_FAC1000_MIN) tmc2130_wave_fac[X_AXIS] = 0;
  3839. if (tmc2130_wave_fac[Y_AXIS] < TMC2130_WAVE_FAC1000_MIN) tmc2130_wave_fac[Y_AXIS] = 0;
  3840. if (tmc2130_wave_fac[Z_AXIS] < TMC2130_WAVE_FAC1000_MIN) tmc2130_wave_fac[Z_AXIS] = 0;
  3841. if (tmc2130_wave_fac[E_AXIS] < TMC2130_WAVE_FAC1000_MIN) tmc2130_wave_fac[E_AXIS] = 0;
  3842. changed |= (eeprom_read_byte((uint8_t*)EEPROM_TMC2130_WAVE_X_FAC) != tmc2130_wave_fac[X_AXIS]);
  3843. changed |= (eeprom_read_byte((uint8_t*)EEPROM_TMC2130_WAVE_Y_FAC) != tmc2130_wave_fac[Y_AXIS]);
  3844. changed |= (eeprom_read_byte((uint8_t*)EEPROM_TMC2130_WAVE_Z_FAC) != tmc2130_wave_fac[Z_AXIS]);
  3845. changed |= (eeprom_read_byte((uint8_t*)EEPROM_TMC2130_WAVE_E_FAC) != tmc2130_wave_fac[E_AXIS]);
  3846. lcd_ustep_linearity_menu_save();
  3847. if (changed) tmc2130_init();
  3848. currentMenu = lcd_experimantal_menu;
  3849. lcd_experimantal_menu();
  3850. }
  3851. static void lcd_ustep_linearity_menu_recomended()
  3852. {
  3853. tmc2130_wave_fac[X_AXIS] = 220;
  3854. tmc2130_wave_fac[Y_AXIS] = 220;
  3855. tmc2130_wave_fac[Z_AXIS] = 220;
  3856. tmc2130_wave_fac[E_AXIS] = 220;
  3857. }
  3858. static void lcd_ustep_linearity_menu_reset()
  3859. {
  3860. tmc2130_wave_fac[X_AXIS] = 0;
  3861. tmc2130_wave_fac[Y_AXIS] = 0;
  3862. tmc2130_wave_fac[Z_AXIS] = 0;
  3863. tmc2130_wave_fac[E_AXIS] = 0;
  3864. }
  3865. static void lcd_ustep_linearity_menu()
  3866. {
  3867. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  3868. START_MENU();
  3869. MENU_ITEM(back, PSTR("Experimental"), lcd_ustep_linearity_menu_back);
  3870. MENU_ITEM(function, PSTR("Reset correction"), lcd_ustep_linearity_menu_reset);
  3871. MENU_ITEM(function, PSTR("Recomended config"), lcd_ustep_linearity_menu_recomended);
  3872. MENU_ITEM_EDIT(wfac, PSTR("X-correction"), &tmc2130_wave_fac[X_AXIS], TMC2130_WAVE_FAC1000_MIN-TMC2130_WAVE_FAC1000_STP, TMC2130_WAVE_FAC1000_MAX);
  3873. MENU_ITEM_EDIT(wfac, PSTR("Y-correction"), &tmc2130_wave_fac[Y_AXIS], TMC2130_WAVE_FAC1000_MIN-TMC2130_WAVE_FAC1000_STP, TMC2130_WAVE_FAC1000_MAX);
  3874. MENU_ITEM_EDIT(wfac, PSTR("Z-correction"), &tmc2130_wave_fac[Z_AXIS], TMC2130_WAVE_FAC1000_MIN-TMC2130_WAVE_FAC1000_STP, TMC2130_WAVE_FAC1000_MAX);
  3875. MENU_ITEM_EDIT(wfac, PSTR("E-correction"), &tmc2130_wave_fac[E_AXIS], TMC2130_WAVE_FAC1000_MIN-TMC2130_WAVE_FAC1000_STP, TMC2130_WAVE_FAC1000_MAX);
  3876. END_MENU();
  3877. }
  3878. static void lcd_experimantal_menu_save_all()
  3879. {
  3880. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_ENABLED, tmc2130_home_enabled);
  3881. lcd_ustep_resolution_menu_save();
  3882. lcd_ustep_linearity_menu_save();
  3883. Config_StoreSettings(EEPROM_OFFSET);
  3884. }
  3885. static void lcd_experimantal_menu_disable_all()
  3886. {
  3887. tmc2130_home_enabled = 0;
  3888. lcd_ustep_resolution_reset_def_xyze();
  3889. lcd_ustep_linearity_menu_reset();
  3890. lcd_experimantal_menu_save_all();
  3891. tmc2130_init();
  3892. }
  3893. static void lcd_experimantal_menu()
  3894. {
  3895. START_MENU();
  3896. MENU_ITEM(back, _T(MSG_MAIN), 0);
  3897. MENU_ITEM(function, PSTR("All Xfeatures off"), lcd_experimantal_menu_disable_all);
  3898. MENU_ITEM(submenu, PSTR("Homing accuracy"), lcd_homing_accuracy_menu);
  3899. MENU_ITEM(submenu, PSTR("uStep resolution"), lcd_ustep_resolution_menu);
  3900. MENU_ITEM(submenu, PSTR("uStep linearity"), lcd_ustep_linearity_menu);
  3901. END_MENU();
  3902. }
  3903. #endif //EXPERIMENTAL_FEATURES
  3904. static void lcd_calibration_menu()
  3905. {
  3906. START_MENU();
  3907. MENU_ITEM(back, _T(MSG_MAIN), 0);
  3908. if (!isPrintPaused)
  3909. {
  3910. MENU_ITEM(function, _i("Wizard"), lcd_wizard);////MSG_WIZARD c=17 r=1
  3911. MENU_ITEM(submenu, _i("First layer cal."), lcd_v2_calibration);////MSG_V2_CALIBRATION c=17 r=1
  3912. MENU_ITEM(gcode, _T(MSG_AUTO_HOME), PSTR("G28 W"));
  3913. MENU_ITEM(function, _i("Selftest "), lcd_selftest_v);////MSG_SELFTEST c=0 r=0
  3914. #ifdef MK1BP
  3915. // MK1
  3916. // "Calibrate Z"
  3917. MENU_ITEM(gcode, _T(MSG_HOMEYZ), PSTR("G28 Z"));
  3918. #else //MK1BP
  3919. // MK2
  3920. MENU_ITEM(function, _i("Calibrate XYZ"), lcd_mesh_calibration);////MSG_CALIBRATE_BED c=0 r=0
  3921. // "Calibrate Z" with storing the reference values to EEPROM.
  3922. MENU_ITEM(submenu, _T(MSG_HOMEYZ), lcd_mesh_calibration_z);
  3923. #ifndef SNMM
  3924. //MENU_ITEM(function, _i("Calibrate E"), lcd_calibrate_extruder);////MSG_CALIBRATE_E c=20 r=1
  3925. #endif
  3926. // "Mesh Bed Leveling"
  3927. MENU_ITEM(submenu, _i("Mesh Bed Leveling"), lcd_mesh_bedleveling);////MSG_MESH_BED_LEVELING c=0 r=0
  3928. #endif //MK1BP
  3929. MENU_ITEM(submenu, _i("Bed level correct"), lcd_adjust_bed);////MSG_BED_CORRECTION_MENU c=0 r=0
  3930. MENU_ITEM(submenu, _i("PID calibration"), pid_extruder);////MSG_PID_EXTRUDER c=17 r=1
  3931. #ifndef TMC2130
  3932. MENU_ITEM(submenu, _i("Show end stops"), menu_show_end_stops);////MSG_SHOW_END_STOPS c=17 r=1
  3933. #endif
  3934. #ifndef MK1BP
  3935. MENU_ITEM(gcode, _i("Reset XYZ calibr."), PSTR("M44"));////MSG_CALIBRATE_BED_RESET c=0 r=0
  3936. #endif //MK1BP
  3937. #ifndef SNMM
  3938. //MENU_ITEM(function, MSG_RESET_CALIBRATE_E, lcd_extr_cal_reset);
  3939. #endif
  3940. #ifndef MK1BP
  3941. MENU_ITEM(submenu, _i("Temp. calibration"), lcd_pinda_calibration_menu);////MSG_CALIBRATION_PINDA_MENU c=17 r=1
  3942. #endif //MK1BP
  3943. }
  3944. END_MENU();
  3945. }
  3946. /*
  3947. void lcd_mylang_top(int hlaska) {
  3948. lcd.setCursor(0,0);
  3949. lcd.print(" ");
  3950. lcd.setCursor(0,0);
  3951. lcd_printPGM(_T(MSG_ALL)[hlaska-1][LANGUAGE_SELECT]);
  3952. }
  3953. void lcd_mylang_drawmenu(int cursor) {
  3954. int first = 0;
  3955. if (cursor>2) first = cursor-2;
  3956. if (cursor==LANG_NUM) first = LANG_NUM-3;
  3957. lcd.setCursor(0, 1);
  3958. lcd.print(" ");
  3959. lcd.setCursor(1, 1);
  3960. lcd_printPGM(_T(MSG_ALL)[first][LANGUAGE_NAME]);
  3961. lcd.setCursor(0, 2);
  3962. lcd.print(" ");
  3963. lcd.setCursor(1, 2);
  3964. lcd_printPGM(_T(MSG_ALL)[first+1][LANGUAGE_NAME]);
  3965. lcd.setCursor(0, 3);
  3966. lcd.print(" ");
  3967. lcd.setCursor(1, 3);
  3968. lcd_printPGM(_T(MSG_ALL)[first+2][LANGUAGE_NAME]);
  3969. if (cursor==1) lcd.setCursor(0, 1);
  3970. if (cursor>1 && cursor<LANG_NUM) lcd.setCursor(0, 2);
  3971. if (cursor==LANG_NUM) lcd.setCursor(0, 3);
  3972. lcd.print(">");
  3973. if (cursor<LANG_NUM-1) {
  3974. lcd.setCursor(19,3);
  3975. lcd.print("\x01");
  3976. }
  3977. if (cursor>2) {
  3978. lcd.setCursor(19,1);
  3979. lcd.print("^");
  3980. }
  3981. }
  3982. */
  3983. /*
  3984. void lcd_mylang_drawmenu(int cursor)
  3985. {
  3986. unsigned char lang_cnt = lang_get_count();
  3987. int first = 0;
  3988. if (cursor>3) first = cursor-3;
  3989. if (cursor==lang_cnt && lang_cnt>4) first = lang_cnt-4;
  3990. if (cursor==lang_cnt && lang_cnt==4) first = lang_cnt-4;
  3991. lcd.setCursor(0, 0);
  3992. lcd.print(" ");
  3993. lcd.setCursor(1, 0);
  3994. lcd_printPGM(lang_get_name(first+0));
  3995. lcd.setCursor(0, 1);
  3996. lcd.print(" ");
  3997. lcd.setCursor(1, 1);
  3998. lcd_printPGM(lang_get_name(first+1));
  3999. lcd.setCursor(0, 2);
  4000. lcd.print(" ");
  4001. if (lang_cnt > 2){
  4002. lcd.setCursor(1, 2);
  4003. lcd_printPGM(lang_get_name(first+2));
  4004. }
  4005. lcd.setCursor(0, 3);
  4006. lcd.print(" ");
  4007. if (lang_cnt>3) {
  4008. lcd.setCursor(1, 3);
  4009. lcd_printPGM(lang_get_name(first+3));
  4010. }
  4011. if (cursor==1) lcd.setCursor(0, 0);
  4012. if (cursor==2) lcd.setCursor(0, 1);
  4013. if (cursor>2) lcd.setCursor(0, 2);
  4014. if (cursor==lang_cnt && lang_cnt>3) lcd.setCursor(0, 3);
  4015. lcd.print(">");
  4016. if (cursor<lang_cnt-1 && lang_cnt>4) {
  4017. lcd.setCursor(19,3);
  4018. lcd.print("\x01");
  4019. }
  4020. if (cursor>3 && lang_cnt>4) {
  4021. lcd.setCursor(19,0);
  4022. lcd.print("^");
  4023. }
  4024. }
  4025. */
  4026. /*
  4027. void lcd_mylang_drawcursor(int cursor) {
  4028. unsigned char lang_cnt = lang_get_count();
  4029. if (cursor==1) lcd.setCursor(0, 1);
  4030. if (cursor>1 && cursor<lang_cnt) lcd.setCursor(0, 2);
  4031. if (cursor==lang_cnt) lcd.setCursor(0, 3);
  4032. lcd.print(">");
  4033. }
  4034. */
  4035. /*
  4036. void lcd_mylang()
  4037. {
  4038. int enc_dif = 0;
  4039. int cursor_pos = 1;
  4040. lang_selected=255;
  4041. int hlaska=1;
  4042. int counter=0;
  4043. unsigned char lang_cnt = lang_get_count();
  4044. lcd_set_custom_characters_arrows();
  4045. lcd_implementation_clear();
  4046. //lcd_mylang_top(hlaska);
  4047. lcd_mylang_drawmenu(cursor_pos);
  4048. enc_dif = encoderDiff;
  4049. while ( (lang_selected == 255) ) {
  4050. manage_heater();
  4051. manage_inactivity(true);
  4052. if ( abs((enc_dif - encoderDiff)) > 4 ) {
  4053. //if ( (abs(enc_dif - encoderDiff)) > 1 ) {
  4054. if (enc_dif > encoderDiff ) {
  4055. cursor_pos --;
  4056. }
  4057. if (enc_dif < encoderDiff ) {
  4058. cursor_pos ++;
  4059. }
  4060. if (cursor_pos > lang_cnt) {
  4061. cursor_pos = lang_cnt;
  4062. }
  4063. if (cursor_pos < 1) {
  4064. cursor_pos = 1;
  4065. }
  4066. lcd_mylang_drawmenu(cursor_pos);
  4067. enc_dif = encoderDiff;
  4068. delay(100);
  4069. //}
  4070. } else delay(20);
  4071. if (lcd_clicked()) {
  4072. lcd_set_lang(cursor_pos-1);
  4073. delay(500);
  4074. }
  4075. // if (++counter == 80) {
  4076. // hlaska++;
  4077. // if(hlaska>LANG_NUM) hlaska=1;
  4078. // lcd_mylang_top(hlaska);
  4079. // lcd_mylang_drawcursor(cursor_pos);
  4080. // counter=0;
  4081. // }
  4082. };
  4083. if(MYSERIAL.available() > 1){
  4084. lang_selected = 0;
  4085. firstrun = 0;
  4086. }
  4087. lcd_set_custom_characters_degree();
  4088. lcd_implementation_clear();
  4089. lcd_return_to_status();
  4090. }
  4091. */
  4092. void bowden_menu() {
  4093. int enc_dif = encoderDiff;
  4094. int cursor_pos = 0;
  4095. lcd_implementation_clear();
  4096. lcd.setCursor(0, 0);
  4097. lcd.print(">");
  4098. for (int i = 0; i < 4; i++) {
  4099. lcd.setCursor(1, i);
  4100. lcd.print("Extruder ");
  4101. lcd.print(i);
  4102. lcd.print(": ");
  4103. EEPROM_read_B(EEPROM_BOWDEN_LENGTH + i * 2, &bowden_length[i]);
  4104. lcd.print(bowden_length[i] - 48);
  4105. }
  4106. enc_dif = encoderDiff;
  4107. while (1) {
  4108. manage_heater();
  4109. manage_inactivity(true);
  4110. if (abs((enc_dif - encoderDiff)) > 2) {
  4111. if (enc_dif > encoderDiff) {
  4112. cursor_pos--;
  4113. }
  4114. if (enc_dif < encoderDiff) {
  4115. cursor_pos++;
  4116. }
  4117. if (cursor_pos > 3) {
  4118. cursor_pos = 3;
  4119. }
  4120. if (cursor_pos < 0) {
  4121. cursor_pos = 0;
  4122. }
  4123. lcd.setCursor(0, 0);
  4124. lcd.print(" ");
  4125. lcd.setCursor(0, 1);
  4126. lcd.print(" ");
  4127. lcd.setCursor(0, 2);
  4128. lcd.print(" ");
  4129. lcd.setCursor(0, 3);
  4130. lcd.print(" ");
  4131. lcd.setCursor(0, cursor_pos);
  4132. lcd.print(">");
  4133. enc_dif = encoderDiff;
  4134. delay(100);
  4135. }
  4136. if (lcd_clicked()) {
  4137. while (lcd_clicked());
  4138. delay(10);
  4139. while (lcd_clicked());
  4140. lcd_implementation_clear();
  4141. while (1) {
  4142. manage_heater();
  4143. manage_inactivity(true);
  4144. lcd.setCursor(1, 1);
  4145. lcd.print("Extruder ");
  4146. lcd.print(cursor_pos);
  4147. lcd.print(": ");
  4148. lcd.setCursor(13, 1);
  4149. lcd.print(bowden_length[cursor_pos] - 48);
  4150. if (abs((enc_dif - encoderDiff)) > 2) {
  4151. if (enc_dif > encoderDiff) {
  4152. bowden_length[cursor_pos]--;
  4153. lcd.setCursor(13, 1);
  4154. lcd.print(bowden_length[cursor_pos] - 48);
  4155. enc_dif = encoderDiff;
  4156. }
  4157. if (enc_dif < encoderDiff) {
  4158. bowden_length[cursor_pos]++;
  4159. lcd.setCursor(13, 1);
  4160. lcd.print(bowden_length[cursor_pos] - 48);
  4161. enc_dif = encoderDiff;
  4162. }
  4163. }
  4164. delay(100);
  4165. if (lcd_clicked()) {
  4166. while (lcd_clicked());
  4167. delay(10);
  4168. while (lcd_clicked());
  4169. EEPROM_save_B(EEPROM_BOWDEN_LENGTH + cursor_pos * 2, &bowden_length[cursor_pos]);
  4170. if (lcd_show_fullscreen_message_yes_no_and_wait_P(PSTR("Continue with another bowden?"))) {
  4171. lcd_update_enable(true);
  4172. lcd_implementation_clear();
  4173. enc_dif = encoderDiff;
  4174. lcd.setCursor(0, cursor_pos);
  4175. lcd.print(">");
  4176. for (int i = 0; i < 4; i++) {
  4177. lcd.setCursor(1, i);
  4178. lcd.print("Extruder ");
  4179. lcd.print(i);
  4180. lcd.print(": ");
  4181. EEPROM_read_B(EEPROM_BOWDEN_LENGTH + i * 2, &bowden_length[i]);
  4182. lcd.print(bowden_length[i] - 48);
  4183. }
  4184. break;
  4185. }
  4186. else return;
  4187. }
  4188. }
  4189. }
  4190. }
  4191. }
  4192. static char snmm_stop_print_menu() { //menu for choosing which filaments will be unloaded in stop print
  4193. lcd_implementation_clear();
  4194. lcd_print_at_PGM(0,0,_T(MSG_UNLOAD_FILAMENT)); lcd.print(":");
  4195. lcd.setCursor(0, 1); lcd.print(">");
  4196. lcd_print_at_PGM(1,1,_T(MSG_ALL));
  4197. lcd_print_at_PGM(1,2,_i("Used during print"));////MSG_USED c=19 r=1
  4198. lcd_print_at_PGM(1,3,_i("Current"));////MSG_CURRENT c=19 r=1
  4199. char cursor_pos = 1;
  4200. int enc_dif = 0;
  4201. KEEPALIVE_STATE(PAUSED_FOR_USER);
  4202. while (1) {
  4203. manage_heater();
  4204. manage_inactivity(true);
  4205. if (abs((enc_dif - encoderDiff)) > 4) {
  4206. if ((abs(enc_dif - encoderDiff)) > 1) {
  4207. if (enc_dif > encoderDiff) cursor_pos--;
  4208. if (enc_dif < encoderDiff) cursor_pos++;
  4209. if (cursor_pos > 3) cursor_pos = 3;
  4210. if (cursor_pos < 1) cursor_pos = 1;
  4211. lcd.setCursor(0, 1);
  4212. lcd.print(" ");
  4213. lcd.setCursor(0, 2);
  4214. lcd.print(" ");
  4215. lcd.setCursor(0, 3);
  4216. lcd.print(" ");
  4217. lcd.setCursor(0, cursor_pos);
  4218. lcd.print(">");
  4219. enc_dif = encoderDiff;
  4220. delay(100);
  4221. }
  4222. }
  4223. if (lcd_clicked()) {
  4224. while (lcd_clicked());
  4225. delay(10);
  4226. while (lcd_clicked());
  4227. KEEPALIVE_STATE(IN_HANDLER);
  4228. return(cursor_pos - 1);
  4229. }
  4230. }
  4231. }
  4232. char choose_extruder_menu() {
  4233. int items_no = 4;
  4234. int first = 0;
  4235. int enc_dif = 0;
  4236. char cursor_pos = 1;
  4237. enc_dif = encoderDiff;
  4238. lcd_implementation_clear();
  4239. lcd_printPGM(_T(MSG_CHOOSE_EXTRUDER));
  4240. lcd.setCursor(0, 1);
  4241. lcd.print(">");
  4242. for (int i = 0; i < 3; i++) {
  4243. lcd_print_at_PGM(1, i + 1, _T(MSG_EXTRUDER));
  4244. }
  4245. KEEPALIVE_STATE(PAUSED_FOR_USER);
  4246. while (1) {
  4247. for (int i = 0; i < 3; i++) {
  4248. lcd.setCursor(2 + strlen_P(_T(MSG_EXTRUDER)), i+1);
  4249. lcd.print(first + i + 1);
  4250. }
  4251. manage_heater();
  4252. manage_inactivity(true);
  4253. if (abs((enc_dif - encoderDiff)) > 4) {
  4254. if ((abs(enc_dif - encoderDiff)) > 1) {
  4255. if (enc_dif > encoderDiff) {
  4256. cursor_pos--;
  4257. }
  4258. if (enc_dif < encoderDiff) {
  4259. cursor_pos++;
  4260. }
  4261. if (cursor_pos > 3) {
  4262. cursor_pos = 3;
  4263. if (first < items_no - 3) {
  4264. first++;
  4265. lcd_implementation_clear();
  4266. lcd_printPGM(_T(MSG_CHOOSE_EXTRUDER));
  4267. for (int i = 0; i < 3; i++) {
  4268. lcd_print_at_PGM(1, i + 1, _T(MSG_EXTRUDER));
  4269. }
  4270. }
  4271. }
  4272. if (cursor_pos < 1) {
  4273. cursor_pos = 1;
  4274. if (first > 0) {
  4275. first--;
  4276. lcd_implementation_clear();
  4277. lcd_printPGM(_T(MSG_CHOOSE_EXTRUDER));
  4278. for (int i = 0; i < 3; i++) {
  4279. lcd_print_at_PGM(1, i + 1, _T(MSG_EXTRUDER));
  4280. }
  4281. }
  4282. }
  4283. lcd.setCursor(0, 1);
  4284. lcd.print(" ");
  4285. lcd.setCursor(0, 2);
  4286. lcd.print(" ");
  4287. lcd.setCursor(0, 3);
  4288. lcd.print(" ");
  4289. lcd.setCursor(0, cursor_pos);
  4290. lcd.print(">");
  4291. enc_dif = encoderDiff;
  4292. delay(100);
  4293. }
  4294. }
  4295. if (lcd_clicked()) {
  4296. lcd_update(2);
  4297. while (lcd_clicked());
  4298. delay(10);
  4299. while (lcd_clicked());
  4300. KEEPALIVE_STATE(IN_HANDLER);
  4301. return(cursor_pos + first - 1);
  4302. }
  4303. }
  4304. }
  4305. char reset_menu() {
  4306. #ifdef SNMM
  4307. int items_no = 5;
  4308. #else
  4309. int items_no = 4;
  4310. #endif
  4311. static int first = 0;
  4312. int enc_dif = 0;
  4313. char cursor_pos = 0;
  4314. const char *item [items_no];
  4315. item[0] = "Language";
  4316. item[1] = "Statistics";
  4317. item[2] = "Shipping prep";
  4318. item[3] = "All Data";
  4319. #ifdef SNMM
  4320. item[4] = "Bowden length";
  4321. #endif // SNMM
  4322. enc_dif = encoderDiff;
  4323. lcd_implementation_clear();
  4324. lcd.setCursor(0, 0);
  4325. lcd.print(">");
  4326. while (1) {
  4327. for (int i = 0; i < 4; i++) {
  4328. lcd.setCursor(1, i);
  4329. lcd.print(item[first + i]);
  4330. }
  4331. manage_heater();
  4332. manage_inactivity(true);
  4333. if (abs((enc_dif - encoderDiff)) > 4) {
  4334. if ((abs(enc_dif - encoderDiff)) > 1) {
  4335. if (enc_dif > encoderDiff) {
  4336. cursor_pos--;
  4337. }
  4338. if (enc_dif < encoderDiff) {
  4339. cursor_pos++;
  4340. }
  4341. if (cursor_pos > 3) {
  4342. cursor_pos = 3;
  4343. if (first < items_no - 4) {
  4344. first++;
  4345. lcd_implementation_clear();
  4346. }
  4347. }
  4348. if (cursor_pos < 0) {
  4349. cursor_pos = 0;
  4350. if (first > 0) {
  4351. first--;
  4352. lcd_implementation_clear();
  4353. }
  4354. }
  4355. lcd.setCursor(0, 0);
  4356. lcd.print(" ");
  4357. lcd.setCursor(0, 1);
  4358. lcd.print(" ");
  4359. lcd.setCursor(0, 2);
  4360. lcd.print(" ");
  4361. lcd.setCursor(0, 3);
  4362. lcd.print(" ");
  4363. lcd.setCursor(0, cursor_pos);
  4364. lcd.print(">");
  4365. enc_dif = encoderDiff;
  4366. delay(100);
  4367. }
  4368. }
  4369. if (lcd_clicked()) {
  4370. while (lcd_clicked());
  4371. delay(10);
  4372. while (lcd_clicked());
  4373. return(cursor_pos + first);
  4374. }
  4375. }
  4376. }
  4377. static void lcd_disable_farm_mode() {
  4378. int8_t disable = lcd_show_fullscreen_message_yes_no_and_wait_P(PSTR("Disable farm mode?"), true, false); //allow timeouting, default no
  4379. if (disable) {
  4380. enquecommand_P(PSTR("G99"));
  4381. lcd_return_to_status();
  4382. }
  4383. else {
  4384. lcd_goto_menu(lcd_settings_menu); //doesn't break menuStack
  4385. }
  4386. lcd_update_enable(true);
  4387. lcdDrawUpdate = 2;
  4388. }
  4389. static void lcd_ping_allert() {
  4390. if ((abs(millis() - allert_timer)*0.001) > PING_ALLERT_PERIOD) {
  4391. allert_timer = millis();
  4392. SET_OUTPUT(BEEPER);
  4393. for (int i = 0; i < 2; i++) {
  4394. WRITE(BEEPER, HIGH);
  4395. delay(50);
  4396. WRITE(BEEPER, LOW);
  4397. delay(100);
  4398. }
  4399. }
  4400. };
  4401. #ifdef SNMM
  4402. static void extr_mov(float shift, float feed_rate) { //move extruder no matter what the current heater temperature is
  4403. set_extrude_min_temp(.0);
  4404. current_position[E_AXIS] += shift;
  4405. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], feed_rate, active_extruder);
  4406. set_extrude_min_temp(EXTRUDE_MINTEMP);
  4407. }
  4408. void change_extr(int extr) { //switches multiplexer for extruders
  4409. st_synchronize();
  4410. delay(100);
  4411. disable_e0();
  4412. disable_e1();
  4413. disable_e2();
  4414. snmm_extruder = extr;
  4415. pinMode(E_MUX0_PIN, OUTPUT);
  4416. pinMode(E_MUX1_PIN, OUTPUT);
  4417. switch (extr) {
  4418. case 1:
  4419. WRITE(E_MUX0_PIN, HIGH);
  4420. WRITE(E_MUX1_PIN, LOW);
  4421. break;
  4422. case 2:
  4423. WRITE(E_MUX0_PIN, LOW);
  4424. WRITE(E_MUX1_PIN, HIGH);
  4425. break;
  4426. case 3:
  4427. WRITE(E_MUX0_PIN, HIGH);
  4428. WRITE(E_MUX1_PIN, HIGH);
  4429. break;
  4430. default:
  4431. WRITE(E_MUX0_PIN, LOW);
  4432. WRITE(E_MUX1_PIN, LOW);
  4433. break;
  4434. }
  4435. delay(100);
  4436. }
  4437. static int get_ext_nr() { //reads multiplexer input pins and return current extruder number (counted from 0)
  4438. return(2 * READ(E_MUX1_PIN) + READ(E_MUX0_PIN));
  4439. }
  4440. void display_loading() {
  4441. switch (snmm_extruder) {
  4442. case 1: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T1)); break;
  4443. case 2: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T2)); break;
  4444. case 3: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T3)); break;
  4445. default: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T0)); break;
  4446. }
  4447. }
  4448. void extr_adj(int extruder) //loading filament for SNMM
  4449. {
  4450. bool correct;
  4451. max_feedrate[E_AXIS] =80;
  4452. //max_feedrate[E_AXIS] = 50;
  4453. START:
  4454. lcd_implementation_clear();
  4455. lcd.setCursor(0, 0);
  4456. switch (extruder) {
  4457. case 1: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T1)); break;
  4458. case 2: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T2)); break;
  4459. case 3: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T3)); break;
  4460. default: lcd_display_message_fullscreen_P(_T(MSG_FILAMENT_LOADING_T0)); break;
  4461. }
  4462. KEEPALIVE_STATE(PAUSED_FOR_USER);
  4463. do{
  4464. extr_mov(0.001,1000);
  4465. delay_keep_alive(2);
  4466. } while (!lcd_clicked());
  4467. //delay_keep_alive(500);
  4468. KEEPALIVE_STATE(IN_HANDLER);
  4469. st_synchronize();
  4470. //correct = lcd_show_fullscreen_message_yes_no_and_wait_P(MSG_FIL_LOADED_CHECK, false);
  4471. //if (!correct) goto START;
  4472. //extr_mov(BOWDEN_LENGTH/2.f, 500); //dividing by 2 is there because of max. extrusion length limitation (x_max + y_max)
  4473. //extr_mov(BOWDEN_LENGTH/2.f, 500);
  4474. extr_mov(bowden_length[extruder], 500);
  4475. lcd_implementation_clear();
  4476. lcd.setCursor(0, 0); lcd_printPGM(_T(MSG_LOADING_FILAMENT));
  4477. if(strlen(_T(MSG_LOADING_FILAMENT))>18) lcd.setCursor(0, 1);
  4478. else lcd.print(" ");
  4479. lcd.print(snmm_extruder + 1);
  4480. lcd.setCursor(0, 2); lcd_printPGM(_T(MSG_PLEASE_WAIT));
  4481. st_synchronize();
  4482. max_feedrate[E_AXIS] = 50;
  4483. lcd_update_enable(true);
  4484. lcd_return_to_status();
  4485. lcdDrawUpdate = 2;
  4486. }
  4487. void extr_unload() { //unloads filament
  4488. float tmp_motor[3] = DEFAULT_PWM_MOTOR_CURRENT;
  4489. float tmp_motor_loud[3] = DEFAULT_PWM_MOTOR_CURRENT_LOUD;
  4490. uint8_t SilentMode = eeprom_read_byte((uint8_t*)EEPROM_SILENT);
  4491. if (degHotend0() > EXTRUDE_MINTEMP) {
  4492. lcd_implementation_clear();
  4493. lcd_display_message_fullscreen_P(PSTR(""));
  4494. max_feedrate[E_AXIS] = 50;
  4495. lcd.setCursor(0, 0); lcd_printPGM(_T(MSG_UNLOADING_FILAMENT));
  4496. lcd.print(" ");
  4497. lcd.print(snmm_extruder + 1);
  4498. lcd.setCursor(0, 2); lcd_printPGM(_T(MSG_PLEASE_WAIT));
  4499. if (current_position[Z_AXIS] < 15) {
  4500. current_position[Z_AXIS] += 15; //lifting in Z direction to make space for extrusion
  4501. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 25, active_extruder);
  4502. }
  4503. current_position[E_AXIS] += 10; //extrusion
  4504. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 10, active_extruder);
  4505. st_current_set(2, E_MOTOR_HIGH_CURRENT);
  4506. if (current_temperature[0] < 230) { //PLA & all other filaments
  4507. current_position[E_AXIS] += 5.4;
  4508. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 2800 / 60, active_extruder);
  4509. current_position[E_AXIS] += 3.2;
  4510. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 3000 / 60, active_extruder);
  4511. current_position[E_AXIS] += 3;
  4512. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 3400 / 60, active_extruder);
  4513. }
  4514. else { //ABS
  4515. current_position[E_AXIS] += 3.1;
  4516. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 2000 / 60, active_extruder);
  4517. current_position[E_AXIS] += 3.1;
  4518. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 2500 / 60, active_extruder);
  4519. current_position[E_AXIS] += 4;
  4520. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 3000 / 60, active_extruder);
  4521. /*current_position[X_AXIS] += 23; //delay
  4522. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 600 / 60, active_extruder); //delay
  4523. current_position[X_AXIS] -= 23; //delay
  4524. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 600 / 60, active_extruder); //delay*/
  4525. delay_keep_alive(4700);
  4526. }
  4527. max_feedrate[E_AXIS] = 80;
  4528. current_position[E_AXIS] -= (bowden_length[snmm_extruder] + 60 + FIL_LOAD_LENGTH) / 2;
  4529. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 500, active_extruder);
  4530. current_position[E_AXIS] -= (bowden_length[snmm_extruder] + 60 + FIL_LOAD_LENGTH) / 2;
  4531. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 500, active_extruder);
  4532. st_synchronize();
  4533. //st_current_init();
  4534. if (SilentMode != SILENT_MODE_OFF) st_current_set(2, tmp_motor[2]); //set back to normal operation currents
  4535. else st_current_set(2, tmp_motor_loud[2]);
  4536. lcd_update_enable(true);
  4537. lcd_return_to_status();
  4538. max_feedrate[E_AXIS] = 50;
  4539. }
  4540. else {
  4541. lcd_implementation_clear();
  4542. lcd.setCursor(0, 0);
  4543. lcd_printPGM(_T(MSG_ERROR));
  4544. lcd.setCursor(0, 2);
  4545. lcd_printPGM(_T(MSG_PREHEAT_NOZZLE));
  4546. delay(2000);
  4547. lcd_implementation_clear();
  4548. }
  4549. lcd_return_to_status();
  4550. }
  4551. //wrapper functions for loading filament
  4552. static void extr_adj_0(){
  4553. change_extr(0);
  4554. extr_adj(0);
  4555. }
  4556. static void extr_adj_1() {
  4557. change_extr(1);
  4558. extr_adj(1);
  4559. }
  4560. static void extr_adj_2() {
  4561. change_extr(2);
  4562. extr_adj(2);
  4563. }
  4564. static void extr_adj_3() {
  4565. change_extr(3);
  4566. extr_adj(3);
  4567. }
  4568. static void load_all() {
  4569. for (int i = 0; i < 4; i++) {
  4570. change_extr(i);
  4571. extr_adj(i);
  4572. }
  4573. }
  4574. //wrapper functions for changing extruders
  4575. static void extr_change_0() {
  4576. change_extr(0);
  4577. lcd_return_to_status();
  4578. }
  4579. static void extr_change_1() {
  4580. change_extr(1);
  4581. lcd_return_to_status();
  4582. }
  4583. static void extr_change_2() {
  4584. change_extr(2);
  4585. lcd_return_to_status();
  4586. }
  4587. static void extr_change_3() {
  4588. change_extr(3);
  4589. lcd_return_to_status();
  4590. }
  4591. //wrapper functions for unloading filament
  4592. void extr_unload_all() {
  4593. if (degHotend0() > EXTRUDE_MINTEMP) {
  4594. for (int i = 0; i < 4; i++) {
  4595. change_extr(i);
  4596. extr_unload();
  4597. }
  4598. }
  4599. else {
  4600. lcd_implementation_clear();
  4601. lcd.setCursor(0, 0);
  4602. lcd_printPGM(_T(MSG_ERROR));
  4603. lcd.setCursor(0, 2);
  4604. lcd_printPGM(_T(MSG_PREHEAT_NOZZLE));
  4605. delay(2000);
  4606. lcd_implementation_clear();
  4607. lcd_return_to_status();
  4608. }
  4609. }
  4610. //unloading just used filament (for snmm)
  4611. void extr_unload_used() {
  4612. if (degHotend0() > EXTRUDE_MINTEMP) {
  4613. for (int i = 0; i < 4; i++) {
  4614. if (snmm_filaments_used & (1 << i)) {
  4615. change_extr(i);
  4616. extr_unload();
  4617. }
  4618. }
  4619. snmm_filaments_used = 0;
  4620. }
  4621. else {
  4622. lcd_implementation_clear();
  4623. lcd.setCursor(0, 0);
  4624. lcd_printPGM(_T(MSG_ERROR));
  4625. lcd.setCursor(0, 2);
  4626. lcd_printPGM(_T(MSG_PREHEAT_NOZZLE));
  4627. delay(2000);
  4628. lcd_implementation_clear();
  4629. lcd_return_to_status();
  4630. }
  4631. }
  4632. static void extr_unload_0() {
  4633. change_extr(0);
  4634. extr_unload();
  4635. }
  4636. static void extr_unload_1() {
  4637. change_extr(1);
  4638. extr_unload();
  4639. }
  4640. static void extr_unload_2() {
  4641. change_extr(2);
  4642. extr_unload();
  4643. }
  4644. static void extr_unload_3() {
  4645. change_extr(3);
  4646. extr_unload();
  4647. }
  4648. static void fil_load_menu()
  4649. {
  4650. START_MENU();
  4651. MENU_ITEM(back, _T(MSG_MAIN), 0);
  4652. MENU_ITEM(function, _i("Load all"), load_all);////MSG_LOAD_ALL c=0 r=0
  4653. MENU_ITEM(function, _i("Load filament 1"), extr_adj_0);////MSG_LOAD_FILAMENT_1 c=17 r=0
  4654. MENU_ITEM(function, _i("Load filament 2"), extr_adj_1);////MSG_LOAD_FILAMENT_2 c=17 r=0
  4655. MENU_ITEM(function, _i("Load filament 3"), extr_adj_2);////MSG_LOAD_FILAMENT_3 c=17 r=0
  4656. MENU_ITEM(function, _i("Load filament 4"), extr_adj_3);////MSG_LOAD_FILAMENT_4 c=17 r=0
  4657. END_MENU();
  4658. }
  4659. static void fil_unload_menu()
  4660. {
  4661. START_MENU();
  4662. MENU_ITEM(back, _T(MSG_MAIN), 0);
  4663. MENU_ITEM(function, _i("Unload all"), extr_unload_all);////MSG_UNLOAD_ALL c=0 r=0
  4664. MENU_ITEM(function, _i("Unload filament 1"), extr_unload_0);////MSG_UNLOAD_FILAMENT_1 c=17 r=0
  4665. MENU_ITEM(function, _i("Unload filament 2"), extr_unload_1);////MSG_UNLOAD_FILAMENT_2 c=17 r=0
  4666. MENU_ITEM(function, _i("Unload filament 3"), extr_unload_2);////MSG_UNLOAD_FILAMENT_3 c=17 r=0
  4667. MENU_ITEM(function, _i("Unload filament 4"), extr_unload_3);////MSG_UNLOAD_FILAMENT_4 c=17 r=0
  4668. END_MENU();
  4669. }
  4670. static void change_extr_menu(){
  4671. START_MENU();
  4672. MENU_ITEM(back, _T(MSG_MAIN), 0);
  4673. MENU_ITEM(function, _i("Extruder 1"), extr_change_0);////MSG_EXTRUDER_1 c=17 r=1
  4674. MENU_ITEM(function, _i("Extruder 2"), extr_change_1);////MSG_EXTRUDER_2 c=17 r=1
  4675. MENU_ITEM(function, _i("Extruder 3"), extr_change_2);////MSG_EXTRUDER_3 c=17 r=1
  4676. MENU_ITEM(function, _i("Extruder 4"), extr_change_3);////MSG_EXTRUDER_4 c=17 r=1
  4677. END_MENU();
  4678. }
  4679. #endif
  4680. static void lcd_farm_no()
  4681. {
  4682. char step = 0;
  4683. int enc_dif = 0;
  4684. int _farmno = farm_no;
  4685. int _ret = 0;
  4686. lcd_implementation_clear();
  4687. lcd.setCursor(0, 0);
  4688. lcd.print("Farm no");
  4689. do
  4690. {
  4691. if (abs((enc_dif - encoderDiff)) > 2) {
  4692. if (enc_dif > encoderDiff) {
  4693. switch (step) {
  4694. case(0): if (_farmno >= 100) _farmno -= 100; break;
  4695. case(1): if (_farmno % 100 >= 10) _farmno -= 10; break;
  4696. case(2): if (_farmno % 10 >= 1) _farmno--; break;
  4697. default: break;
  4698. }
  4699. }
  4700. if (enc_dif < encoderDiff) {
  4701. switch (step) {
  4702. case(0): if (_farmno < 900) _farmno += 100; break;
  4703. case(1): if (_farmno % 100 < 90) _farmno += 10; break;
  4704. case(2): if (_farmno % 10 <= 8)_farmno++; break;
  4705. default: break;
  4706. }
  4707. }
  4708. enc_dif = 0;
  4709. encoderDiff = 0;
  4710. }
  4711. lcd.setCursor(0, 2);
  4712. if (_farmno < 100) lcd.print("0");
  4713. if (_farmno < 10) lcd.print("0");
  4714. lcd.print(_farmno);
  4715. lcd.print(" ");
  4716. lcd.setCursor(0, 3);
  4717. lcd.print(" ");
  4718. lcd.setCursor(step, 3);
  4719. lcd.print("^");
  4720. delay(100);
  4721. if (lcd_clicked())
  4722. {
  4723. delay(200);
  4724. step++;
  4725. if(step == 3) {
  4726. _ret = 1;
  4727. farm_no = _farmno;
  4728. EEPROM_save_B(EEPROM_FARM_NUMBER, &farm_no);
  4729. prusa_statistics(20);
  4730. lcd_return_to_status();
  4731. }
  4732. }
  4733. manage_heater();
  4734. } while (_ret == 0);
  4735. }
  4736. unsigned char lcd_choose_color() {
  4737. //function returns index of currently chosen item
  4738. //following part can be modified from 2 to 255 items:
  4739. //-----------------------------------------------------
  4740. unsigned char items_no = 2;
  4741. const char *item[items_no];
  4742. item[0] = "Orange";
  4743. item[1] = "Black";
  4744. //-----------------------------------------------------
  4745. unsigned char active_rows;
  4746. static int first = 0;
  4747. int enc_dif = 0;
  4748. unsigned char cursor_pos = 1;
  4749. enc_dif = encoderDiff;
  4750. lcd_implementation_clear();
  4751. lcd.setCursor(0, 1);
  4752. lcd.print(">");
  4753. active_rows = items_no < 3 ? items_no : 3;
  4754. while (1) {
  4755. lcd_print_at_PGM(0, 0, PSTR("Choose color:"));
  4756. for (int i = 0; i < active_rows; i++) {
  4757. lcd.setCursor(1, i+1);
  4758. lcd.print(item[first + i]);
  4759. }
  4760. manage_heater();
  4761. manage_inactivity(true);
  4762. proc_commands();
  4763. if (abs((enc_dif - encoderDiff)) > 12) {
  4764. if (enc_dif > encoderDiff) {
  4765. cursor_pos--;
  4766. }
  4767. if (enc_dif < encoderDiff) {
  4768. cursor_pos++;
  4769. }
  4770. if (cursor_pos > active_rows) {
  4771. cursor_pos = active_rows;
  4772. if (first < items_no - active_rows) {
  4773. first++;
  4774. lcd_implementation_clear();
  4775. }
  4776. }
  4777. if (cursor_pos < 1) {
  4778. cursor_pos = 1;
  4779. if (first > 0) {
  4780. first--;
  4781. lcd_implementation_clear();
  4782. }
  4783. }
  4784. lcd.setCursor(0, 1);
  4785. lcd.print(" ");
  4786. lcd.setCursor(0, 2);
  4787. lcd.print(" ");
  4788. lcd.setCursor(0, 3);
  4789. lcd.print(" ");
  4790. lcd.setCursor(0, cursor_pos);
  4791. lcd.print(">");
  4792. enc_dif = encoderDiff;
  4793. delay(100);
  4794. }
  4795. if (lcd_clicked()) {
  4796. while (lcd_clicked());
  4797. delay(10);
  4798. while (lcd_clicked());
  4799. switch(cursor_pos + first - 1) {
  4800. case 0: return 1; break;
  4801. case 1: return 0; break;
  4802. default: return 99; break;
  4803. }
  4804. }
  4805. }
  4806. }
  4807. void lcd_confirm_print()
  4808. {
  4809. uint8_t filament_type;
  4810. int enc_dif = 0;
  4811. int cursor_pos = 1;
  4812. int _ret = 0;
  4813. int _t = 0;
  4814. enc_dif = encoderDiff;
  4815. lcd_implementation_clear();
  4816. lcd.setCursor(0, 0);
  4817. lcd.print("Print ok ?");
  4818. do
  4819. {
  4820. if (abs(enc_dif - encoderDiff) > 12) {
  4821. if (enc_dif > encoderDiff) {
  4822. cursor_pos--;
  4823. }
  4824. if (enc_dif < encoderDiff) {
  4825. cursor_pos++;
  4826. }
  4827. enc_dif = encoderDiff;
  4828. }
  4829. if (cursor_pos > 2) { cursor_pos = 2; }
  4830. if (cursor_pos < 1) { cursor_pos = 1; }
  4831. lcd.setCursor(0, 2); lcd.print(" ");
  4832. lcd.setCursor(0, 3); lcd.print(" ");
  4833. lcd.setCursor(2, 2);
  4834. lcd_printPGM(_T(MSG_YES));
  4835. lcd.setCursor(2, 3);
  4836. lcd_printPGM(_T(MSG_NO));
  4837. lcd.setCursor(0, 1 + cursor_pos);
  4838. lcd.print(">");
  4839. delay(100);
  4840. _t = _t + 1;
  4841. if (_t>100)
  4842. {
  4843. prusa_statistics(99);
  4844. _t = 0;
  4845. }
  4846. if (lcd_clicked())
  4847. {
  4848. if (cursor_pos == 1)
  4849. {
  4850. _ret = 1;
  4851. filament_type = lcd_choose_color();
  4852. prusa_statistics(4, filament_type);
  4853. no_response = true; //we need confirmation by recieving PRUSA thx
  4854. important_status = 4;
  4855. saved_filament_type = filament_type;
  4856. NcTime = millis();
  4857. }
  4858. if (cursor_pos == 2)
  4859. {
  4860. _ret = 2;
  4861. filament_type = lcd_choose_color();
  4862. prusa_statistics(5, filament_type);
  4863. no_response = true; //we need confirmation by recieving PRUSA thx
  4864. important_status = 5;
  4865. saved_filament_type = filament_type;
  4866. NcTime = millis();
  4867. }
  4868. }
  4869. manage_heater();
  4870. manage_inactivity();
  4871. proc_commands();
  4872. } while (_ret == 0);
  4873. }
  4874. extern void __test();
  4875. static void lcd_test_menu()
  4876. {
  4877. __test();
  4878. }
  4879. static void lcd_main_menu()
  4880. {
  4881. SDscrool = 0;
  4882. START_MENU();
  4883. // Majkl superawesome menu
  4884. MENU_ITEM(back, _T(MSG_WATCH), 0);
  4885. #ifdef RESUME_DEBUG
  4886. if (!saved_printing)
  4887. MENU_ITEM(function, PSTR("tst - Save"), lcd_menu_test_save);
  4888. else
  4889. MENU_ITEM(function, PSTR("tst - Restore"), lcd_menu_test_restore);
  4890. #endif //RESUME_DEBUG
  4891. #ifdef TMC2130_DEBUG
  4892. MENU_ITEM(function, PSTR("recover print"), recover_print);
  4893. MENU_ITEM(function, PSTR("power panic"), uvlo_);
  4894. #endif //TMC2130_DEBUG
  4895. /* if (farm_mode && !IS_SD_PRINTING )
  4896. {
  4897. int tempScrool = 0;
  4898. if (lcdDrawUpdate == 0 && LCD_CLICKED == 0)
  4899. //delay(100);
  4900. return; // nothing to do (so don't thrash the SD card)
  4901. uint16_t fileCnt = card.getnrfilenames();
  4902. card.getWorkDirName();
  4903. if (card.filename[0] == '/')
  4904. {
  4905. #if SDCARDDETECT == -1
  4906. MENU_ITEM(function, _T(MSG_REFRESH), lcd_sd_refresh);
  4907. #endif
  4908. } else {
  4909. MENU_ITEM(function, PSTR(LCD_STR_FOLDER ".."), lcd_sd_updir);
  4910. }
  4911. for (uint16_t i = 0; i < fileCnt; i++)
  4912. {
  4913. if (_menuItemNr == _lineNr)
  4914. {
  4915. #ifndef SDCARD_RATHERRECENTFIRST
  4916. card.getfilename(i);
  4917. #else
  4918. card.getfilename(fileCnt - 1 - i);
  4919. #endif
  4920. if (card.filenameIsDir)
  4921. {
  4922. MENU_ITEM(sddirectory, _T(MSG_CARD_MENU), card.filename, card.longFilename);
  4923. } else {
  4924. MENU_ITEM(sdfile, _T(MSG_CARD_MENU), card.filename, card.longFilename);
  4925. }
  4926. } else {
  4927. MENU_ITEM_DUMMY();
  4928. }
  4929. }
  4930. MENU_ITEM(back, PSTR("- - - - - - - - -"), 0);
  4931. }*/
  4932. 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)
  4933. {
  4934. MENU_ITEM(submenu, _T(MSG_BABYSTEP_Z), lcd_babystep_z);//8
  4935. }
  4936. if ( moves_planned() || IS_SD_PRINTING || is_usb_printing || (lcd_commands_type == LCD_COMMAND_V2_CAL))
  4937. {
  4938. MENU_ITEM(submenu, _i("Tune"), lcd_tune_menu);////MSG_TUNE c=0 r=0
  4939. } else
  4940. {
  4941. MENU_ITEM(submenu, _i("Preheat"), lcd_preheat_menu);////MSG_PREHEAT c=0 r=0
  4942. }
  4943. #ifdef SDSUPPORT
  4944. if (card.cardOK || lcd_commands_type == LCD_COMMAND_V2_CAL)
  4945. {
  4946. if (card.isFileOpen())
  4947. {
  4948. if (mesh_bed_leveling_flag == false && homing_flag == false) {
  4949. if (card.sdprinting)
  4950. {
  4951. MENU_ITEM(function, _i("Pause print"), lcd_sdcard_pause);////MSG_PAUSE_PRINT c=0 r=0
  4952. }
  4953. else
  4954. {
  4955. MENU_ITEM(function, _i("Resume print"), lcd_sdcard_resume);////MSG_RESUME_PRINT c=0 r=0
  4956. }
  4957. MENU_ITEM(submenu, _T(MSG_STOP_PRINT), lcd_sdcard_stop);
  4958. }
  4959. }
  4960. else if (lcd_commands_type == LCD_COMMAND_V2_CAL && mesh_bed_leveling_flag == false && homing_flag == false) {
  4961. //MENU_ITEM(submenu, _T(MSG_STOP_PRINT), lcd_sdcard_stop);
  4962. }
  4963. else
  4964. {
  4965. if (!is_usb_printing && (lcd_commands_type != LCD_COMMAND_V2_CAL))
  4966. {
  4967. //if (farm_mode) MENU_ITEM(submenu, MSG_FARM_CARD_MENU, lcd_farm_sdcard_menu);
  4968. /*else*/ MENU_ITEM(submenu, _T(MSG_CARD_MENU), lcd_sdcard_menu);
  4969. }
  4970. #if SDCARDDETECT < 1
  4971. MENU_ITEM(gcode, _i("Change SD card"), PSTR("M21")); // SD-card changed by user////MSG_CNG_SDCARD c=0 r=0
  4972. #endif
  4973. }
  4974. } else
  4975. {
  4976. MENU_ITEM(submenu, _i("No SD card"), lcd_sdcard_menu);////MSG_NO_CARD c=0 r=0
  4977. #if SDCARDDETECT < 1
  4978. MENU_ITEM(gcode, _i("Init. SD card"), PSTR("M21")); // Manually initialize the SD-card via user interface////MSG_INIT_SDCARD c=0 r=0
  4979. #endif
  4980. }
  4981. #endif
  4982. if (IS_SD_PRINTING || is_usb_printing || (lcd_commands_type == LCD_COMMAND_V2_CAL))
  4983. {
  4984. if (farm_mode)
  4985. {
  4986. MENU_ITEM(submenu, PSTR("Farm number"), lcd_farm_no);
  4987. }
  4988. }
  4989. else
  4990. {
  4991. #ifndef SNMM
  4992. #ifdef PAT9125
  4993. if ( ((filament_autoload_enabled == true) && (fsensor_enabled == true)))
  4994. MENU_ITEM(submenu, _i("AutoLoad filament"), lcd_menu_AutoLoadFilament);////MSG_AUTOLOAD_FILAMENT c=17 r=0
  4995. else
  4996. #endif //PAT9125
  4997. MENU_ITEM(function, _T(MSG_LOAD_FILAMENT), lcd_LoadFilament);
  4998. MENU_ITEM(submenu, _T(MSG_UNLOAD_FILAMENT), lcd_unLoadFilament);
  4999. #endif
  5000. #ifdef SNMM
  5001. MENU_ITEM(submenu, _T(MSG_LOAD_FILAMENT), fil_load_menu);
  5002. MENU_ITEM(submenu, _T(MSG_UNLOAD_FILAMENT), fil_unload_menu);
  5003. MENU_ITEM(submenu, _i("Change extruder"), change_extr_menu);////MSG_CHANGE_EXTR c=20 r=1
  5004. #endif
  5005. MENU_ITEM(submenu, _T(MSG_SETTINGS), lcd_settings_menu);
  5006. if(!isPrintPaused) MENU_ITEM(submenu, _T(MSG_MENU_CALIBRATION), lcd_calibration_menu);
  5007. #ifdef EXPERIMENTAL_FEATURES
  5008. MENU_ITEM(submenu, PSTR("Experimantal"), lcd_experimantal_menu);
  5009. #endif //EXPERIMENTAL_FEATURES
  5010. }
  5011. if (!is_usb_printing && (lcd_commands_type != LCD_COMMAND_V2_CAL))
  5012. {
  5013. MENU_ITEM(submenu, _i("Statistics "), lcd_menu_statistics);////MSG_STATISTICS c=0 r=0
  5014. }
  5015. #if defined(TMC2130) || defined(PAT9125)
  5016. MENU_ITEM(submenu, PSTR("Fail stats"), lcd_menu_fails_stats);
  5017. #endif
  5018. MENU_ITEM(submenu, _i("Support"), lcd_support_menu);////MSG_SUPPORT c=0 r=0
  5019. // MENU_ITEM(submenu, _i("Test"), lcd_test_menu);////MSG_SUPPORT c=0 r=0
  5020. END_MENU();
  5021. }
  5022. void stack_error() {
  5023. SET_OUTPUT(BEEPER);
  5024. WRITE(BEEPER, HIGH);
  5025. delay(1000);
  5026. WRITE(BEEPER, LOW);
  5027. lcd_display_message_fullscreen_P(_i("Error - static memory has been overwritten"));////MSG_STACK_ERROR c=20 r=4
  5028. //err_triggered = 1;
  5029. while (1) delay_keep_alive(1000);
  5030. }
  5031. #ifdef DEBUG_STEPPER_TIMER_MISSED
  5032. bool stepper_timer_overflow_state = false;
  5033. uint16_t stepper_timer_overflow_max = 0;
  5034. uint16_t stepper_timer_overflow_last = 0;
  5035. uint16_t stepper_timer_overflow_cnt = 0;
  5036. void stepper_timer_overflow() {
  5037. char msg[28];
  5038. sprintf_P(msg, PSTR("#%d %d max %d"), ++ stepper_timer_overflow_cnt, stepper_timer_overflow_last >> 1, stepper_timer_overflow_max >> 1);
  5039. lcd_setstatus(msg);
  5040. stepper_timer_overflow_state = false;
  5041. if (stepper_timer_overflow_last > stepper_timer_overflow_max)
  5042. stepper_timer_overflow_max = stepper_timer_overflow_last;
  5043. SERIAL_ECHOPGM("Stepper timer overflow: ");
  5044. MYSERIAL.print(msg);
  5045. SERIAL_ECHOLNPGM("");
  5046. WRITE(BEEPER, LOW);
  5047. }
  5048. #endif /* DEBUG_STEPPER_TIMER_MISSED */
  5049. #ifdef SDSUPPORT
  5050. static void lcd_autostart_sd()
  5051. {
  5052. card.lastnr = 0;
  5053. card.setroot();
  5054. card.checkautostart(true);
  5055. }
  5056. #endif
  5057. static void lcd_silent_mode_set_tune() {
  5058. switch (SilentModeMenu) {
  5059. #ifdef TMC2130
  5060. case SILENT_MODE_NORMAL: SilentModeMenu = SILENT_MODE_STEALTH; break;
  5061. case SILENT_MODE_STEALTH: SilentModeMenu = SILENT_MODE_NORMAL; break;
  5062. default: SilentModeMenu = SILENT_MODE_NORMAL; break; // (probably) not needed
  5063. #else
  5064. case SILENT_MODE_POWER: SilentModeMenu = SILENT_MODE_SILENT; break;
  5065. case SILENT_MODE_SILENT: SilentModeMenu = SILENT_MODE_AUTO; break;
  5066. case SILENT_MODE_AUTO: SilentModeMenu = SILENT_MODE_POWER; break;
  5067. default: SilentModeMenu = SILENT_MODE_POWER; break; // (probably) not needed
  5068. #endif //TMC2130
  5069. }
  5070. eeprom_update_byte((unsigned char *)EEPROM_SILENT, SilentModeMenu);
  5071. st_current_init();
  5072. menu_action_back();
  5073. }
  5074. static void lcd_colorprint_change() {
  5075. enquecommand_P(PSTR("M600"));
  5076. custom_message = true;
  5077. custom_message_type = 2; //just print status message
  5078. lcd_setstatuspgm(_T(MSG_FINISHING_MOVEMENTS));
  5079. lcd_return_to_status();
  5080. lcdDrawUpdate = 3;
  5081. }
  5082. static void lcd_tune_menu()
  5083. {
  5084. if (menuData.tuneMenu.status == 0) {
  5085. // Menu was entered. Mark the menu as entered and save the current extrudemultiply value.
  5086. menuData.tuneMenu.status = 1;
  5087. menuData.tuneMenu.extrudemultiply = extrudemultiply;
  5088. } else if (menuData.tuneMenu.extrudemultiply != extrudemultiply) {
  5089. // extrudemultiply has been changed from the child menu. Apply the new value.
  5090. menuData.tuneMenu.extrudemultiply = extrudemultiply;
  5091. calculate_extruder_multipliers();
  5092. }
  5093. EEPROM_read(EEPROM_SILENT, (uint8_t*)&SilentModeMenu, sizeof(SilentModeMenu));
  5094. START_MENU();
  5095. MENU_ITEM(back, _T(MSG_MAIN), 0); //1
  5096. MENU_ITEM_EDIT(int3, _i("Speed"), &feedmultiply, 10, 999);//2////MSG_SPEED c=0 r=0
  5097. MENU_ITEM_EDIT(int3, _T(MSG_NOZZLE), &target_temperature[0], 0, HEATER_0_MAXTEMP - 10);//3
  5098. MENU_ITEM_EDIT(int3, _T(MSG_BED), &target_temperature_bed, 0, BED_MAXTEMP - 10);//4
  5099. MENU_ITEM_EDIT(int3, _T(MSG_FAN_SPEED), &fanSpeed, 0, 255);//5
  5100. MENU_ITEM_EDIT(int3, _i("Flow"), &extrudemultiply, 10, 999);//6////MSG_FLOW c=0 r=0
  5101. #ifdef FILAMENTCHANGEENABLE
  5102. MENU_ITEM(function, _T(MSG_FILAMENTCHANGE), lcd_colorprint_change);//7
  5103. #endif
  5104. #ifndef DEBUG_DISABLE_FSENSORCHECK
  5105. #ifdef PAT9125
  5106. if (FSensorStateMenu == 0) {
  5107. MENU_ITEM(function, _T(MSG_FSENSOR_OFF), lcd_fsensor_state_set);
  5108. }
  5109. else {
  5110. MENU_ITEM(function, _T(MSG_FSENSOR_ON), lcd_fsensor_state_set);
  5111. }
  5112. #endif //PAT9125
  5113. #endif //DEBUG_DISABLE_FSENSORCHECK
  5114. #ifdef TMC2130
  5115. if(!farm_mode)
  5116. {
  5117. //*** MaR::180416_01b
  5118. if (SilentModeMenu == SILENT_MODE_NORMAL) MENU_ITEM(function, _T(MSG_STEALTH_MODE_OFF), lcd_silent_mode_set);
  5119. else MENU_ITEM(function, _T(MSG_STEALTH_MODE_ON), lcd_silent_mode_set);
  5120. if (SilentModeMenu == SILENT_MODE_NORMAL)
  5121. {
  5122. if (CrashDetectMenu == 0) MENU_ITEM(function, _T(MSG_CRASHDETECT_OFF), lcd_crash_mode_set);
  5123. else MENU_ITEM(function, _T(MSG_CRASHDETECT_ON), lcd_crash_mode_set);
  5124. }
  5125. else MENU_ITEM(submenu, _T(MSG_CRASHDETECT_NA), lcd_crash_mode_info);
  5126. }
  5127. #else //TMC2130
  5128. if (!farm_mode) { //dont show in menu if we are in farm mode
  5129. switch (SilentModeMenu) {
  5130. case SILENT_MODE_POWER: MENU_ITEM(function, _T(MSG_SILENT_MODE_OFF), lcd_silent_mode_set); break;
  5131. case SILENT_MODE_SILENT: MENU_ITEM(function, _T(MSG_SILENT_MODE_ON), lcd_silent_mode_set); break;
  5132. case SILENT_MODE_AUTO: MENU_ITEM(function, _T(MSG_AUTO_MODE_ON), lcd_silent_mode_set); break;
  5133. default: MENU_ITEM(function, _T(MSG_SILENT_MODE_OFF), lcd_silent_mode_set); break; // (probably) not needed
  5134. }
  5135. }
  5136. #endif //TMC2130
  5137. END_MENU();
  5138. }
  5139. static void lcd_move_menu_01mm()
  5140. {
  5141. move_menu_scale = 0.1;
  5142. lcd_move_menu_axis();
  5143. }
  5144. static void lcd_control_temperature_menu()
  5145. {
  5146. #ifdef PIDTEMP
  5147. // set up temp variables - undo the default scaling
  5148. // raw_Ki = unscalePID_i(Ki);
  5149. // raw_Kd = unscalePID_d(Kd);
  5150. #endif
  5151. START_MENU();
  5152. MENU_ITEM(back, _T(MSG_SETTINGS), 0);
  5153. #if TEMP_SENSOR_0 != 0
  5154. MENU_ITEM_EDIT(int3, _T(MSG_NOZZLE), &target_temperature[0], 0, HEATER_0_MAXTEMP - 10);
  5155. #endif
  5156. #if TEMP_SENSOR_1 != 0
  5157. MENU_ITEM_EDIT(int3, _i("Nozzle2"), &target_temperature[1], 0, HEATER_1_MAXTEMP - 10);////MSG_NOZZLE1 c=0 r=0
  5158. #endif
  5159. #if TEMP_SENSOR_2 != 0
  5160. MENU_ITEM_EDIT(int3, _i("Nozzle3"), &target_temperature[2], 0, HEATER_2_MAXTEMP - 10);////MSG_NOZZLE2 c=0 r=0
  5161. #endif
  5162. #if TEMP_SENSOR_BED != 0
  5163. MENU_ITEM_EDIT(int3, _T(MSG_BED), &target_temperature_bed, 0, BED_MAXTEMP - 3);
  5164. #endif
  5165. MENU_ITEM_EDIT(int3, _T(MSG_FAN_SPEED), &fanSpeed, 0, 255);
  5166. #if defined AUTOTEMP && (TEMP_SENSOR_0 != 0)
  5167. MENU_ITEM_EDIT(bool, MSG_AUTOTEMP, &autotemp_enabled);
  5168. MENU_ITEM_EDIT(float3, _i(" \002 Min"), &autotemp_min, 0, HEATER_0_MAXTEMP - 10);////MSG_MIN c=0 r=0
  5169. MENU_ITEM_EDIT(float3, _i(" \002 Max"), &autotemp_max, 0, HEATER_0_MAXTEMP - 10);////MSG_MAX c=0 r=0
  5170. MENU_ITEM_EDIT(float32, _i(" \002 Fact"), &autotemp_factor, 0.0, 1.0);////MSG_FACTOR c=0 r=0
  5171. #endif
  5172. END_MENU();
  5173. }
  5174. #if SDCARDDETECT == -1
  5175. static void lcd_sd_refresh()
  5176. {
  5177. card.initsd();
  5178. currentMenuViewOffset = 0;
  5179. }
  5180. #endif
  5181. static void lcd_sd_updir()
  5182. {
  5183. SDscrool = 0;
  5184. card.updir();
  5185. currentMenuViewOffset = 0;
  5186. }
  5187. void lcd_print_stop() {
  5188. cancel_heatup = true;
  5189. #ifdef MESH_BED_LEVELING
  5190. mbl.active = false;
  5191. #endif
  5192. // Stop the stoppers, update the position from the stoppers.
  5193. if (mesh_bed_leveling_flag == false && homing_flag == false) {
  5194. planner_abort_hard();
  5195. // Because the planner_abort_hard() initialized current_position[Z] from the stepper,
  5196. // Z baystep is no more applied. Reset it.
  5197. babystep_reset();
  5198. }
  5199. // Clean the input command queue.
  5200. cmdqueue_reset();
  5201. lcd_setstatuspgm(_T(MSG_PRINT_ABORTED));
  5202. lcd_update(2);
  5203. card.sdprinting = false;
  5204. card.closefile();
  5205. stoptime = millis();
  5206. unsigned long t = (stoptime - starttime - pause_time) / 1000; //time in s
  5207. pause_time = 0;
  5208. save_statistics(total_filament_used, t);
  5209. lcd_return_to_status();
  5210. lcd_ignore_click(true);
  5211. lcd_commands_step = 0;
  5212. lcd_commands_type = LCD_COMMAND_STOP_PRINT;
  5213. // Turn off the print fan
  5214. SET_OUTPUT(FAN_PIN);
  5215. WRITE(FAN_PIN, 0);
  5216. fanSpeed = 0;
  5217. }
  5218. void lcd_sdcard_stop()
  5219. {
  5220. lcd.setCursor(0, 0);
  5221. lcd_printPGM(_T(MSG_STOP_PRINT));
  5222. lcd.setCursor(2, 2);
  5223. lcd_printPGM(_T(MSG_NO));
  5224. lcd.setCursor(2, 3);
  5225. lcd_printPGM(_T(MSG_YES));
  5226. lcd.setCursor(0, 2); lcd.print(" ");
  5227. lcd.setCursor(0, 3); lcd.print(" ");
  5228. if ((int32_t)encoderPosition > 2) { encoderPosition = 2; }
  5229. if ((int32_t)encoderPosition < 1) { encoderPosition = 1; }
  5230. lcd.setCursor(0, 1 + encoderPosition);
  5231. lcd.print(">");
  5232. if (lcd_clicked())
  5233. {
  5234. if ((int32_t)encoderPosition == 1)
  5235. {
  5236. lcd_return_to_status();
  5237. }
  5238. if ((int32_t)encoderPosition == 2)
  5239. {
  5240. lcd_print_stop();
  5241. }
  5242. }
  5243. }
  5244. /*
  5245. void getFileDescription(char *name, char *description) {
  5246. // get file description, ie the REAL filenam, ie the second line
  5247. card.openFile(name, true);
  5248. int i = 0;
  5249. // skip the first line (which is the version line)
  5250. while (true) {
  5251. uint16_t readByte = card.get();
  5252. if (readByte == '\n') {
  5253. break;
  5254. }
  5255. }
  5256. // read the second line (which is the description line)
  5257. while (true) {
  5258. uint16_t readByte = card.get();
  5259. if (i == 0) {
  5260. // skip the first '^'
  5261. readByte = card.get();
  5262. }
  5263. description[i] = readByte;
  5264. i++;
  5265. if (readByte == '\n') {
  5266. break;
  5267. }
  5268. }
  5269. card.closefile();
  5270. description[i-1] = 0;
  5271. }
  5272. */
  5273. void lcd_sdcard_menu()
  5274. {
  5275. uint8_t sdSort = eeprom_read_byte((uint8_t*)EEPROM_SD_SORT);
  5276. int tempScrool = 0;
  5277. if (presort_flag == true) {
  5278. presort_flag = false;
  5279. card.presort();
  5280. }
  5281. if (lcdDrawUpdate == 0 && LCD_CLICKED == 0)
  5282. //delay(100);
  5283. return; // nothing to do (so don't thrash the SD card)
  5284. uint16_t fileCnt = card.getnrfilenames();
  5285. START_MENU();
  5286. MENU_ITEM(back, _T(MSG_MAIN), 0);
  5287. card.getWorkDirName();
  5288. if (card.filename[0] == '/')
  5289. {
  5290. #if SDCARDDETECT == -1
  5291. MENU_ITEM(function, _T(MSG_REFRESH), lcd_sd_refresh);
  5292. #endif
  5293. } else {
  5294. MENU_ITEM(function, PSTR(LCD_STR_FOLDER ".."), lcd_sd_updir);
  5295. }
  5296. for (uint16_t i = 0; i < fileCnt; i++)
  5297. {
  5298. if (_menuItemNr == _lineNr)
  5299. {
  5300. const uint16_t nr = ((sdSort == SD_SORT_NONE) || farm_mode || (sdSort == SD_SORT_TIME)) ? (fileCnt - 1 - i) : i;
  5301. /*#ifdef SDCARD_RATHERRECENTFIRST
  5302. #ifndef SDCARD_SORT_ALPHA
  5303. fileCnt - 1 -
  5304. #endif
  5305. #endif
  5306. i;*/
  5307. #ifdef SDCARD_SORT_ALPHA
  5308. if (sdSort == SD_SORT_NONE) card.getfilename(nr);
  5309. else card.getfilename_sorted(nr);
  5310. #else
  5311. card.getfilename(nr);
  5312. #endif
  5313. if (card.filenameIsDir)
  5314. MENU_ITEM(sddirectory, _T(MSG_CARD_MENU), card.filename, card.longFilename);
  5315. else
  5316. MENU_ITEM(sdfile, _T(MSG_CARD_MENU), card.filename, card.longFilename);
  5317. } else {
  5318. MENU_ITEM_DUMMY();
  5319. }
  5320. }
  5321. END_MENU();
  5322. }
  5323. //char description [10] [31];
  5324. /*void get_description() {
  5325. uint16_t fileCnt = card.getnrfilenames();
  5326. for (uint16_t i = 0; i < fileCnt; i++)
  5327. {
  5328. card.getfilename(fileCnt - 1 - i);
  5329. getFileDescription(card.filename, description[i]);
  5330. }
  5331. }*/
  5332. /*void lcd_farm_sdcard_menu()
  5333. {
  5334. static int i = 0;
  5335. if (i == 0) {
  5336. get_description();
  5337. i++;
  5338. }
  5339. //int j;
  5340. //char description[31];
  5341. int tempScrool = 0;
  5342. if (lcdDrawUpdate == 0 && LCD_CLICKED == 0)
  5343. //delay(100);
  5344. return; // nothing to do (so don't thrash the SD card)
  5345. uint16_t fileCnt = card.getnrfilenames();
  5346. START_MENU();
  5347. MENU_ITEM(back, _T(MSG_MAIN), 0);
  5348. card.getWorkDirName();
  5349. if (card.filename[0] == '/')
  5350. {
  5351. #if SDCARDDETECT == -1
  5352. MENU_ITEM(function, _T(MSG_REFRESH), lcd_sd_refresh);
  5353. #endif
  5354. }
  5355. else {
  5356. MENU_ITEM(function, PSTR(LCD_STR_FOLDER ".."), lcd_sd_updir);
  5357. }
  5358. for (uint16_t i = 0; i < fileCnt; i++)
  5359. {
  5360. if (_menuItemNr == _lineNr)
  5361. {
  5362. #ifndef SDCARD_RATHERRECENTFIRST
  5363. card.getfilename(i);
  5364. #else
  5365. card.getfilename(fileCnt - 1 - i);
  5366. #endif
  5367. if (card.filenameIsDir)
  5368. {
  5369. MENU_ITEM(sddirectory, _T(MSG_CARD_MENU), card.filename, card.longFilename);
  5370. }
  5371. else {
  5372. MENU_ITEM(sdfile, _T(MSG_CARD_MENU), card.filename, description[i]);
  5373. }
  5374. }
  5375. else {
  5376. MENU_ITEM_DUMMY();
  5377. }
  5378. }
  5379. END_MENU();
  5380. }*/
  5381. #define menu_edit_type(_type, _name, _strFunc, scale) \
  5382. void menu_edit_ ## _name () \
  5383. { \
  5384. if ((int32_t)encoderPosition < 0) encoderPosition = 0; \
  5385. if ((int32_t)encoderPosition > menuData.editMenuParentState.maxEditValue) encoderPosition = menuData.editMenuParentState.maxEditValue; \
  5386. if (lcdDrawUpdate) \
  5387. lcd_implementation_drawedit(menuData.editMenuParentState.editLabel, _strFunc(((_type)((int32_t)encoderPosition + menuData.editMenuParentState.minEditValue)) / scale)); \
  5388. if (LCD_CLICKED) \
  5389. { \
  5390. *((_type*)menuData.editMenuParentState.editValue) = ((_type)((int32_t)encoderPosition + menuData.editMenuParentState.minEditValue)) / scale; \
  5391. lcd_goto_menu(menuData.editMenuParentState.prevMenu, menuData.editMenuParentState.prevEncoderPosition, true, false); \
  5392. } \
  5393. } \
  5394. static void menu_action_setting_edit_ ## _name (const char* pstr, _type* ptr, _type minValue, _type maxValue) \
  5395. { \
  5396. asm("cli"); \
  5397. menuData.editMenuParentState.prevMenu = currentMenu; \
  5398. menuData.editMenuParentState.prevEncoderPosition = encoderPosition; \
  5399. asm("sei"); \
  5400. \
  5401. lcdDrawUpdate = 2; \
  5402. menuData.editMenuParentState.editLabel = pstr; \
  5403. menuData.editMenuParentState.editValue = ptr; \
  5404. menuData.editMenuParentState.minEditValue = minValue * scale; \
  5405. menuData.editMenuParentState.maxEditValue = maxValue * scale - menuData.editMenuParentState.minEditValue; \
  5406. lcd_goto_menu(menu_edit_ ## _name, (*ptr) * scale - menuData.editMenuParentState.minEditValue, true, false); \
  5407. \
  5408. }\
  5409. /*
  5410. void menu_edit_callback_ ## _name () { \
  5411. menu_edit_ ## _name (); \
  5412. if (LCD_CLICKED) (*callbackFunc)(); \
  5413. } \
  5414. static void menu_action_setting_edit_callback_ ## _name (const char* pstr, _type* ptr, _type minValue, _type maxValue, menuFunc_t callback) \
  5415. { \
  5416. menuData.editMenuParentState.prevMenu = currentMenu; \
  5417. menuData.editMenuParentState.prevEncoderPosition = encoderPosition; \
  5418. \
  5419. lcdDrawUpdate = 2; \
  5420. lcd_goto_menu(menu_edit_callback_ ## _name, (*ptr) * scale - menuData.editMenuParentState.minEditValue, true, false); \
  5421. \
  5422. menuData.editMenuParentState.editLabel = pstr; \
  5423. menuData.editMenuParentState.editValue = ptr; \
  5424. menuData.editMenuParentState.minEditValue = minValue * scale; \
  5425. menuData.editMenuParentState.maxEditValue = maxValue * scale - menuData.editMenuParentState.minEditValue; \
  5426. callbackFunc = callback;\
  5427. }
  5428. */
  5429. #ifdef TMC2130
  5430. extern char conv[8];
  5431. // Convert tmc2130 mres to string
  5432. char *mres_to_str3(const uint8_t &x)
  5433. {
  5434. return itostr3(256 >> x);
  5435. }
  5436. menu_edit_type(uint8_t, mres, mres_to_str3, 1)
  5437. // Convert tmc2130 wfac to string
  5438. char *wfac_to_str5(const uint8_t &x)
  5439. {
  5440. if (x >= TMC2130_WAVE_FAC1000_MIN)
  5441. {
  5442. conv[0] = '[';
  5443. ftostr43(((float)((uint16_t)x + 1000) / 1000), 1);
  5444. }
  5445. else strcpy_P(conv, _i(" [off"));////MSG_EXTRUDER_CORRECTION_OFF c=6 r=0
  5446. conv[6] = ']';
  5447. conv[7] = ' ';
  5448. conv[8] = 0;
  5449. return conv;
  5450. }
  5451. menu_edit_type(uint8_t, wfac, wfac_to_str5, 1)
  5452. #endif //TMC2130
  5453. menu_edit_type(uint8_t, byte3, itostr3, 1)
  5454. menu_edit_type(int, int3, itostr3, 1)
  5455. menu_edit_type(float, float3, ftostr3, 1)
  5456. menu_edit_type(float, float32, ftostr32, 100)
  5457. menu_edit_type(float, float43, ftostr43, 1000)
  5458. menu_edit_type(float, float5, ftostr5, 0.01)
  5459. menu_edit_type(float, float51, ftostr51, 10)
  5460. menu_edit_type(float, float52, ftostr52, 100)
  5461. menu_edit_type(unsigned long, long5, ftostr5, 0.01)
  5462. static void lcd_selftest_v()
  5463. {
  5464. (void)lcd_selftest();
  5465. }
  5466. bool lcd_selftest()
  5467. {
  5468. int _progress = 0;
  5469. bool _result = true;
  5470. lcd_wait_for_cool_down();
  5471. lcd_implementation_clear();
  5472. lcd.setCursor(0, 0); lcd_printPGM(_i("Self test start "));////MSG_SELFTEST_START c=20 r=0
  5473. #ifdef TMC2130
  5474. FORCE_HIGH_POWER_START;
  5475. #endif // TMC2130
  5476. delay(2000);
  5477. KEEPALIVE_STATE(IN_HANDLER);
  5478. _progress = lcd_selftest_screen(-1, _progress, 3, true, 2000);
  5479. #if (defined(FANCHECK) && defined(TACH_0))
  5480. _result = lcd_selftest_fan_dialog(0);
  5481. #else //defined(TACH_0)
  5482. _result = lcd_selftest_manual_fan_check(0, false);
  5483. if (!_result)
  5484. {
  5485. const char *_err;
  5486. lcd_selftest_error(7, _err, _err); //extruder fan not spinning
  5487. }
  5488. #endif //defined(TACH_0)
  5489. if (_result)
  5490. {
  5491. _progress = lcd_selftest_screen(0, _progress, 3, true, 2000);
  5492. #if (defined(FANCHECK) && defined(TACH_1))
  5493. _result = lcd_selftest_fan_dialog(1);
  5494. #else //defined(TACH_1)
  5495. _result = lcd_selftest_manual_fan_check(1, false);
  5496. if (!_result)
  5497. {
  5498. const char *_err;
  5499. lcd_selftest_error(6, _err, _err); //print fan not spinning
  5500. }
  5501. #endif //defined(TACH_1)
  5502. }
  5503. if (_result)
  5504. {
  5505. _progress = lcd_selftest_screen(1, _progress, 3, true, 2000);
  5506. #ifndef TMC2130
  5507. _result = lcd_selfcheck_endstops();
  5508. #else
  5509. _result = true;
  5510. #endif
  5511. }
  5512. if (_result)
  5513. {
  5514. _progress = lcd_selftest_screen(3, _progress, 3, true, 1000);
  5515. _result = lcd_selfcheck_check_heater(false);
  5516. }
  5517. if (_result)
  5518. {
  5519. //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
  5520. _progress = lcd_selftest_screen(4, _progress, 3, true, 2000);
  5521. #ifdef TMC2130
  5522. _result = lcd_selfcheck_axis_sg(X_AXIS);
  5523. #else
  5524. _result = lcd_selfcheck_axis(X_AXIS, X_MAX_POS);
  5525. #endif //TMC2130
  5526. }
  5527. if (_result)
  5528. {
  5529. _progress = lcd_selftest_screen(4, _progress, 3, true, 0);
  5530. #ifndef TMC2130
  5531. _result = lcd_selfcheck_pulleys(X_AXIS);
  5532. #endif
  5533. }
  5534. if (_result)
  5535. {
  5536. _progress = lcd_selftest_screen(5, _progress, 3, true, 1500);
  5537. #ifdef TMC2130
  5538. _result = lcd_selfcheck_axis_sg(Y_AXIS);
  5539. #else
  5540. _result = lcd_selfcheck_axis(Y_AXIS, Y_MAX_POS);
  5541. #endif // TMC2130
  5542. }
  5543. if (_result)
  5544. {
  5545. _progress = lcd_selftest_screen(5, _progress, 3, true, 0);
  5546. #ifndef TMC2130
  5547. _result = lcd_selfcheck_pulleys(Y_AXIS);
  5548. #endif // TMC2130
  5549. }
  5550. if (_result)
  5551. {
  5552. #ifdef TMC2130
  5553. tmc2130_home_exit();
  5554. enable_endstops(false);
  5555. current_position[X_AXIS] = current_position[X_AXIS] + 14;
  5556. current_position[Y_AXIS] = current_position[Y_AXIS] + 12;
  5557. #endif
  5558. //homeaxis(X_AXIS);
  5559. //homeaxis(Y_AXIS);
  5560. current_position[Z_AXIS] = current_position[Z_AXIS] + 10;
  5561. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5562. st_synchronize();
  5563. _progress = lcd_selftest_screen(6, _progress, 3, true, 1500);
  5564. _result = lcd_selfcheck_axis(2, Z_MAX_POS);
  5565. if (eeprom_read_byte((uint8_t*)EEPROM_WIZARD_ACTIVE) != 1) {
  5566. enquecommand_P(PSTR("G28 W"));
  5567. enquecommand_P(PSTR("G1 Z15 F1000"));
  5568. }
  5569. }
  5570. #ifdef TMC2130
  5571. if (_result)
  5572. {
  5573. current_position[Z_AXIS] = current_position[Z_AXIS] + 10;
  5574. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5575. st_synchronize();
  5576. _progress = lcd_selftest_screen(13, 0, 2, true, 0);
  5577. bool bres = tmc2130_home_calibrate(X_AXIS);
  5578. _progress = lcd_selftest_screen(13, 1, 2, true, 0);
  5579. bres &= tmc2130_home_calibrate(Y_AXIS);
  5580. _progress = lcd_selftest_screen(13, 2, 2, true, 0);
  5581. if (bres)
  5582. eeprom_update_byte((uint8_t*)EEPROM_TMC2130_HOME_ENABLED, 1);
  5583. _result = bres;
  5584. }
  5585. #endif //TMC2130
  5586. if (_result)
  5587. {
  5588. _progress = lcd_selftest_screen(7, _progress, 3, true, 2000); //check bed
  5589. _result = lcd_selfcheck_check_heater(true);
  5590. }
  5591. if (_result)
  5592. {
  5593. _progress = lcd_selftest_screen(8, _progress, 3, true, 2000); //bed ok
  5594. #ifdef PAT9125
  5595. _progress = lcd_selftest_screen(9, _progress, 3, true, 2000); //check filaments sensor
  5596. _result = lcd_selftest_fsensor();
  5597. #endif // PAT9125
  5598. }
  5599. if (_result)
  5600. {
  5601. #ifdef PAT9125
  5602. _progress = lcd_selftest_screen(10, _progress, 3, true, 2000); //fil sensor OK
  5603. #endif // PAT9125
  5604. _progress = lcd_selftest_screen(11, _progress, 3, true, 5000); //all correct
  5605. }
  5606. else
  5607. {
  5608. _progress = lcd_selftest_screen(12, _progress, 3, true, 5000);
  5609. }
  5610. lcd_reset_alert_level();
  5611. enquecommand_P(PSTR("M84"));
  5612. lcd_implementation_clear();
  5613. lcd_next_update_millis = millis() + LCD_UPDATE_INTERVAL;
  5614. if (_result)
  5615. {
  5616. LCD_ALERTMESSAGERPGM(_i("Self test OK"));////MSG_SELFTEST_OK c=0 r=0
  5617. }
  5618. else
  5619. {
  5620. LCD_ALERTMESSAGERPGM(_T(MSG_SELFTEST_FAILED));
  5621. }
  5622. #ifdef TMC2130
  5623. FORCE_HIGH_POWER_END;
  5624. #endif // TMC2130
  5625. KEEPALIVE_STATE(NOT_BUSY);
  5626. return(_result);
  5627. }
  5628. #ifdef TMC2130
  5629. static void reset_crash_det(char axis) {
  5630. current_position[axis] += 10;
  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. if (eeprom_read_byte((uint8_t*)EEPROM_CRASH_DET)) tmc2130_sg_stop_on_crash = true;
  5634. }
  5635. static bool lcd_selfcheck_axis_sg(char axis) {
  5636. // each axis length is measured twice
  5637. float axis_length, current_position_init, current_position_final;
  5638. float measured_axis_length[2];
  5639. float margin = 60;
  5640. float max_error_mm = 5;
  5641. switch (axis) {
  5642. case 0: axis_length = X_MAX_POS; break;
  5643. case 1: axis_length = Y_MAX_POS + 8; break;
  5644. default: axis_length = 210; break;
  5645. }
  5646. tmc2130_sg_stop_on_crash = false;
  5647. tmc2130_home_exit();
  5648. enable_endstops(true);
  5649. if (axis == X_AXIS) { //there is collision between cables and PSU cover in X axis if Z coordinate is too low
  5650. current_position[Z_AXIS] += 17;
  5651. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5652. tmc2130_home_enter(Z_AXIS_MASK);
  5653. st_synchronize();
  5654. tmc2130_home_exit();
  5655. }
  5656. // first axis length measurement begin
  5657. current_position[axis] -= (axis_length + margin);
  5658. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5659. st_synchronize();
  5660. tmc2130_sg_meassure_start(axis);
  5661. current_position_init = st_get_position_mm(axis);
  5662. current_position[axis] += 2 * margin;
  5663. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5664. st_synchronize();
  5665. current_position[axis] += axis_length;
  5666. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5667. st_synchronize();
  5668. uint16_t sg1 = tmc2130_sg_meassure_stop();
  5669. printf_P(PSTR("%c AXIS SG1=%d\n"), 'X'+axis, sg1);
  5670. eeprom_write_word(((uint16_t*)((axis == X_AXIS)?EEPROM_BELTSTATUS_X:EEPROM_BELTSTATUS_Y)), sg1);
  5671. current_position_final = st_get_position_mm(axis);
  5672. measured_axis_length[0] = abs(current_position_final - current_position_init);
  5673. // first measurement end and second measurement begin
  5674. current_position[axis] -= margin;
  5675. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5676. st_synchronize();
  5677. current_position[axis] -= (axis_length + margin);
  5678. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5679. st_synchronize();
  5680. current_position_init = st_get_position_mm(axis);
  5681. measured_axis_length[1] = abs(current_position_final - current_position_init);
  5682. //end of second measurement, now check for possible errors:
  5683. for(int i = 0; i < 2; i++){ //check if measured axis length corresponds to expected length
  5684. SERIAL_ECHOPGM("Measured axis length:");
  5685. MYSERIAL.println(measured_axis_length[i]);
  5686. if (abs(measured_axis_length[i] - axis_length) > max_error_mm) {
  5687. enable_endstops(false);
  5688. const char *_error_1;
  5689. const char *_error_2;
  5690. if (axis == X_AXIS) _error_1 = "X";
  5691. if (axis == Y_AXIS) _error_1 = "Y";
  5692. if (axis == Z_AXIS) _error_1 = "Z";
  5693. lcd_selftest_error(9, _error_1, _error_2);
  5694. current_position[axis] = 0;
  5695. plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
  5696. reset_crash_det(axis);
  5697. return false;
  5698. }
  5699. }
  5700. SERIAL_ECHOPGM("Axis length difference:");
  5701. MYSERIAL.println(abs(measured_axis_length[0] - measured_axis_length[1]));
  5702. if (abs(measured_axis_length[0] - measured_axis_length[1]) > 1) { //check if difference between first and second measurement is low
  5703. //loose pulleys
  5704. const char *_error_1;
  5705. const char *_error_2;
  5706. if (axis == X_AXIS) _error_1 = "X";
  5707. if (axis == Y_AXIS) _error_1 = "Y";
  5708. if (axis == Z_AXIS) _error_1 = "Z";
  5709. lcd_selftest_error(8, _error_1, _error_2);
  5710. current_position[axis] = 0;
  5711. plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
  5712. reset_crash_det(axis);
  5713. return false;
  5714. }
  5715. current_position[axis] = 0;
  5716. plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
  5717. reset_crash_det(axis);
  5718. return true;
  5719. }
  5720. #endif //TMC2130
  5721. //#ifndef TMC2130
  5722. static bool lcd_selfcheck_axis(int _axis, int _travel)
  5723. {
  5724. // printf_P(PSTR("lcd_selfcheck_axis %d, %d\n"), _axis, _travel);
  5725. bool _stepdone = false;
  5726. bool _stepresult = false;
  5727. int _progress = 0;
  5728. int _travel_done = 0;
  5729. int _err_endstop = 0;
  5730. int _lcd_refresh = 0;
  5731. _travel = _travel + (_travel / 10);
  5732. if (_axis == X_AXIS) {
  5733. current_position[Z_AXIS] += 17;
  5734. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5735. }
  5736. do {
  5737. current_position[_axis] = current_position[_axis] - 1;
  5738. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5739. st_synchronize();
  5740. #ifdef TMC2130
  5741. if ((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING == 1))
  5742. #else //TMC2130
  5743. if (((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ||
  5744. ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1) ||
  5745. ((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING) == 1))
  5746. #endif //TMC2130
  5747. {
  5748. if (_axis == 0)
  5749. {
  5750. _stepresult = ((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ? true : false;
  5751. _err_endstop = ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1) ? 1 : 2;
  5752. }
  5753. if (_axis == 1)
  5754. {
  5755. _stepresult = ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1) ? true : false;
  5756. _err_endstop = ((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ? 0 : 2;
  5757. }
  5758. if (_axis == 2)
  5759. {
  5760. _stepresult = ((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING) == 1) ? true : false;
  5761. _err_endstop = ((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ? 0 : 1;
  5762. printf_P(PSTR("lcd_selfcheck_axis %d, %d\n"), _stepresult, _err_endstop);
  5763. /*disable_x();
  5764. disable_y();
  5765. disable_z();*/
  5766. }
  5767. _stepdone = true;
  5768. }
  5769. if (_lcd_refresh < 6)
  5770. {
  5771. _lcd_refresh++;
  5772. }
  5773. else
  5774. {
  5775. _progress = lcd_selftest_screen(4 + _axis, _progress, 3, false, 0);
  5776. _lcd_refresh = 0;
  5777. }
  5778. manage_heater();
  5779. manage_inactivity(true);
  5780. //delay(100);
  5781. (_travel_done <= _travel) ? _travel_done++ : _stepdone = true;
  5782. } while (!_stepdone);
  5783. //current_position[_axis] = current_position[_axis] + 15;
  5784. //plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5785. if (!_stepresult)
  5786. {
  5787. const char *_error_1;
  5788. const char *_error_2;
  5789. if (_axis == X_AXIS) _error_1 = "X";
  5790. if (_axis == Y_AXIS) _error_1 = "Y";
  5791. if (_axis == Z_AXIS) _error_1 = "Z";
  5792. if (_err_endstop == 0) _error_2 = "X";
  5793. if (_err_endstop == 1) _error_2 = "Y";
  5794. if (_err_endstop == 2) _error_2 = "Z";
  5795. if (_travel_done >= _travel)
  5796. {
  5797. lcd_selftest_error(5, _error_1, _error_2);
  5798. }
  5799. else
  5800. {
  5801. lcd_selftest_error(4, _error_1, _error_2);
  5802. }
  5803. }
  5804. return _stepresult;
  5805. }
  5806. #ifndef TMC2130
  5807. static bool lcd_selfcheck_pulleys(int axis)
  5808. {
  5809. float tmp_motor_loud[3] = DEFAULT_PWM_MOTOR_CURRENT_LOUD;
  5810. float tmp_motor[3] = DEFAULT_PWM_MOTOR_CURRENT;
  5811. float current_position_init;
  5812. float move;
  5813. bool endstop_triggered = false;
  5814. int i;
  5815. unsigned long timeout_counter;
  5816. refresh_cmd_timeout();
  5817. manage_inactivity(true);
  5818. if (axis == 0) move = 50; //X_AXIS
  5819. else move = 50; //Y_AXIS
  5820. current_position_init = current_position[axis];
  5821. current_position[axis] += 2;
  5822. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5823. for (i = 0; i < 5; i++) {
  5824. refresh_cmd_timeout();
  5825. current_position[axis] = current_position[axis] + move;
  5826. st_current_set(0, 850); //set motor current higher
  5827. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], 200, active_extruder);
  5828. st_synchronize();
  5829. //*** MaR::180416_02
  5830. if (SilentModeMenu != SILENT_MODE_OFF) st_current_set(0, tmp_motor[0]); //set back to normal operation currents
  5831. else st_current_set(0, tmp_motor_loud[0]); //set motor current back
  5832. current_position[axis] = current_position[axis] - move;
  5833. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], 50, active_extruder);
  5834. st_synchronize();
  5835. if (((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ||
  5836. ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1)) {
  5837. lcd_selftest_error(8, (axis == 0) ? "X" : "Y", "");
  5838. return(false);
  5839. }
  5840. }
  5841. timeout_counter = millis() + 2500;
  5842. endstop_triggered = false;
  5843. manage_inactivity(true);
  5844. while (!endstop_triggered) {
  5845. if (((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ||
  5846. ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1)) {
  5847. endstop_triggered = true;
  5848. if (current_position_init - 1 <= current_position[axis] && current_position_init + 1 >= current_position[axis]) {
  5849. current_position[axis] += (axis == X_AXIS) ? 13 : 9;
  5850. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5851. st_synchronize();
  5852. return(true);
  5853. }
  5854. else {
  5855. lcd_selftest_error(8, (axis == 0) ? "X" : "Y", "");
  5856. return(false);
  5857. }
  5858. }
  5859. else {
  5860. current_position[axis] -= 1;
  5861. plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
  5862. st_synchronize();
  5863. if (millis() > timeout_counter) {
  5864. lcd_selftest_error(8, (axis == 0) ? "X" : "Y", "");
  5865. return(false);
  5866. }
  5867. }
  5868. }
  5869. return(true);
  5870. }
  5871. #endif //TMC2130
  5872. static bool lcd_selfcheck_endstops()
  5873. {
  5874. bool _result = true;
  5875. if (((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ||
  5876. ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1) ||
  5877. ((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING) == 1))
  5878. {
  5879. if ((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) current_position[0] += 10;
  5880. if ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1) current_position[1] += 10;
  5881. if ((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING) == 1) current_position[2] += 10;
  5882. }
  5883. 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);
  5884. delay(500);
  5885. if (((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) ||
  5886. ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1) ||
  5887. ((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING) == 1))
  5888. {
  5889. _result = false;
  5890. char _error[4] = "";
  5891. if ((READ(X_MIN_PIN) ^ X_MIN_ENDSTOP_INVERTING) == 1) strcat(_error, "X");
  5892. if ((READ(Y_MIN_PIN) ^ Y_MIN_ENDSTOP_INVERTING) == 1) strcat(_error, "Y");
  5893. if ((READ(Z_MIN_PIN) ^ Z_MIN_ENDSTOP_INVERTING) == 1) strcat(_error, "Z");
  5894. lcd_selftest_error(3, _error, "");
  5895. }
  5896. manage_heater();
  5897. manage_inactivity(true);
  5898. return _result;
  5899. }
  5900. //#endif //not defined TMC2130
  5901. static bool lcd_selfcheck_check_heater(bool _isbed)
  5902. {
  5903. int _counter = 0;
  5904. int _progress = 0;
  5905. bool _stepresult = false;
  5906. bool _docycle = true;
  5907. int _checked_snapshot = (_isbed) ? degBed() : degHotend(0);
  5908. int _opposite_snapshot = (_isbed) ? degHotend(0) : degBed();
  5909. int _cycles = (_isbed) ? 180 : 60; //~ 90s / 30s
  5910. target_temperature[0] = (_isbed) ? 0 : 200;
  5911. target_temperature_bed = (_isbed) ? 100 : 0;
  5912. manage_heater();
  5913. manage_inactivity(true);
  5914. KEEPALIVE_STATE(NOT_BUSY); //we are sending temperatures on serial line, so no need to send host keepalive messages
  5915. do {
  5916. _counter++;
  5917. _docycle = (_counter < _cycles) ? true : false;
  5918. manage_heater();
  5919. manage_inactivity(true);
  5920. _progress = (_isbed) ? lcd_selftest_screen(7, _progress, 2, false, 400) : lcd_selftest_screen(3, _progress, 2, false, 400);
  5921. /*if (_isbed) {
  5922. MYSERIAL.print("Bed temp:");
  5923. MYSERIAL.println(degBed());
  5924. }
  5925. else {
  5926. MYSERIAL.print("Hotend temp:");
  5927. MYSERIAL.println(degHotend(0));
  5928. }*/
  5929. if(_counter%5 == 0) serialecho_temperatures(); //show temperatures once in two seconds
  5930. } while (_docycle);
  5931. target_temperature[0] = 0;
  5932. target_temperature_bed = 0;
  5933. manage_heater();
  5934. int _checked_result = (_isbed) ? degBed() - _checked_snapshot : degHotend(0) - _checked_snapshot;
  5935. int _opposite_result = (_isbed) ? degHotend(0) - _opposite_snapshot : degBed() - _opposite_snapshot;
  5936. /*
  5937. MYSERIAL.println("");
  5938. MYSERIAL.print("Checked result:");
  5939. MYSERIAL.println(_checked_result);
  5940. MYSERIAL.print("Opposite result:");
  5941. MYSERIAL.println(_opposite_result);
  5942. */
  5943. if (_opposite_result < ((_isbed) ? 10 : 3))
  5944. {
  5945. if (_checked_result >= ((_isbed) ? 3 : 10))
  5946. {
  5947. _stepresult = true;
  5948. }
  5949. else
  5950. {
  5951. lcd_selftest_error(1, "", "");
  5952. }
  5953. }
  5954. else
  5955. {
  5956. lcd_selftest_error(2, "", "");
  5957. }
  5958. manage_heater();
  5959. manage_inactivity(true);
  5960. KEEPALIVE_STATE(IN_HANDLER);
  5961. return _stepresult;
  5962. }
  5963. static void lcd_selftest_error(int _error_no, const char *_error_1, const char *_error_2)
  5964. {
  5965. lcd_implementation_quick_feedback();
  5966. target_temperature[0] = 0;
  5967. target_temperature_bed = 0;
  5968. manage_heater();
  5969. manage_inactivity();
  5970. lcd_implementation_clear();
  5971. lcd.setCursor(0, 0);
  5972. lcd_printPGM(_i("Selftest error !"));////MSG_SELFTEST_ERROR c=0 r=0
  5973. lcd.setCursor(0, 1);
  5974. lcd_printPGM(_i("Please check :"));////MSG_SELFTEST_PLEASECHECK c=0 r=0
  5975. switch (_error_no)
  5976. {
  5977. case 1:
  5978. lcd.setCursor(0, 2);
  5979. lcd_printPGM(_i("Heater/Thermistor"));////MSG_SELFTEST_HEATERTHERMISTOR c=0 r=0
  5980. lcd.setCursor(0, 3);
  5981. lcd_printPGM(_i("Not connected"));////MSG_SELFTEST_NOTCONNECTED c=0 r=0
  5982. break;
  5983. case 2:
  5984. lcd.setCursor(0, 2);
  5985. lcd_printPGM(_i("Bed / Heater"));////MSG_SELFTEST_BEDHEATER c=0 r=0
  5986. lcd.setCursor(0, 3);
  5987. lcd_printPGM(_T(MSG_SELFTEST_WIRINGERROR));
  5988. break;
  5989. case 3:
  5990. lcd.setCursor(0, 2);
  5991. lcd_printPGM(_i("Endstops"));////MSG_SELFTEST_ENDSTOPS c=0 r=0
  5992. lcd.setCursor(0, 3);
  5993. lcd_printPGM(_T(MSG_SELFTEST_WIRINGERROR));
  5994. lcd.setCursor(17, 3);
  5995. lcd.print(_error_1);
  5996. break;
  5997. case 4:
  5998. lcd.setCursor(0, 2);
  5999. lcd_printPGM(_T(MSG_SELFTEST_MOTOR));
  6000. lcd.setCursor(18, 2);
  6001. lcd.print(_error_1);
  6002. lcd.setCursor(0, 3);
  6003. lcd_printPGM(_i("Endstop"));////MSG_SELFTEST_ENDSTOP c=0 r=0
  6004. lcd.setCursor(18, 3);
  6005. lcd.print(_error_2);
  6006. break;
  6007. case 5:
  6008. lcd.setCursor(0, 2);
  6009. lcd_printPGM(_i("Endstop not hit"));////MSG_SELFTEST_ENDSTOP_NOTHIT c=20 r=1
  6010. lcd.setCursor(0, 3);
  6011. lcd_printPGM(_T(MSG_SELFTEST_MOTOR));
  6012. lcd.setCursor(18, 3);
  6013. lcd.print(_error_1);
  6014. break;
  6015. case 6:
  6016. lcd.setCursor(0, 2);
  6017. lcd_printPGM(_T(MSG_SELFTEST_COOLING_FAN));
  6018. lcd.setCursor(0, 3);
  6019. lcd_printPGM(_T(MSG_SELFTEST_WIRINGERROR));
  6020. lcd.setCursor(18, 3);
  6021. lcd.print(_error_1);
  6022. break;
  6023. case 7:
  6024. lcd.setCursor(0, 2);
  6025. lcd_printPGM(_T(MSG_SELFTEST_EXTRUDER_FAN));
  6026. lcd.setCursor(0, 3);
  6027. lcd_printPGM(_T(MSG_SELFTEST_WIRINGERROR));
  6028. lcd.setCursor(18, 3);
  6029. lcd.print(_error_1);
  6030. break;
  6031. case 8:
  6032. lcd.setCursor(0, 2);
  6033. lcd_printPGM(_i("Loose pulley"));////MSG_LOOSE_PULLEY c=20 r=1
  6034. lcd.setCursor(0, 3);
  6035. lcd_printPGM(_T(MSG_SELFTEST_MOTOR));
  6036. lcd.setCursor(18, 3);
  6037. lcd.print(_error_1);
  6038. break;
  6039. case 9:
  6040. lcd.setCursor(0, 2);
  6041. lcd_printPGM(_i("Axis length"));////MSG_SELFTEST_AXIS_LENGTH c=0 r=0
  6042. lcd.setCursor(0, 3);
  6043. lcd_printPGM(_i("Axis"));////MSG_SELFTEST_AXIS c=0 r=0
  6044. lcd.setCursor(18, 3);
  6045. lcd.print(_error_1);
  6046. break;
  6047. case 10:
  6048. lcd.setCursor(0, 2);
  6049. lcd_printPGM(_i("Front/left fans"));////MSG_SELFTEST_FANS c=0 r=0
  6050. lcd.setCursor(0, 3);
  6051. lcd_printPGM(_i("Swapped"));////MSG_SELFTEST_SWAPPED c=0 r=0
  6052. lcd.setCursor(18, 3);
  6053. lcd.print(_error_1);
  6054. break;
  6055. case 11:
  6056. lcd.setCursor(0, 2);
  6057. lcd_printPGM(_i("Filament sensor"));////MSG_FILAMENT_SENSOR c=20 r=0
  6058. lcd.setCursor(0, 3);
  6059. lcd_printPGM(_T(MSG_SELFTEST_WIRINGERROR));
  6060. break;
  6061. }
  6062. delay(1000);
  6063. lcd_implementation_quick_feedback();
  6064. do {
  6065. delay(100);
  6066. manage_heater();
  6067. manage_inactivity();
  6068. } while (!lcd_clicked());
  6069. LCD_ALERTMESSAGERPGM(_T(MSG_SELFTEST_FAILED));
  6070. lcd_return_to_status();
  6071. }
  6072. #ifdef PAT9125
  6073. static bool lcd_selftest_fsensor() {
  6074. fsensor_init();
  6075. if (fsensor_not_responding)
  6076. {
  6077. const char *_err;
  6078. lcd_selftest_error(11, _err, _err);
  6079. }
  6080. return(!fsensor_not_responding);
  6081. }
  6082. #endif //PAT9125
  6083. static bool lcd_selftest_manual_fan_check(int _fan, bool check_opposite)
  6084. {
  6085. bool _result = check_opposite;
  6086. lcd_implementation_clear();
  6087. lcd.setCursor(0, 0); lcd_printPGM(_T(MSG_SELFTEST_FAN));
  6088. switch (_fan)
  6089. {
  6090. case 0:
  6091. // extruder cooling fan
  6092. lcd.setCursor(0, 1);
  6093. if(check_opposite == true) lcd_printPGM(_T(MSG_SELFTEST_COOLING_FAN));
  6094. else lcd_printPGM(_T(MSG_SELFTEST_EXTRUDER_FAN));
  6095. SET_OUTPUT(EXTRUDER_0_AUTO_FAN_PIN);
  6096. WRITE(EXTRUDER_0_AUTO_FAN_PIN, 1);
  6097. break;
  6098. case 1:
  6099. // object cooling fan
  6100. lcd.setCursor(0, 1);
  6101. if (check_opposite == true) lcd_printPGM(_T(MSG_SELFTEST_EXTRUDER_FAN));
  6102. else lcd_printPGM(_T(MSG_SELFTEST_COOLING_FAN));
  6103. SET_OUTPUT(FAN_PIN);
  6104. analogWrite(FAN_PIN, 255);
  6105. break;
  6106. }
  6107. delay(500);
  6108. lcd.setCursor(1, 2); lcd_printPGM(_T(MSG_SELFTEST_FAN_YES));
  6109. lcd.setCursor(0, 3); lcd.print(">");
  6110. lcd.setCursor(1, 3); lcd_printPGM(_T(MSG_SELFTEST_FAN_NO));
  6111. int8_t enc_dif = 0;
  6112. KEEPALIVE_STATE(PAUSED_FOR_USER);
  6113. button_pressed = false;
  6114. do
  6115. {
  6116. switch (_fan)
  6117. {
  6118. case 0:
  6119. // extruder cooling fan
  6120. SET_OUTPUT(EXTRUDER_0_AUTO_FAN_PIN);
  6121. WRITE(EXTRUDER_0_AUTO_FAN_PIN, 1);
  6122. break;
  6123. case 1:
  6124. // object cooling fan
  6125. SET_OUTPUT(FAN_PIN);
  6126. analogWrite(FAN_PIN, 255);
  6127. break;
  6128. }
  6129. if (abs((enc_dif - encoderDiff)) > 2) {
  6130. if (enc_dif > encoderDiff) {
  6131. _result = !check_opposite;
  6132. lcd.setCursor(0, 2); lcd.print(">");
  6133. lcd.setCursor(1, 2); lcd_printPGM(_T(MSG_SELFTEST_FAN_YES));
  6134. lcd.setCursor(0, 3); lcd.print(" ");
  6135. lcd.setCursor(1, 3); lcd_printPGM(_T(MSG_SELFTEST_FAN_NO));
  6136. }
  6137. if (enc_dif < encoderDiff) {
  6138. _result = check_opposite;
  6139. lcd.setCursor(0, 2); lcd.print(" ");
  6140. lcd.setCursor(1, 2); lcd_printPGM(_T(MSG_SELFTEST_FAN_YES));
  6141. lcd.setCursor(0, 3); lcd.print(">");
  6142. lcd.setCursor(1, 3); lcd_printPGM(_T(MSG_SELFTEST_FAN_NO));
  6143. }
  6144. enc_dif = 0;
  6145. encoderDiff = 0;
  6146. }
  6147. manage_heater();
  6148. delay(100);
  6149. } while (!lcd_clicked());
  6150. KEEPALIVE_STATE(IN_HANDLER);
  6151. SET_OUTPUT(EXTRUDER_0_AUTO_FAN_PIN);
  6152. WRITE(EXTRUDER_0_AUTO_FAN_PIN, 0);
  6153. SET_OUTPUT(FAN_PIN);
  6154. analogWrite(FAN_PIN, 0);
  6155. fanSpeed = 0;
  6156. manage_heater();
  6157. return _result;
  6158. }
  6159. static bool lcd_selftest_fan_dialog(int _fan)
  6160. {
  6161. bool _result = true;
  6162. int _errno = 7;
  6163. switch (_fan) {
  6164. case 0:
  6165. fanSpeed = 0;
  6166. manage_heater(); //turn off fan
  6167. setExtruderAutoFanState(EXTRUDER_0_AUTO_FAN_PIN, 1); //extruder fan
  6168. delay(2000); //delay_keep_alive would turn off extruder fan, because temerature is too low
  6169. manage_heater(); //count average fan speed from 2s delay and turn off fans
  6170. if (!fan_speed[0]) _result = false;
  6171. //SERIAL_ECHOPGM("Extruder fan speed: ");
  6172. //MYSERIAL.println(fan_speed[0]);
  6173. //SERIAL_ECHOPGM("Print fan speed: ");
  6174. //MYSERIAL.print(fan_speed[1]);
  6175. break;
  6176. case 1:
  6177. //will it work with Thotend > 50 C ?
  6178. fanSpeed = 150; //print fan
  6179. for (uint8_t i = 0; i < 5; i++) {
  6180. delay_keep_alive(1000);
  6181. lcd.setCursor(18, 3);
  6182. lcd.print("-");
  6183. delay_keep_alive(1000);
  6184. lcd.setCursor(18, 3);
  6185. lcd.print("|");
  6186. }
  6187. fanSpeed = 0;
  6188. manage_heater(); //turn off fan
  6189. manage_inactivity(true); //to turn off print fan
  6190. if (!fan_speed[1]) {
  6191. _result = false; _errno = 6; //print fan not spinning
  6192. }
  6193. else if (fan_speed[1] < 34) { //fan is spinning, but measured RPM are too low for print fan, it must be left extruder fan
  6194. //check fans manually
  6195. _result = lcd_selftest_manual_fan_check(1, true); //turn on print fan and check that left extruder fan is not spinning
  6196. if (_result) {
  6197. _result = lcd_selftest_manual_fan_check(1, false); //print fan is stil turned on; check that it is spinning
  6198. if (!_result) _errno = 6; //print fan not spinning
  6199. }
  6200. else {
  6201. _errno = 10; //swapped fans
  6202. }
  6203. }
  6204. //SERIAL_ECHOPGM("Extruder fan speed: ");
  6205. //MYSERIAL.println(fan_speed[0]);
  6206. //SERIAL_ECHOPGM("Print fan speed: ");
  6207. //MYSERIAL.println(fan_speed[1]);
  6208. break;
  6209. }
  6210. if (!_result)
  6211. {
  6212. const char *_err;
  6213. lcd_selftest_error(_errno, _err, _err);
  6214. }
  6215. return _result;
  6216. }
  6217. static int lcd_selftest_screen(int _step, int _progress, int _progress_scale, bool _clear, int _delay)
  6218. {
  6219. lcd_next_update_millis = millis() + (LCD_UPDATE_INTERVAL * 10000);
  6220. int _step_block = 0;
  6221. const char *_indicator = (_progress > _progress_scale) ? "-" : "|";
  6222. if (_clear) lcd_implementation_clear();
  6223. lcd.setCursor(0, 0);
  6224. if (_step == -1) lcd_printPGM(_T(MSG_SELFTEST_FAN));
  6225. if (_step == 0) lcd_printPGM(_T(MSG_SELFTEST_FAN));
  6226. if (_step == 1) lcd_printPGM(_T(MSG_SELFTEST_FAN));
  6227. if (_step == 2) lcd_printPGM(_i("Checking endstops"));////MSG_SELFTEST_CHECK_ENDSTOPS c=20 r=0
  6228. if (_step == 3) lcd_printPGM(_i("Checking hotend "));////MSG_SELFTEST_CHECK_HOTEND c=20 r=0
  6229. if (_step == 4) lcd_printPGM(_i("Checking X axis "));////MSG_SELFTEST_CHECK_X c=20 r=0
  6230. if (_step == 5) lcd_printPGM(_i("Checking Y axis "));////MSG_SELFTEST_CHECK_Y c=20 r=0
  6231. if (_step == 6) lcd_printPGM(_i("Checking Z axis "));////MSG_SELFTEST_CHECK_Z c=20 r=0
  6232. if (_step == 7) lcd_printPGM(_T(MSG_SELFTEST_CHECK_BED));
  6233. if (_step == 8) lcd_printPGM(_T(MSG_SELFTEST_CHECK_BED));
  6234. if (_step == 9) lcd_printPGM(_T(MSG_SELFTEST_CHECK_FSENSOR));
  6235. if (_step == 10) lcd_printPGM(_T(MSG_SELFTEST_CHECK_FSENSOR));
  6236. if (_step == 11) lcd_printPGM(_i("All correct "));////MSG_SELFTEST_CHECK_ALLCORRECT c=20 r=0
  6237. if (_step == 12) lcd_printPGM(_T(MSG_SELFTEST_FAILED));
  6238. if (_step == 13) lcd_printPGM(PSTR("Calibrating home"));
  6239. lcd.setCursor(0, 1);
  6240. lcd_printPGM(separator);
  6241. if ((_step >= -1) && (_step <= 1))
  6242. {
  6243. //SERIAL_ECHOLNPGM("Fan test");
  6244. lcd_print_at_PGM(0, 2, _i("Extruder fan:"));////MSG_SELFTEST_EXTRUDER_FAN_SPEED c=18 r=0
  6245. lcd.setCursor(18, 2);
  6246. (_step < 0) ? lcd.print(_indicator) : lcd.print("OK");
  6247. lcd_print_at_PGM(0, 3, _i("Print fan:"));////MSG_SELFTEST_PRINT_FAN_SPEED c=18 r=0
  6248. lcd.setCursor(18, 3);
  6249. (_step < 1) ? lcd.print(_indicator) : lcd.print("OK");
  6250. }
  6251. else if (_step >= 9 && _step <= 10)
  6252. {
  6253. lcd_print_at_PGM(0, 2, _i("Filament sensor:"));////MSG_SELFTEST_FILAMENT_SENSOR c=18 r=0
  6254. lcd.setCursor(18, 2);
  6255. (_step == 9) ? lcd.print(_indicator) : lcd.print("OK");
  6256. }
  6257. else if (_step < 9)
  6258. {
  6259. //SERIAL_ECHOLNPGM("Other tests");
  6260. _step_block = 3;
  6261. lcd_selftest_screen_step(3, 9, ((_step == _step_block) ? 1 : (_step < _step_block) ? 0 : 2), "Hotend", _indicator);
  6262. _step_block = 4;
  6263. lcd_selftest_screen_step(2, 2, ((_step == _step_block) ? 1 : (_step < _step_block) ? 0 : 2), "X", _indicator);
  6264. _step_block = 5;
  6265. lcd_selftest_screen_step(2, 8, ((_step == _step_block) ? 1 : (_step < _step_block) ? 0 : 2), "Y", _indicator);
  6266. _step_block = 6;
  6267. lcd_selftest_screen_step(2, 14, ((_step == _step_block) ? 1 : (_step < _step_block) ? 0 : 2), "Z", _indicator);
  6268. _step_block = 7;
  6269. lcd_selftest_screen_step(3, 0, ((_step == _step_block) ? 1 : (_step < _step_block) ? 0 : 2), "Bed", _indicator);
  6270. }
  6271. if (_delay > 0) delay_keep_alive(_delay);
  6272. _progress++;
  6273. return (_progress > _progress_scale * 2) ? 0 : _progress;
  6274. }
  6275. static void lcd_selftest_screen_step(int _row, int _col, int _state, const char *_name, const char *_indicator)
  6276. {
  6277. lcd.setCursor(_col, _row);
  6278. switch (_state)
  6279. {
  6280. case 1:
  6281. lcd.print(_name);
  6282. lcd.setCursor(_col + strlen(_name), _row);
  6283. lcd.print(":");
  6284. lcd.setCursor(_col + strlen(_name) + 1, _row);
  6285. lcd.print(_indicator);
  6286. break;
  6287. case 2:
  6288. lcd.print(_name);
  6289. lcd.setCursor(_col + strlen(_name), _row);
  6290. lcd.print(":");
  6291. lcd.setCursor(_col + strlen(_name) + 1, _row);
  6292. lcd.print("OK");
  6293. break;
  6294. default:
  6295. lcd.print(_name);
  6296. }
  6297. }
  6298. /** End of menus **/
  6299. static void lcd_quick_feedback()
  6300. {
  6301. lcdDrawUpdate = 2;
  6302. button_pressed = false;
  6303. lcd_implementation_quick_feedback();
  6304. }
  6305. /** Menu action functions **/
  6306. /**
  6307. * @brief Go up in menu structure
  6308. * @param data one time action to be done before leaving menu e.g. saving data or 0
  6309. */
  6310. static void menu_action_back(menuFunc_t data)
  6311. {
  6312. if (data) data();
  6313. MenuStack::Record record = menuStack.pop();
  6314. lcd_goto_menu(record.menu);
  6315. encoderPosition = record.position;
  6316. }
  6317. /**
  6318. * @brief Go deeper into menu structure
  6319. * @param data nested menu
  6320. */
  6321. static void menu_action_submenu(menuFunc_t data) {
  6322. menuStack.push(currentMenu, encoderPosition);
  6323. lcd_goto_menu(data);
  6324. }
  6325. static void menu_action_gcode(const char* pgcode) {
  6326. enquecommand_P(pgcode);
  6327. }
  6328. static void menu_action_setlang(unsigned char lang)
  6329. {
  6330. if (lang <= LANG_ID_SEC)
  6331. {
  6332. lcd_set_lang(lang);
  6333. return;
  6334. }
  6335. uint16_t code = lang_get_code(lang);
  6336. if (code == lang_get_code(1)) lcd_set_lang(1);
  6337. lcd_set_lang(lang);
  6338. }
  6339. static void menu_action_function(menuFunc_t data) {
  6340. (*data)();
  6341. }
  6342. static bool check_file(const char* filename) {
  6343. if (farm_mode) return true;
  6344. bool result = false;
  6345. uint32_t filesize;
  6346. card.openFile((char*)filename, true);
  6347. filesize = card.getFileSize();
  6348. if (filesize > END_FILE_SECTION) {
  6349. card.setIndex(filesize - END_FILE_SECTION);
  6350. }
  6351. while (!card.eof() && !result) {
  6352. card.sdprinting = true;
  6353. get_command();
  6354. result = check_commands();
  6355. }
  6356. card.printingHasFinished();
  6357. strncpy_P(lcd_status_message, _T(WELCOME_MSG), LCD_WIDTH);
  6358. lcd_finishstatus();
  6359. return result;
  6360. }
  6361. static void menu_action_sdfile(const char* filename, char* longFilename)
  6362. {
  6363. loading_flag = false;
  6364. char cmd[30];
  6365. char* c;
  6366. bool result = true;
  6367. sprintf_P(cmd, PSTR("M23 %s"), filename);
  6368. for (c = &cmd[4]; *c; c++)
  6369. *c = tolower(*c);
  6370. for (int i = 0; i < 8; i++) {
  6371. eeprom_write_byte((uint8_t*)EEPROM_FILENAME + i, filename[i]);
  6372. }
  6373. uint8_t depth = (uint8_t)card.getWorkDirDepth();
  6374. eeprom_write_byte((uint8_t*)EEPROM_DIR_DEPTH, depth);
  6375. for (uint8_t i = 0; i < depth; i++) {
  6376. for (int j = 0; j < 8; j++) {
  6377. eeprom_write_byte((uint8_t*)EEPROM_DIRS + j + 8 * i, dir_names[i][j]);
  6378. }
  6379. }
  6380. if (!check_file(filename)) {
  6381. result = lcd_show_fullscreen_message_yes_no_and_wait_P(_i("File incomplete. Continue anyway?"), false, false);////MSG_FILE_INCOMPLETE c=20 r=2
  6382. lcd_update_enable(true);
  6383. }
  6384. if (result) {
  6385. enquecommand(cmd);
  6386. enquecommand_P(PSTR("M24"));
  6387. }
  6388. lcd_return_to_status();
  6389. }
  6390. static void menu_action_sddirectory(const char* filename, char* longFilename)
  6391. {
  6392. uint8_t depth = (uint8_t)card.getWorkDirDepth();
  6393. strcpy(dir_names[depth], filename);
  6394. MYSERIAL.println(dir_names[depth]);
  6395. card.chdir(filename);
  6396. encoderPosition = 0;
  6397. }
  6398. static void menu_action_setting_edit_bool(const char* pstr, bool* ptr)
  6399. {
  6400. *ptr = !(*ptr);
  6401. }
  6402. /*
  6403. static void menu_action_setting_edit_callback_bool(const char* pstr, bool* ptr, menuFunc_t callback)
  6404. {
  6405. menu_action_setting_edit_bool(pstr, ptr);
  6406. (*callback)();
  6407. }
  6408. */
  6409. #endif//ULTIPANEL
  6410. /** LCD API **/
  6411. void lcd_init()
  6412. {
  6413. lcd_implementation_init();
  6414. #ifdef NEWPANEL
  6415. SET_INPUT(BTN_EN1);
  6416. SET_INPUT(BTN_EN2);
  6417. WRITE(BTN_EN1, HIGH);
  6418. WRITE(BTN_EN2, HIGH);
  6419. #if BTN_ENC > 0
  6420. SET_INPUT(BTN_ENC);
  6421. WRITE(BTN_ENC, HIGH);
  6422. #endif
  6423. #ifdef REPRAPWORLD_KEYPAD
  6424. pinMode(SHIFT_CLK, OUTPUT);
  6425. pinMode(SHIFT_LD, OUTPUT);
  6426. pinMode(SHIFT_OUT, INPUT);
  6427. WRITE(SHIFT_OUT, HIGH);
  6428. WRITE(SHIFT_LD, HIGH);
  6429. #endif
  6430. #else // Not NEWPANEL
  6431. #ifdef SR_LCD_2W_NL // Non latching 2 wire shift register
  6432. pinMode (SR_DATA_PIN, OUTPUT);
  6433. pinMode (SR_CLK_PIN, OUTPUT);
  6434. #elif defined(SHIFT_CLK)
  6435. pinMode(SHIFT_CLK, OUTPUT);
  6436. pinMode(SHIFT_LD, OUTPUT);
  6437. pinMode(SHIFT_EN, OUTPUT);
  6438. pinMode(SHIFT_OUT, INPUT);
  6439. WRITE(SHIFT_OUT, HIGH);
  6440. WRITE(SHIFT_LD, HIGH);
  6441. WRITE(SHIFT_EN, LOW);
  6442. #else
  6443. #ifdef ULTIPANEL
  6444. #error ULTIPANEL requires an encoder
  6445. #endif
  6446. #endif // SR_LCD_2W_NL
  6447. #endif//!NEWPANEL
  6448. #if defined (SDSUPPORT) && defined(SDCARDDETECT) && (SDCARDDETECT > 0)
  6449. pinMode(SDCARDDETECT, INPUT);
  6450. WRITE(SDCARDDETECT, HIGH);
  6451. lcd_oldcardstatus = IS_SD_INSERTED;
  6452. #endif//(SDCARDDETECT > 0)
  6453. #ifdef LCD_HAS_SLOW_BUTTONS
  6454. slow_buttons = 0;
  6455. #endif
  6456. lcd_buttons_update();
  6457. #ifdef ULTIPANEL
  6458. encoderDiff = 0;
  6459. #endif
  6460. }
  6461. //#include <avr/pgmspace.h>
  6462. static volatile bool lcd_update_enabled = true;
  6463. unsigned long lcd_timeoutToStatus = 0;
  6464. void lcd_update_enable(bool enabled)
  6465. {
  6466. if (lcd_update_enabled != enabled) {
  6467. lcd_update_enabled = enabled;
  6468. if (enabled) {
  6469. // Reset encoder position. This is equivalent to re-entering a menu.
  6470. encoderPosition = 0;
  6471. encoderDiff = 0;
  6472. // Enabling the normal LCD update procedure.
  6473. // Reset the timeout interval.
  6474. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  6475. // Force the keypad update now.
  6476. lcd_next_update_millis = millis() - 1;
  6477. // Full update.
  6478. lcd_implementation_clear();
  6479. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT)
  6480. lcd_set_custom_characters(currentMenu == lcd_status_screen);
  6481. #else
  6482. if (currentMenu == lcd_status_screen)
  6483. lcd_set_custom_characters_degree();
  6484. else
  6485. lcd_set_custom_characters_arrows();
  6486. #endif
  6487. lcd_update(2);
  6488. } else {
  6489. // Clear the LCD always, or let it to the caller?
  6490. }
  6491. }
  6492. }
  6493. void lcd_update(uint8_t lcdDrawUpdateOverride)
  6494. {
  6495. if (lcdDrawUpdate < lcdDrawUpdateOverride)
  6496. lcdDrawUpdate = lcdDrawUpdateOverride;
  6497. if (!lcd_update_enabled)
  6498. return;
  6499. #ifdef LCD_HAS_SLOW_BUTTONS
  6500. slow_buttons = lcd_implementation_read_slow_buttons(); // buttons which take too long to read in interrupt context
  6501. #endif
  6502. lcd_buttons_update();
  6503. #if (SDCARDDETECT > 0)
  6504. if ((IS_SD_INSERTED != lcd_oldcardstatus && lcd_detected()))
  6505. {
  6506. lcdDrawUpdate = 2;
  6507. lcd_oldcardstatus = IS_SD_INSERTED;
  6508. lcd_implementation_init( // to maybe revive the LCD if static electricity killed it.
  6509. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT)
  6510. currentMenu == lcd_status_screen
  6511. #endif
  6512. );
  6513. if (lcd_oldcardstatus)
  6514. {
  6515. card.initsd();
  6516. LCD_MESSAGERPGM(_i("Card inserted"));////MSG_SD_INSERTED c=0 r=0
  6517. //get_description();
  6518. }
  6519. else
  6520. {
  6521. card.release();
  6522. LCD_MESSAGERPGM(_i("Card removed"));////MSG_SD_REMOVED c=0 r=0
  6523. }
  6524. }
  6525. #endif//CARDINSERTED
  6526. if (lcd_next_update_millis < millis())
  6527. {
  6528. #ifdef DEBUG_BLINK_ACTIVE
  6529. static bool active_led = false;
  6530. active_led = !active_led;
  6531. pinMode(LED_PIN, OUTPUT);
  6532. digitalWrite(LED_PIN, active_led?HIGH:LOW);
  6533. #endif //DEBUG_BLINK_ACTIVE
  6534. #ifdef ULTIPANEL
  6535. #ifdef REPRAPWORLD_KEYPAD
  6536. if (REPRAPWORLD_KEYPAD_MOVE_Z_UP) {
  6537. reprapworld_keypad_move_z_up();
  6538. }
  6539. if (REPRAPWORLD_KEYPAD_MOVE_Z_DOWN) {
  6540. reprapworld_keypad_move_z_down();
  6541. }
  6542. if (REPRAPWORLD_KEYPAD_MOVE_X_LEFT) {
  6543. reprapworld_keypad_move_x_left();
  6544. }
  6545. if (REPRAPWORLD_KEYPAD_MOVE_X_RIGHT) {
  6546. reprapworld_keypad_move_x_right();
  6547. }
  6548. if (REPRAPWORLD_KEYPAD_MOVE_Y_DOWN) {
  6549. reprapworld_keypad_move_y_down();
  6550. }
  6551. if (REPRAPWORLD_KEYPAD_MOVE_Y_UP) {
  6552. reprapworld_keypad_move_y_up();
  6553. }
  6554. if (REPRAPWORLD_KEYPAD_MOVE_HOME) {
  6555. reprapworld_keypad_move_home();
  6556. }
  6557. #endif
  6558. if (abs(encoderDiff) >= ENCODER_PULSES_PER_STEP)
  6559. {
  6560. if (lcdDrawUpdate == 0)
  6561. lcdDrawUpdate = 1;
  6562. encoderPosition += encoderDiff / ENCODER_PULSES_PER_STEP;
  6563. encoderDiff = 0;
  6564. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  6565. }
  6566. if (LCD_CLICKED) lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  6567. #endif//ULTIPANEL
  6568. (*currentMenu)();
  6569. #ifdef LCD_HAS_STATUS_INDICATORS
  6570. lcd_implementation_update_indicators();
  6571. #endif
  6572. #ifdef ULTIPANEL
  6573. if (lcd_timeoutToStatus < millis() && currentMenu != lcd_status_screen)
  6574. {
  6575. // Exiting a menu. Let's call the menu function the last time with menuExiting flag set to true
  6576. // to give it a chance to save its state.
  6577. // This is useful for example, when the babystep value has to be written into EEPROM.
  6578. if (currentMenu != NULL) {
  6579. menuExiting = true;
  6580. (*currentMenu)();
  6581. menuExiting = false;
  6582. }
  6583. lcd_implementation_clear();
  6584. lcd_return_to_status();
  6585. lcdDrawUpdate = 2;
  6586. }
  6587. #endif//ULTIPANEL
  6588. if (lcdDrawUpdate == 2) lcd_implementation_clear();
  6589. if (lcdDrawUpdate) lcdDrawUpdate--;
  6590. lcd_next_update_millis = millis() + LCD_UPDATE_INTERVAL;
  6591. }
  6592. if (!SdFatUtil::test_stack_integrity()) stack_error();
  6593. #ifdef DEBUG_STEPPER_TIMER_MISSED
  6594. if (stepper_timer_overflow_state) stepper_timer_overflow();
  6595. #endif /* DEBUG_STEPPER_TIMER_MISSED */
  6596. lcd_ping(); //check that we have received ping command if we are in farm mode
  6597. lcd_send_status();
  6598. if (lcd_commands_type == LCD_COMMAND_V2_CAL) lcd_commands();
  6599. }
  6600. void lcd_printer_connected() {
  6601. printer_connected = true;
  6602. }
  6603. static void lcd_send_status() {
  6604. if (farm_mode && no_response && ((millis() - NcTime) > (NC_TIME * 1000))) {
  6605. //send important status messages periodicaly
  6606. prusa_statistics(important_status, saved_filament_type);
  6607. NcTime = millis();
  6608. lcd_connect_printer();
  6609. }
  6610. }
  6611. static void lcd_connect_printer() {
  6612. lcd_update_enable(false);
  6613. lcd_implementation_clear();
  6614. bool pressed = false;
  6615. int i = 0;
  6616. int t = 0;
  6617. lcd_set_custom_characters_progress();
  6618. lcd_implementation_print_at(0, 0, "Connect printer to");
  6619. lcd_implementation_print_at(0, 1, "monitoring or hold");
  6620. lcd_implementation_print_at(0, 2, "the knob to continue");
  6621. while (no_response) {
  6622. i++;
  6623. t++;
  6624. delay_keep_alive(100);
  6625. proc_commands();
  6626. if (t == 10) {
  6627. prusa_statistics(important_status, saved_filament_type);
  6628. t = 0;
  6629. }
  6630. if (READ(BTN_ENC)) { //if button is not pressed
  6631. i = 0;
  6632. lcd_implementation_print_at(0, 3, " ");
  6633. }
  6634. if (i!=0) lcd_implementation_print_at((i * 20) / (NC_BUTTON_LONG_PRESS * 10), 3, "\x01");
  6635. if (i == NC_BUTTON_LONG_PRESS * 10) {
  6636. no_response = false;
  6637. }
  6638. }
  6639. lcd_set_custom_characters_degree();
  6640. lcd_update_enable(true);
  6641. lcd_update(2);
  6642. }
  6643. void lcd_ping() { //chceck if printer is connected to monitoring when in farm mode
  6644. if (farm_mode) {
  6645. bool empty = is_buffer_empty();
  6646. if ((millis() - PingTime) * 0.001 > (empty ? PING_TIME : PING_TIME_LONG)) { //if commands buffer is empty use shorter time period
  6647. //if there are comamnds in buffer, some long gcodes can delay execution of ping command
  6648. //therefore longer period is used
  6649. printer_connected = false;
  6650. //lcd_ping_allert(); //acustic signals
  6651. }
  6652. else {
  6653. lcd_printer_connected();
  6654. }
  6655. }
  6656. }
  6657. void lcd_ignore_click(bool b)
  6658. {
  6659. ignore_click = b;
  6660. wait_for_unclick = false;
  6661. }
  6662. void lcd_finishstatus() {
  6663. int len = strlen(lcd_status_message);
  6664. if (len > 0) {
  6665. while (len < LCD_WIDTH) {
  6666. lcd_status_message[len++] = ' ';
  6667. }
  6668. }
  6669. lcd_status_message[LCD_WIDTH] = '\0';
  6670. #if defined(LCD_PROGRESS_BAR) && defined(SDSUPPORT)
  6671. #if PROGRESS_MSG_EXPIRE > 0
  6672. messageTick =
  6673. #endif
  6674. progressBarTick = millis();
  6675. #endif
  6676. lcdDrawUpdate = 2;
  6677. #ifdef FILAMENT_LCD_DISPLAY
  6678. message_millis = millis(); //get status message to show up for a while
  6679. #endif
  6680. }
  6681. void lcd_setstatus(const char* message)
  6682. {
  6683. if (lcd_status_message_level > 0)
  6684. return;
  6685. strncpy(lcd_status_message, message, LCD_WIDTH);
  6686. lcd_finishstatus();
  6687. }
  6688. void lcd_setstatuspgm(const char* message)
  6689. {
  6690. if (lcd_status_message_level > 0)
  6691. return;
  6692. strncpy_P(lcd_status_message, message, LCD_WIDTH);
  6693. lcd_status_message[LCD_WIDTH] = 0;
  6694. lcd_finishstatus();
  6695. }
  6696. void lcd_setalertstatuspgm(const char* message)
  6697. {
  6698. lcd_setstatuspgm(message);
  6699. lcd_status_message_level = 1;
  6700. #ifdef ULTIPANEL
  6701. lcd_return_to_status();
  6702. #endif//ULTIPANEL
  6703. }
  6704. void lcd_reset_alert_level()
  6705. {
  6706. lcd_status_message_level = 0;
  6707. }
  6708. uint8_t get_message_level()
  6709. {
  6710. return lcd_status_message_level;
  6711. }
  6712. #ifdef DOGLCD
  6713. void lcd_setcontrast(uint8_t value)
  6714. {
  6715. lcd_contrast = value & 63;
  6716. u8g.setContrast(lcd_contrast);
  6717. }
  6718. #endif
  6719. #ifdef ULTIPANEL
  6720. /* Warning: This function is called from interrupt context */
  6721. void lcd_buttons_update()
  6722. {
  6723. static bool _lock = false;
  6724. if (_lock) return;
  6725. _lock = true;
  6726. #ifdef NEWPANEL
  6727. uint8_t newbutton = 0;
  6728. if (READ(BTN_EN1) == 0) newbutton |= EN_A;
  6729. if (READ(BTN_EN2) == 0) newbutton |= EN_B;
  6730. #if BTN_ENC > 0
  6731. if (lcd_update_enabled == true) { //if we are in non-modal mode, long press can be used and short press triggers with button release
  6732. if (READ(BTN_ENC) == 0) { //button is pressed
  6733. lcd_timeoutToStatus = millis() + LCD_TIMEOUT_TO_STATUS;
  6734. if (millis() > button_blanking_time) {
  6735. button_blanking_time = millis() + BUTTON_BLANKING_TIME;
  6736. if (button_pressed == false && long_press_active == false) {
  6737. long_press_timer = millis();
  6738. button_pressed = true;
  6739. }
  6740. else {
  6741. if (millis() - long_press_timer > LONG_PRESS_TIME) { //long press activated
  6742. long_press_active = true;
  6743. move_menu_scale = 1.0;
  6744. menu_action_submenu(lcd_move_z);
  6745. }
  6746. }
  6747. }
  6748. }
  6749. else { //button not pressed
  6750. if (button_pressed) { //button was released
  6751. button_blanking_time = millis() + BUTTON_BLANKING_TIME;
  6752. if (long_press_active == false) { //button released before long press gets activated
  6753. newbutton |= EN_C;
  6754. }
  6755. else if (currentMenu == lcd_move_z) lcd_quick_feedback();
  6756. //button_pressed is set back to false via lcd_quick_feedback function
  6757. }
  6758. else {
  6759. long_press_active = false;
  6760. }
  6761. }
  6762. }
  6763. else { //we are in modal mode
  6764. if (READ(BTN_ENC) == 0)
  6765. newbutton |= EN_C;
  6766. }
  6767. #endif
  6768. buttons = newbutton;
  6769. #ifdef LCD_HAS_SLOW_BUTTONS
  6770. buttons |= slow_buttons;
  6771. #endif
  6772. #ifdef REPRAPWORLD_KEYPAD
  6773. // for the reprapworld_keypad
  6774. uint8_t newbutton_reprapworld_keypad = 0;
  6775. WRITE(SHIFT_LD, LOW);
  6776. WRITE(SHIFT_LD, HIGH);
  6777. for (int8_t i = 0; i < 8; i++) {
  6778. newbutton_reprapworld_keypad = newbutton_reprapworld_keypad >> 1;
  6779. if (READ(SHIFT_OUT))
  6780. newbutton_reprapworld_keypad |= (1 << 7);
  6781. WRITE(SHIFT_CLK, HIGH);
  6782. WRITE(SHIFT_CLK, LOW);
  6783. }
  6784. buttons_reprapworld_keypad = ~newbutton_reprapworld_keypad; //invert it, because a pressed switch produces a logical 0
  6785. #endif
  6786. #else //read it from the shift register
  6787. uint8_t newbutton = 0;
  6788. WRITE(SHIFT_LD, LOW);
  6789. WRITE(SHIFT_LD, HIGH);
  6790. unsigned char tmp_buttons = 0;
  6791. for (int8_t i = 0; i < 8; i++)
  6792. {
  6793. newbutton = newbutton >> 1;
  6794. if (READ(SHIFT_OUT))
  6795. newbutton |= (1 << 7);
  6796. WRITE(SHIFT_CLK, HIGH);
  6797. WRITE(SHIFT_CLK, LOW);
  6798. }
  6799. buttons = ~newbutton; //invert it, because a pressed switch produces a logical 0
  6800. #endif//!NEWPANEL
  6801. //manage encoder rotation
  6802. uint8_t enc = 0;
  6803. if (buttons & EN_A) enc |= B01;
  6804. if (buttons & EN_B) enc |= B10;
  6805. if (enc != lastEncoderBits)
  6806. {
  6807. switch (enc)
  6808. {
  6809. case encrot0:
  6810. if (lastEncoderBits == encrot3)
  6811. encoderDiff++;
  6812. else if (lastEncoderBits == encrot1)
  6813. encoderDiff--;
  6814. break;
  6815. case encrot1:
  6816. if (lastEncoderBits == encrot0)
  6817. encoderDiff++;
  6818. else if (lastEncoderBits == encrot2)
  6819. encoderDiff--;
  6820. break;
  6821. case encrot2:
  6822. if (lastEncoderBits == encrot1)
  6823. encoderDiff++;
  6824. else if (lastEncoderBits == encrot3)
  6825. encoderDiff--;
  6826. break;
  6827. case encrot3:
  6828. if (lastEncoderBits == encrot2)
  6829. encoderDiff++;
  6830. else if (lastEncoderBits == encrot0)
  6831. encoderDiff--;
  6832. break;
  6833. }
  6834. }
  6835. lastEncoderBits = enc;
  6836. _lock = false;
  6837. }
  6838. bool lcd_detected(void)
  6839. {
  6840. #if (defined(LCD_I2C_TYPE_MCP23017) || defined(LCD_I2C_TYPE_MCP23008)) && defined(DETECT_DEVICE)
  6841. return lcd.LcdDetected() == 1;
  6842. #else
  6843. return true;
  6844. #endif
  6845. }
  6846. void lcd_buzz(long duration, uint16_t freq)
  6847. {
  6848. #ifdef LCD_USE_I2C_BUZZER
  6849. lcd.buzz(duration, freq);
  6850. #endif
  6851. }
  6852. bool lcd_clicked()
  6853. {
  6854. bool clicked = LCD_CLICKED;
  6855. if(clicked) button_pressed = false;
  6856. return clicked;
  6857. }
  6858. #endif//ULTIPANEL
  6859. /********************************/
  6860. /** Float conversion utilities **/
  6861. /********************************/
  6862. // convert float to string with +123.4 format
  6863. char conv[8];
  6864. char *ftostr3(const float &x)
  6865. {
  6866. return itostr3((int)x);
  6867. }
  6868. char *itostr2(const uint8_t &x)
  6869. {
  6870. //sprintf(conv,"%5.1f",x);
  6871. int xx = x;
  6872. conv[0] = (xx / 10) % 10 + '0';
  6873. conv[1] = (xx) % 10 + '0';
  6874. conv[2] = 0;
  6875. return conv;
  6876. }
  6877. // Convert float to string with 123.4 format, dropping sign
  6878. char *ftostr31(const float &x)
  6879. {
  6880. int xx = x * 10;
  6881. conv[0] = (xx >= 0) ? '+' : '-';
  6882. xx = abs(xx);
  6883. conv[1] = (xx / 1000) % 10 + '0';
  6884. conv[2] = (xx / 100) % 10 + '0';
  6885. conv[3] = (xx / 10) % 10 + '0';
  6886. conv[4] = '.';
  6887. conv[5] = (xx) % 10 + '0';
  6888. conv[6] = 0;
  6889. return conv;
  6890. }
  6891. // Convert float to string with 123.4 format
  6892. char *ftostr31ns(const float &x)
  6893. {
  6894. int xx = x * 10;
  6895. //conv[0]=(xx>=0)?'+':'-';
  6896. xx = abs(xx);
  6897. conv[0] = (xx / 1000) % 10 + '0';
  6898. conv[1] = (xx / 100) % 10 + '0';
  6899. conv[2] = (xx / 10) % 10 + '0';
  6900. conv[3] = '.';
  6901. conv[4] = (xx) % 10 + '0';
  6902. conv[5] = 0;
  6903. return conv;
  6904. }
  6905. char *ftostr32(const float &x)
  6906. {
  6907. long xx = x * 100;
  6908. if (xx >= 0)
  6909. conv[0] = (xx / 10000) % 10 + '0';
  6910. else
  6911. conv[0] = '-';
  6912. xx = abs(xx);
  6913. conv[1] = (xx / 1000) % 10 + '0';
  6914. conv[2] = (xx / 100) % 10 + '0';
  6915. conv[3] = '.';
  6916. conv[4] = (xx / 10) % 10 + '0';
  6917. conv[5] = (xx) % 10 + '0';
  6918. conv[6] = 0;
  6919. return conv;
  6920. }
  6921. //// Convert float to rj string with 123.45 format
  6922. char *ftostr32ns(const float &x) {
  6923. long xx = abs(x);
  6924. conv[0] = xx >= 10000 ? (xx / 10000) % 10 + '0' : ' ';
  6925. conv[1] = xx >= 1000 ? (xx / 1000) % 10 + '0' : ' ';
  6926. conv[2] = xx >= 100 ? (xx / 100) % 10 + '0' : '0';
  6927. conv[3] = '.';
  6928. conv[4] = (xx / 10) % 10 + '0';
  6929. conv[5] = xx % 10 + '0';
  6930. return conv;
  6931. }
  6932. // Convert float to string with 1.234 format
  6933. char *ftostr43(const float &x, uint8_t offset)
  6934. {
  6935. const size_t maxOffset = sizeof(conv)/sizeof(conv[0]) - 6;
  6936. if (offset>maxOffset) offset = maxOffset;
  6937. long xx = x * 1000;
  6938. if (xx >= 0)
  6939. conv[offset] = (xx / 1000) % 10 + '0';
  6940. else
  6941. conv[offset] = '-';
  6942. xx = abs(xx);
  6943. conv[offset + 1] = '.';
  6944. conv[offset + 2] = (xx / 100) % 10 + '0';
  6945. conv[offset + 3] = (xx / 10) % 10 + '0';
  6946. conv[offset + 4] = (xx) % 10 + '0';
  6947. conv[offset + 5] = 0;
  6948. return conv;
  6949. }
  6950. //Float to string with 1.23 format
  6951. char *ftostr12ns(const float &x)
  6952. {
  6953. long xx = x * 100;
  6954. xx = abs(xx);
  6955. conv[0] = (xx / 100) % 10 + '0';
  6956. conv[1] = '.';
  6957. conv[2] = (xx / 10) % 10 + '0';
  6958. conv[3] = (xx) % 10 + '0';
  6959. conv[4] = 0;
  6960. return conv;
  6961. }
  6962. //Float to string with 1.234 format
  6963. char *ftostr13ns(const float &x)
  6964. {
  6965. long xx = x * 1000;
  6966. if (xx >= 0)
  6967. conv[0] = ' ';
  6968. else
  6969. conv[0] = '-';
  6970. xx = abs(xx);
  6971. conv[1] = (xx / 1000) % 10 + '0';
  6972. conv[2] = '.';
  6973. conv[3] = (xx / 100) % 10 + '0';
  6974. conv[4] = (xx / 10) % 10 + '0';
  6975. conv[5] = (xx) % 10 + '0';
  6976. conv[6] = 0;
  6977. return conv;
  6978. }
  6979. // convert float to space-padded string with -_23.4_ format
  6980. char *ftostr32sp(const float &x) {
  6981. long xx = abs(x * 100);
  6982. uint8_t dig;
  6983. if (x < 0) { // negative val = -_0
  6984. conv[0] = '-';
  6985. dig = (xx / 1000) % 10;
  6986. conv[1] = dig ? '0' + dig : ' ';
  6987. }
  6988. else { // positive val = __0
  6989. dig = (xx / 10000) % 10;
  6990. if (dig) {
  6991. conv[0] = '0' + dig;
  6992. conv[1] = '0' + (xx / 1000) % 10;
  6993. }
  6994. else {
  6995. conv[0] = ' ';
  6996. dig = (xx / 1000) % 10;
  6997. conv[1] = dig ? '0' + dig : ' ';
  6998. }
  6999. }
  7000. conv[2] = '0' + (xx / 100) % 10; // lsd always
  7001. dig = xx % 10;
  7002. if (dig) { // 2 decimal places
  7003. conv[5] = '0' + dig;
  7004. conv[4] = '0' + (xx / 10) % 10;
  7005. conv[3] = '.';
  7006. }
  7007. else { // 1 or 0 decimal place
  7008. dig = (xx / 10) % 10;
  7009. if (dig) {
  7010. conv[4] = '0' + dig;
  7011. conv[3] = '.';
  7012. }
  7013. else {
  7014. conv[3] = conv[4] = ' ';
  7015. }
  7016. conv[5] = ' ';
  7017. }
  7018. conv[6] = '\0';
  7019. return conv;
  7020. }
  7021. char *itostr31(const int &xx)
  7022. {
  7023. conv[0] = (xx >= 0) ? '+' : '-';
  7024. conv[1] = (xx / 1000) % 10 + '0';
  7025. conv[2] = (xx / 100) % 10 + '0';
  7026. conv[3] = (xx / 10) % 10 + '0';
  7027. conv[4] = '.';
  7028. conv[5] = (xx) % 10 + '0';
  7029. conv[6] = 0;
  7030. return conv;
  7031. }
  7032. // Convert int to rj string with 123 or -12 format
  7033. char *itostr3(const int &x)
  7034. {
  7035. int xx = x;
  7036. if (xx < 0) {
  7037. conv[0] = '-';
  7038. xx = -xx;
  7039. } else if (xx >= 100)
  7040. conv[0] = (xx / 100) % 10 + '0';
  7041. else
  7042. conv[0] = ' ';
  7043. if (xx >= 10)
  7044. conv[1] = (xx / 10) % 10 + '0';
  7045. else
  7046. conv[1] = ' ';
  7047. conv[2] = (xx) % 10 + '0';
  7048. conv[3] = 0;
  7049. return conv;
  7050. }
  7051. // Convert int to lj string with 123 format
  7052. char *itostr3left(const int &xx)
  7053. {
  7054. if (xx >= 100)
  7055. {
  7056. conv[0] = (xx / 100) % 10 + '0';
  7057. conv[1] = (xx / 10) % 10 + '0';
  7058. conv[2] = (xx) % 10 + '0';
  7059. conv[3] = 0;
  7060. }
  7061. else if (xx >= 10)
  7062. {
  7063. conv[0] = (xx / 10) % 10 + '0';
  7064. conv[1] = (xx) % 10 + '0';
  7065. conv[2] = 0;
  7066. }
  7067. else
  7068. {
  7069. conv[0] = (xx) % 10 + '0';
  7070. conv[1] = 0;
  7071. }
  7072. return conv;
  7073. }
  7074. // Convert int to rj string with 1234 format
  7075. char *itostr4(const int &xx) {
  7076. conv[0] = xx >= 1000 ? (xx / 1000) % 10 + '0' : ' ';
  7077. conv[1] = xx >= 100 ? (xx / 100) % 10 + '0' : ' ';
  7078. conv[2] = xx >= 10 ? (xx / 10) % 10 + '0' : ' ';
  7079. conv[3] = xx % 10 + '0';
  7080. conv[4] = 0;
  7081. return conv;
  7082. }
  7083. // Convert float to rj string with 12345 format
  7084. char *ftostr5(const float &x) {
  7085. long xx = abs(x);
  7086. conv[0] = xx >= 10000 ? (xx / 10000) % 10 + '0' : ' ';
  7087. conv[1] = xx >= 1000 ? (xx / 1000) % 10 + '0' : ' ';
  7088. conv[2] = xx >= 100 ? (xx / 100) % 10 + '0' : ' ';
  7089. conv[3] = xx >= 10 ? (xx / 10) % 10 + '0' : ' ';
  7090. conv[4] = xx % 10 + '0';
  7091. conv[5] = 0;
  7092. return conv;
  7093. }
  7094. // Convert float to string with +1234.5 format
  7095. char *ftostr51(const float &x)
  7096. {
  7097. long xx = x * 10;
  7098. conv[0] = (xx >= 0) ? '+' : '-';
  7099. xx = abs(xx);
  7100. conv[1] = (xx / 10000) % 10 + '0';
  7101. conv[2] = (xx / 1000) % 10 + '0';
  7102. conv[3] = (xx / 100) % 10 + '0';
  7103. conv[4] = (xx / 10) % 10 + '0';
  7104. conv[5] = '.';
  7105. conv[6] = (xx) % 10 + '0';
  7106. conv[7] = 0;
  7107. return conv;
  7108. }
  7109. // Convert float to string with +123.45 format
  7110. char *ftostr52(const float &x)
  7111. {
  7112. long xx = x * 100;
  7113. conv[0] = (xx >= 0) ? '+' : '-';
  7114. xx = abs(xx);
  7115. conv[1] = (xx / 10000) % 10 + '0';
  7116. conv[2] = (xx / 1000) % 10 + '0';
  7117. conv[3] = (xx / 100) % 10 + '0';
  7118. conv[4] = '.';
  7119. conv[5] = (xx / 10) % 10 + '0';
  7120. conv[6] = (xx) % 10 + '0';
  7121. conv[7] = 0;
  7122. return conv;
  7123. }
  7124. /*
  7125. // Callback for after editing PID i value
  7126. // grab the PID i value out of the temp variable; scale it; then update the PID driver
  7127. void copy_and_scalePID_i()
  7128. {
  7129. #ifdef PIDTEMP
  7130. Ki = scalePID_i(raw_Ki);
  7131. updatePID();
  7132. #endif
  7133. }
  7134. // Callback for after editing PID d value
  7135. // grab the PID d value out of the temp variable; scale it; then update the PID driver
  7136. void copy_and_scalePID_d()
  7137. {
  7138. #ifdef PIDTEMP
  7139. Kd = scalePID_d(raw_Kd);
  7140. updatePID();
  7141. #endif
  7142. }
  7143. */
  7144. #endif //ULTRA_LCD