ultralcd.cpp 220 KB

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