12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272327332743275327632773278327932803281328232833284328532863287328832893290329132923293329432953296329732983299330033013302330333043305330633073308330933103311331233133314331533163317331833193320332133223323332433253326332733283329333033313332333333343335333633373338333933403341334233433344334533463347334833493350335133523353335433553356335733583359336033613362336333643365336633673368336933703371337233733374337533763377337833793380338133823383338433853386338733883389339033913392339333943395339633973398339934003401340234033404340534063407340834093410341134123413341434153416341734183419342034213422342334243425342634273428342934303431343234333434343534363437343834393440344134423443344434453446344734483449345034513452345334543455345634573458345934603461346234633464346534663467346834693470347134723473347434753476347734783479348034813482348334843485348634873488348934903491349234933494349534963497349834993500350135023503350435053506350735083509351035113512351335143515351635173518351935203521352235233524352535263527352835293530353135323533353435353536353735383539354035413542354335443545354635473548354935503551355235533554355535563557355835593560356135623563356435653566356735683569357035713572357335743575357635773578357935803581358235833584358535863587358835893590359135923593359435953596359735983599360036013602360336043605360636073608360936103611361236133614361536163617361836193620362136223623362436253626362736283629363036313632363336343635363636373638363936403641364236433644364536463647364836493650365136523653365436553656365736583659366036613662366336643665366636673668366936703671367236733674367536763677367836793680368136823683368436853686368736883689369036913692369336943695369636973698369937003701370237033704370537063707370837093710371137123713371437153716371737183719372037213722372337243725372637273728372937303731373237333734373537363737373837393740374137423743374437453746374737483749375037513752375337543755375637573758375937603761376237633764376537663767376837693770377137723773377437753776377737783779378037813782378337843785378637873788378937903791379237933794379537963797379837993800380138023803380438053806380738083809381038113812381338143815381638173818381938203821382238233824382538263827382838293830383138323833383438353836383738383839384038413842384338443845384638473848384938503851385238533854385538563857385838593860386138623863386438653866386738683869387038713872387338743875387638773878387938803881388238833884388538863887388838893890389138923893389438953896389738983899390039013902390339043905390639073908390939103911391239133914391539163917391839193920392139223923392439253926392739283929393039313932393339343935393639373938393939403941394239433944394539463947394839493950395139523953395439553956395739583959396039613962396339643965396639673968396939703971397239733974397539763977397839793980398139823983398439853986398739883989399039913992399339943995399639973998399940004001400240034004400540064007400840094010401140124013401440154016401740184019402040214022402340244025402640274028402940304031403240334034403540364037403840394040404140424043404440454046404740484049405040514052405340544055405640574058405940604061406240634064406540664067406840694070407140724073407440754076407740784079408040814082408340844085408640874088408940904091409240934094409540964097409840994100410141024103410441054106410741084109411041114112411341144115411641174118411941204121412241234124412541264127412841294130413141324133413441354136413741384139414041414142414341444145414641474148414941504151415241534154415541564157415841594160416141624163416441654166416741684169417041714172417341744175417641774178417941804181418241834184418541864187418841894190419141924193419441954196419741984199420042014202420342044205420642074208420942104211421242134214421542164217421842194220422142224223422442254226422742284229423042314232423342344235423642374238423942404241424242434244424542464247424842494250425142524253425442554256425742584259426042614262426342644265426642674268426942704271427242734274427542764277427842794280428142824283428442854286428742884289429042914292429342944295429642974298429943004301430243034304430543064307430843094310431143124313431443154316431743184319432043214322432343244325432643274328432943304331433243334334433543364337433843394340434143424343434443454346434743484349435043514352435343544355435643574358435943604361436243634364436543664367436843694370437143724373437443754376437743784379438043814382438343844385438643874388438943904391439243934394439543964397439843994400440144024403440444054406440744084409441044114412441344144415441644174418441944204421442244234424442544264427442844294430443144324433443444354436443744384439444044414442444344444445444644474448444944504451445244534454445544564457445844594460446144624463446444654466446744684469447044714472447344744475447644774478447944804481448244834484448544864487448844894490449144924493449444954496449744984499450045014502450345044505450645074508450945104511451245134514451545164517451845194520452145224523452445254526452745284529453045314532453345344535453645374538453945404541454245434544454545464547454845494550455145524553455445554556455745584559456045614562456345644565456645674568456945704571457245734574457545764577457845794580458145824583458445854586458745884589459045914592459345944595459645974598459946004601460246034604460546064607460846094610461146124613461446154616461746184619462046214622462346244625462646274628462946304631463246334634463546364637463846394640464146424643464446454646464746484649465046514652465346544655465646574658465946604661466246634664466546664667466846694670467146724673467446754676467746784679468046814682468346844685468646874688468946904691469246934694469546964697469846994700470147024703470447054706470747084709471047114712471347144715471647174718471947204721472247234724472547264727472847294730473147324733473447354736473747384739474047414742474347444745474647474748474947504751475247534754475547564757475847594760476147624763476447654766476747684769477047714772477347744775477647774778477947804781478247834784478547864787478847894790479147924793479447954796479747984799480048014802480348044805480648074808480948104811481248134814481548164817481848194820482148224823482448254826482748284829483048314832483348344835483648374838483948404841484248434844484548464847484848494850485148524853485448554856485748584859486048614862486348644865486648674868486948704871487248734874487548764877487848794880488148824883488448854886488748884889489048914892489348944895489648974898489949004901490249034904490549064907490849094910491149124913491449154916491749184919492049214922492349244925492649274928492949304931493249334934493549364937493849394940494149424943494449454946494749484949495049514952495349544955495649574958495949604961496249634964496549664967496849694970497149724973497449754976497749784979498049814982498349844985498649874988498949904991499249934994499549964997499849995000500150025003500450055006500750085009501050115012501350145015501650175018501950205021502250235024502550265027502850295030503150325033503450355036503750385039504050415042504350445045504650475048504950505051505250535054505550565057505850595060506150625063506450655066506750685069507050715072507350745075507650775078507950805081508250835084508550865087508850895090509150925093509450955096509750985099510051015102510351045105510651075108510951105111511251135114511551165117511851195120512151225123512451255126512751285129513051315132513351345135513651375138513951405141514251435144514551465147514851495150515151525153515451555156515751585159516051615162516351645165516651675168516951705171517251735174517551765177517851795180518151825183518451855186518751885189519051915192519351945195519651975198519952005201520252035204520552065207520852095210521152125213521452155216521752185219522052215222522352245225522652275228522952305231523252335234523552365237523852395240524152425243524452455246524752485249525052515252525352545255525652575258525952605261526252635264526552665267526852695270527152725273527452755276527752785279528052815282528352845285528652875288528952905291529252935294529552965297529852995300530153025303530453055306530753085309531053115312531353145315531653175318531953205321532253235324532553265327532853295330533153325333533453355336533753385339534053415342534353445345534653475348534953505351535253535354535553565357535853595360536153625363536453655366536753685369537053715372537353745375537653775378537953805381538253835384538553865387538853895390539153925393539453955396539753985399540054015402540354045405540654075408540954105411541254135414541554165417541854195420542154225423542454255426542754285429543054315432543354345435543654375438543954405441544254435444544554465447544854495450545154525453545454555456545754585459546054615462546354645465546654675468546954705471547254735474547554765477547854795480548154825483548454855486548754885489549054915492549354945495549654975498549955005501550255035504550555065507550855095510551155125513551455155516551755185519552055215522552355245525552655275528552955305531553255335534553555365537553855395540554155425543554455455546554755485549555055515552555355545555555655575558555955605561556255635564556555665567556855695570557155725573557455755576557755785579558055815582558355845585558655875588558955905591559255935594559555965597559855995600560156025603560456055606560756085609561056115612561356145615561656175618561956205621562256235624562556265627562856295630563156325633563456355636563756385639564056415642564356445645564656475648564956505651565256535654565556565657565856595660566156625663566456655666566756685669567056715672567356745675567656775678567956805681568256835684568556865687568856895690569156925693569456955696569756985699570057015702570357045705570657075708570957105711571257135714571557165717571857195720572157225723572457255726572757285729573057315732573357345735573657375738573957405741574257435744574557465747574857495750575157525753575457555756575757585759576057615762576357645765576657675768576957705771577257735774577557765777577857795780578157825783578457855786578757885789579057915792579357945795579657975798579958005801580258035804580558065807580858095810581158125813581458155816581758185819582058215822582358245825582658275828582958305831583258335834583558365837583858395840584158425843584458455846584758485849585058515852585358545855585658575858585958605861586258635864586558665867586858695870587158725873587458755876587758785879588058815882588358845885588658875888588958905891589258935894589558965897589858995900590159025903590459055906590759085909591059115912591359145915591659175918591959205921592259235924592559265927592859295930593159325933593459355936593759385939594059415942594359445945594659475948594959505951595259535954595559565957595859595960596159625963596459655966596759685969597059715972597359745975597659775978597959805981598259835984598559865987598859895990599159925993599459955996599759985999600060016002600360046005600660076008600960106011601260136014601560166017601860196020602160226023602460256026602760286029603060316032603360346035603660376038603960406041604260436044604560466047604860496050605160526053605460556056605760586059606060616062606360646065606660676068606960706071607260736074607560766077607860796080608160826083608460856086608760886089609060916092609360946095609660976098609961006101610261036104610561066107610861096110611161126113611461156116611761186119612061216122612361246125612661276128612961306131613261336134613561366137613861396140614161426143614461456146614761486149615061516152615361546155615661576158615961606161616261636164616561666167616861696170617161726173617461756176617761786179618061816182618361846185618661876188618961906191619261936194619561966197619861996200620162026203620462056206620762086209621062116212621362146215621662176218621962206221622262236224622562266227622862296230623162326233623462356236623762386239624062416242624362446245624662476248624962506251625262536254625562566257625862596260626162626263626462656266626762686269627062716272627362746275627662776278627962806281628262836284628562866287628862896290629162926293629462956296629762986299630063016302630363046305630663076308630963106311631263136314631563166317631863196320632163226323632463256326632763286329633063316332633363346335633663376338633963406341634263436344634563466347634863496350635163526353635463556356635763586359636063616362636363646365636663676368636963706371637263736374637563766377637863796380638163826383638463856386638763886389639063916392639363946395639663976398639964006401640264036404640564066407640864096410641164126413641464156416641764186419642064216422642364246425642664276428642964306431643264336434643564366437643864396440644164426443644464456446644764486449645064516452645364546455645664576458645964606461646264636464646564666467 |
- #include "ff.h"
- #include "diskio.h"
- #include <stdio.h>
- #include <stdlib.h>
- #include <string.h>
- #if _FS_NORTC == 0
- #include <drivers/rtc.h>
- #endif
- #if _FATFS != 68020
- #error Wrong include file (ff.h).
- #endif
- #define ABORT(fs, res) { fp->err = (BYTE)(res); LEAVE_FF(fs, res); }
- #if _FS_REENTRANT
- #if _USE_LFN == 1
- #error Static LFN work area cannot be used at thread-safe configuration
- #endif
- #define ENTER_FF(fs) { if (!lock_fs(fs)) return FR_TIMEOUT; }
- #define LEAVE_FF(fs, res) { unlock_fs(fs, res); return res; }
- #else
- #define ENTER_FF(fs)
- #define LEAVE_FF(fs, res) return res
- #endif
- #if (_MAX_SS < _MIN_SS) || (_MAX_SS != 512 && _MAX_SS != 1024 && _MAX_SS != 2048 && _MAX_SS != 4096) || (_MIN_SS != 512 && _MIN_SS != 1024 && _MIN_SS != 2048 && _MIN_SS != 4096)
- #error Wrong sector size configuration
- #endif
- #if _MAX_SS == _MIN_SS
- #define SS(fs) ((UINT)_MAX_SS)
- #else
- #define SS(fs) ((fs)->ssize)
- #endif
- #if _FS_NORTC == 1
- #if _NORTC_YEAR < 1980 || _NORTC_YEAR > 2107 || _NORTC_MON < 1 || _NORTC_MON > 12 || _NORTC_MDAY < 1 || _NORTC_MDAY > 31
- #error Invalid _FS_NORTC settings
- #endif
- #define GET_FATTIME() ((DWORD)(_NORTC_YEAR - 1980) << 25 | (DWORD)_NORTC_MON << 21 | (DWORD)_NORTC_MDAY << 16)
- #else
- #define GET_FATTIME() get_fattime()
- #endif
- #if _FS_LOCK != 0
- #if _FS_READONLY
- #error _FS_LOCK must be 0 at read-only configuration
- #endif
- typedef struct {
- FATFS *fs;
- DWORD clu;
- DWORD ofs;
- WORD ctr;
- } FILESEM;
- #endif
- #if _CODE_PAGE == 932
- #define _DF1S 0x81
- #define _DF1E 0x9F
- #define _DF2S 0xE0
- #define _DF2E 0xFC
- #define _DS1S 0x40
- #define _DS1E 0x7E
- #define _DS2S 0x80
- #define _DS2E 0xFC
- #elif _CODE_PAGE == 936
- #define _DF1S 0x81
- #define _DF1E 0xFE
- #define _DS1S 0x40
- #define _DS1E 0x7E
- #define _DS2S 0x80
- #define _DS2E 0xFE
- #elif _CODE_PAGE == 949
- #define _DF1S 0x81
- #define _DF1E 0xFE
- #define _DS1S 0x41
- #define _DS1E 0x5A
- #define _DS2S 0x61
- #define _DS2E 0x7A
- #define _DS3S 0x81
- #define _DS3E 0xFE
- #elif _CODE_PAGE == 950
- #define _DF1S 0x81
- #define _DF1E 0xFE
- #define _DS1S 0x40
- #define _DS1E 0x7E
- #define _DS2S 0xA1
- #define _DS2E 0xFE
- #elif _CODE_PAGE == 437
- #define _DF1S 0
- #define _EXCVT {0x80,0x9A,0x45,0x41,0x8E,0x41,0x8F,0x80,0x45,0x45,0x45,0x49,0x49,0x49,0x8E,0x8F, \
- 0x90,0x92,0x92,0x4F,0x99,0x4F,0x55,0x55,0x59,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
- 0x41,0x49,0x4F,0x55,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
- 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
- 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
- #elif _CODE_PAGE == 720
- #define _DF1S 0
- #define _EXCVT {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
- 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
- 0xA0,0xA1,0xA2,0xA3,0xA4,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
- 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
- 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
- #elif _CODE_PAGE == 737
- #define _DF1S 0
- #define _EXCVT {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
- 0x90,0x92,0x92,0x93,0x94,0x95,0x96,0x97,0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87, \
- 0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F,0x90,0x91,0xAA,0x92,0x93,0x94,0x95,0x96, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
- 0x97,0xEA,0xEB,0xEC,0xE4,0xED,0xEE,0xEF,0xF5,0xF0,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
- 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
- #elif _CODE_PAGE == 771
- #define _DF1S 0
- #define _EXCVT {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
- 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
- 0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDC,0xDE,0xDE, \
- 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
- 0xF0,0xF0,0xF2,0xF2,0xF4,0xF4,0xF6,0xF6,0xF8,0xF8,0xFA,0xFA,0xFC,0xFC,0xFE,0xFF}
- #elif _CODE_PAGE == 775
- #define _DF1S 0
- #define _EXCVT {0x80,0x9A,0x91,0xA0,0x8E,0x95,0x8F,0x80,0xAD,0xED,0x8A,0x8A,0xA1,0x8D,0x8E,0x8F, \
- 0x90,0x92,0x92,0xE2,0x99,0x95,0x96,0x97,0x97,0x99,0x9A,0x9D,0x9C,0x9D,0x9E,0x9F, \
- 0xA0,0xA1,0xE0,0xA3,0xA3,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xB5,0xB6,0xB7,0xB8,0xBD,0xBE,0xC6,0xC7,0xA5,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
- 0xE0,0xE1,0xE2,0xE3,0xE5,0xE5,0xE6,0xE3,0xE8,0xE8,0xEA,0xEA,0xEE,0xED,0xEE,0xEF, \
- 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
- #elif _CODE_PAGE == 850
- #define _DF1S 0
- #define _EXCVT {0x43,0x55,0x45,0x41,0x41,0x41,0x41,0x43,0x45,0x45,0x45,0x49,0x49,0x49,0x41,0x41, \
- 0x45,0x92,0x92,0x4F,0x4F,0x4F,0x55,0x55,0x59,0x4F,0x55,0x4F,0x9C,0x4F,0x9E,0x9F, \
- 0x41,0x49,0x4F,0x55,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0x41,0x41,0x41,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0x41,0x41,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD1,0xD1,0x45,0x45,0x45,0x49,0x49,0x49,0x49,0xD9,0xDA,0xDB,0xDC,0xDD,0x49,0xDF, \
- 0x4F,0xE1,0x4F,0x4F,0x4F,0x4F,0xE6,0xE8,0xE8,0x55,0x55,0x55,0x59,0x59,0xEE,0xEF, \
- 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
- #elif _CODE_PAGE == 852
- #define _DF1S 0
- #define _EXCVT {0x80,0x9A,0x90,0xB6,0x8E,0xDE,0x8F,0x80,0x9D,0xD3,0x8A,0x8A,0xD7,0x8D,0x8E,0x8F, \
- 0x90,0x91,0x91,0xE2,0x99,0x95,0x95,0x97,0x97,0x99,0x9A,0x9B,0x9B,0x9D,0x9E,0xAC, \
- 0xB5,0xD6,0xE0,0xE9,0xA4,0xA4,0xA6,0xA6,0xA8,0xA8,0xAA,0x8D,0xAC,0xB8,0xAE,0xAF, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBD,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC6,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD1,0xD1,0xD2,0xD3,0xD2,0xD5,0xD6,0xD7,0xB7,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
- 0xE0,0xE1,0xE2,0xE3,0xE3,0xD5,0xE6,0xE6,0xE8,0xE9,0xE8,0xEB,0xED,0xED,0xDD,0xEF, \
- 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xEB,0xFC,0xFC,0xFE,0xFF}
- #elif _CODE_PAGE == 855
- #define _DF1S 0
- #define _EXCVT {0x81,0x81,0x83,0x83,0x85,0x85,0x87,0x87,0x89,0x89,0x8B,0x8B,0x8D,0x8D,0x8F,0x8F, \
- 0x91,0x91,0x93,0x93,0x95,0x95,0x97,0x97,0x99,0x99,0x9B,0x9B,0x9D,0x9D,0x9F,0x9F, \
- 0xA1,0xA1,0xA3,0xA3,0xA5,0xA5,0xA7,0xA7,0xA9,0xA9,0xAB,0xAB,0xAD,0xAD,0xAE,0xAF, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB6,0xB6,0xB8,0xB8,0xB9,0xBA,0xBB,0xBC,0xBE,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC7,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD1,0xD1,0xD3,0xD3,0xD5,0xD5,0xD7,0xD7,0xDD,0xD9,0xDA,0xDB,0xDC,0xDD,0xE0,0xDF, \
- 0xE0,0xE2,0xE2,0xE4,0xE4,0xE6,0xE6,0xE8,0xE8,0xEA,0xEA,0xEC,0xEC,0xEE,0xEE,0xEF, \
- 0xF0,0xF2,0xF2,0xF4,0xF4,0xF6,0xF6,0xF8,0xF8,0xFA,0xFA,0xFC,0xFC,0xFD,0xFE,0xFF}
- #elif _CODE_PAGE == 857
- #define _DF1S 0
- #define _EXCVT {0x80,0x9A,0x90,0xB6,0x8E,0xB7,0x8F,0x80,0xD2,0xD3,0xD4,0xD8,0xD7,0x49,0x8E,0x8F, \
- 0x90,0x92,0x92,0xE2,0x99,0xE3,0xEA,0xEB,0x98,0x99,0x9A,0x9D,0x9C,0x9D,0x9E,0x9E, \
- 0xB5,0xD6,0xE0,0xE9,0xA5,0xA5,0xA6,0xA6,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC7,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD0,0xD1,0xD2,0xD3,0xD4,0x49,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
- 0xE0,0xE1,0xE2,0xE3,0xE5,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xDE,0xED,0xEE,0xEF, \
- 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
- #elif _CODE_PAGE == 860
- #define _DF1S 0
- #define _EXCVT {0x80,0x9A,0x90,0x8F,0x8E,0x91,0x86,0x80,0x89,0x89,0x92,0x8B,0x8C,0x98,0x8E,0x8F, \
- 0x90,0x91,0x92,0x8C,0x99,0xA9,0x96,0x9D,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
- 0x86,0x8B,0x9F,0x96,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
- 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
- 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
- #elif _CODE_PAGE == 861
- #define _DF1S 0
- #define _EXCVT {0x80,0x9A,0x90,0x41,0x8E,0x41,0x8F,0x80,0x45,0x45,0x45,0x8B,0x8B,0x8D,0x8E,0x8F, \
- 0x90,0x92,0x92,0x4F,0x99,0x8D,0x55,0x97,0x97,0x99,0x9A,0x9D,0x9C,0x9D,0x9E,0x9F, \
- 0xA4,0xA5,0xA6,0xA7,0xA4,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
- 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
- 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
- #elif _CODE_PAGE == 862
- #define _DF1S 0
- #define _EXCVT {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
- 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
- 0x41,0x49,0x4F,0x55,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
- 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
- 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
- #elif _CODE_PAGE == 863
- #define _DF1S 0
- #define _EXCVT {0x43,0x55,0x45,0x41,0x41,0x41,0x86,0x43,0x45,0x45,0x45,0x49,0x49,0x8D,0x41,0x8F, \
- 0x45,0x45,0x45,0x4F,0x45,0x49,0x55,0x55,0x98,0x4F,0x55,0x9B,0x9C,0x55,0x55,0x9F, \
- 0xA0,0xA1,0x4F,0x55,0xA4,0xA5,0xA6,0xA7,0x49,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
- 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
- 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
- #elif _CODE_PAGE == 864
- #define _DF1S 0
- #define _EXCVT {0x80,0x9A,0x45,0x41,0x8E,0x41,0x8F,0x80,0x45,0x45,0x45,0x49,0x49,0x49,0x8E,0x8F, \
- 0x90,0x92,0x92,0x4F,0x99,0x4F,0x55,0x55,0x59,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
- 0x41,0x49,0x4F,0x55,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
- 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
- 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
- #elif _CODE_PAGE == 865
- #define _DF1S 0
- #define _EXCVT {0x80,0x9A,0x90,0x41,0x8E,0x41,0x8F,0x80,0x45,0x45,0x45,0x49,0x49,0x49,0x8E,0x8F, \
- 0x90,0x92,0x92,0x4F,0x99,0x4F,0x55,0x55,0x59,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
- 0x41,0x49,0x4F,0x55,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
- 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
- 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
- #elif _CODE_PAGE == 866
- #define _DF1S 0
- #define _EXCVT {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
- 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
- 0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
- 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
- 0xF0,0xF0,0xF2,0xF2,0xF4,0xF4,0xF6,0xF6,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
- #elif _CODE_PAGE == 869
- #define _DF1S 0
- #define _EXCVT {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
- 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x86,0x9C,0x8D,0x8F,0x90, \
- 0x91,0x90,0x92,0x95,0xA4,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
- 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
- 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
- 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xA4,0xA5,0xA6,0xD9,0xDA,0xDB,0xDC,0xA7,0xA8,0xDF, \
- 0xA9,0xAA,0xAC,0xAD,0xB5,0xB6,0xB7,0xB8,0xBD,0xBE,0xC6,0xC7,0xCF,0xCF,0xD0,0xEF, \
- 0xF0,0xF1,0xD1,0xD2,0xD3,0xF5,0xD4,0xF7,0xF8,0xF9,0xD5,0x96,0x95,0x98,0xFE,0xFF}
- #elif _CODE_PAGE == 1
- #if _USE_LFN != 0
- #error Cannot enable LFN without valid code page.
- #endif
- #define _DF1S 0
- #else
- #error Unknown code page
- #endif
- #define IsUpper(c) (((c)>='A')&&((c)<='Z'))
- #define IsLower(c) (((c)>='a')&&((c)<='z'))
- #define IsDigit(c) (((c)>='0')&&((c)<='9'))
- #if _DF1S != 0
- #ifdef _DF2S
- #define IsDBCS1(c) (((BYTE)(c) >= _DF1S && (BYTE)(c) <= _DF1E) || ((BYTE)(c) >= _DF2S && (BYTE)(c) <= _DF2E))
- #else
- #define IsDBCS1(c) ((BYTE)(c) >= _DF1S && (BYTE)(c) <= _DF1E)
- #endif
- #ifdef _DS3S
- #define IsDBCS2(c) (((BYTE)(c) >= _DS1S && (BYTE)(c) <= _DS1E) || ((BYTE)(c) >= _DS2S && (BYTE)(c) <= _DS2E) || ((BYTE)(c) >= _DS3S && (BYTE)(c) <= _DS3E))
- #else
- #define IsDBCS2(c) (((BYTE)(c) >= _DS1S && (BYTE)(c) <= _DS1E) || ((BYTE)(c) >= _DS2S && (BYTE)(c) <= _DS2E))
- #endif
- #else
- #define IsDBCS1(c) 0
- #define IsDBCS2(c) 0
- #endif
- #define AM_VOL 0x08
- #define AM_LFN 0x0F
- #define AM_MASK 0x3F
- #define FA_SEEKEND 0x20
- #define FA_MODIFIED 0x40
- #define FA_DIRTY 0x80
- #define NSFLAG 11
- #define NS_LOSS 0x01
- #define NS_LFN 0x02
- #define NS_LAST 0x04
- #define NS_BODY 0x08
- #define NS_EXT 0x10
- #define NS_DOT 0x20
- #define NS_NOLFN 0x40
- #define NS_NONAME 0x80
- #define MAX_FAT12 0xFF5
- #define MAX_FAT16 0xFFF5
- #define MAX_FAT32 0xFFFFFF5
- #define MAX_EXFAT 0x7FFFFFFD
- #define MAX_DIR 0x200000
- #define MAX_DIR_EX 0x10000000
- #define BS_JmpBoot 0
- #define BS_OEMName 3
- #define BPB_BytsPerSec 11
- #define BPB_SecPerClus 13
- #define BPB_RsvdSecCnt 14
- #define BPB_NumFATs 16
- #define BPB_RootEntCnt 17
- #define BPB_TotSec16 19
- #define BPB_Media 21
- #define BPB_FATSz16 22
- #define BPB_SecPerTrk 24
- #define BPB_NumHeads 26
- #define BPB_HiddSec 28
- #define BPB_TotSec32 32
- #define BS_DrvNum 36
- #define BS_NTres 37
- #define BS_BootSig 38
- #define BS_VolID 39
- #define BS_VolLab 43
- #define BS_FilSysType 54
- #define BS_BootCode 62
- #define BS_55AA 510
- #define BPB_FATSz32 36
- #define BPB_ExtFlags32 40
- #define BPB_FSVer32 42
- #define BPB_RootClus32 44
- #define BPB_FSInfo32 48
- #define BPB_BkBootSec32 50
- #define BS_DrvNum32 64
- #define BS_NTres32 65
- #define BS_BootSig32 66
- #define BS_VolID32 67
- #define BS_VolLab32 71
- #define BS_FilSysType32 82
- #define BS_BootCode32 90
- #define BPB_ZeroedEx 11
- #define BPB_VolOfsEx 64
- #define BPB_TotSecEx 72
- #define BPB_FatOfsEx 80
- #define BPB_FatSzEx 84
- #define BPB_DataOfsEx 88
- #define BPB_NumClusEx 92
- #define BPB_RootClusEx 96
- #define BPB_VolIDEx 100
- #define BPB_FSVerEx 104
- #define BPB_VolFlagEx 106
- #define BPB_ActFatEx 107
- #define BPB_BytsPerSecEx 108
- #define BPB_SecPerClusEx 109
- #define BPB_NumFATsEx 110
- #define BPB_DrvNumEx 111
- #define BPB_PercInUseEx 112
- #define BPB_RsvdEx 113
- #define BS_BootCodeEx 120
- #define FSI_LeadSig 0
- #define FSI_StrucSig 484
- #define FSI_Free_Count 488
- #define FSI_Nxt_Free 492
- #define MBR_Table 446
- #define SZ_PTE 16
- #define PTE_Boot 0
- #define PTE_StHead 1
- #define PTE_StSec 2
- #define PTE_StCyl 3
- #define PTE_System 4
- #define PTE_EdHead 5
- #define PTE_EdSec 6
- #define PTE_EdCyl 7
- #define PTE_StLba 8
- #define PTE_SizLba 12
- #define DIR_Name 0
- #define DIR_Attr 11
- #define DIR_NTres 12
- #define DIR_CrtTime10 13
- #define DIR_CrtTime 14
- #define DIR_LstAccDate 18
- #define DIR_FstClusHI 20
- #define DIR_ModTime 22
- #define DIR_FstClusLO 26
- #define DIR_FileSize 28
- #define LDIR_Ord 0
- #define LDIR_Attr 11
- #define LDIR_Type 12
- #define LDIR_Chksum 13
- #define LDIR_FstClusLO 26
- #define XDIR_Type 0
- #define XDIR_NumLabel 1
- #define XDIR_Label 2
- #define XDIR_CaseSum 4
- #define XDIR_NumSec 1
- #define XDIR_SetSum 2
- #define XDIR_Attr 4
- #define XDIR_CrtTime 8
- #define XDIR_ModTime 12
- #define XDIR_AccTime 16
- #define XDIR_CrtTime10 20
- #define XDIR_ModTime10 21
- #define XDIR_CrtTZ 22
- #define XDIR_ModTZ 23
- #define XDIR_AccTZ 24
- #define XDIR_GenFlags 33
- #define XDIR_NumName 35
- #define XDIR_NameHash 36
- #define XDIR_ValidFileSize 40
- #define XDIR_FstClus 52
- #define XDIR_FileSize 56
- #define SZDIRE 32
- #define LLEF 0x40
- #define DDEM 0xE5
- #define RDDEM 0x05
- #if _VOLUMES < 1 || _VOLUMES > 9
- #error Wrong _VOLUMES setting
- #endif
- static FATFS *FatFs[_VOLUMES];
- static WORD Fsid;
- #if _FS_RPATH != 0 && _VOLUMES >= 2
- static BYTE CurrVol;
- #endif
- #if _FS_LOCK != 0
- static FILESEM Files[_FS_LOCK];
- #endif
- #if _USE_LFN == 0
- #define DEF_NAMBUF
- #define INIT_NAMBUF(fs)
- #define FREE_NAMBUF()
- #else
- #if _MAX_LFN < 12 || _MAX_LFN > 255
- #error Wrong _MAX_LFN setting
- #endif
- #if _USE_LFN == 1
- #if _FS_EXFAT
- static BYTE DirBuf[SZDIRE*19];
- #endif
- static WCHAR LfnBuf[_MAX_LFN+1];
- #define DEF_NAMBUF
- #define INIT_NAMBUF(fs)
- #define FREE_NAMBUF()
- #elif _USE_LFN == 2
- #if _FS_EXFAT
- #define DEF_NAMBUF WCHAR lbuf[_MAX_LFN+1]; BYTE dbuf[SZDIRE*19];
- #define INIT_NAMBUF(fs) { (fs)->lfnbuf = lbuf; (fs)->dirbuf = dbuf; }
- #define FREE_NAMBUF()
- #else
- #define DEF_NAMBUF WCHAR lbuf[_MAX_LFN+1];
- #define INIT_NAMBUF(fs) { (fs)->lfnbuf = lbuf; }
- #define FREE_NAMBUF()
- #endif
- #elif _USE_LFN == 3
- #if _FS_EXFAT
- #define DEF_NAMBUF WCHAR *lfn;
- #define INIT_NAMBUF(fs) { lfn = ff_memalloc((_MAX_LFN+1)*2 + SZDIRE*19); if (!lfn) LEAVE_FF(fs, FR_NOT_ENOUGH_CORE); (fs)->lfnbuf = lfn; (fs)->dirbuf = (BYTE*)(lfn+_MAX_LFN+1); }
- #define FREE_NAMBUF() ff_memfree(lfn)
- #else
- #define DEF_NAMBUF WCHAR *lfn;
- #define INIT_NAMBUF(fs) { lfn = ff_memalloc((_MAX_LFN+1)*2); if (!lfn) LEAVE_FF(fs, FR_NOT_ENOUGH_CORE); (fs)->lfnbuf = lfn; }
- #define FREE_NAMBUF() ff_memfree(lfn)
- #endif
- #else
- #error Wrong _USE_LFN setting
- #endif
- #endif
- #ifdef _EXCVT
- static const BYTE ExCvt[] = _EXCVT;
- #endif
- #if _FS_NORTC == 0
- DWORD get_fattime(void)
- {
- struct device *rtc = device_get_binding(CONFIG_RTC_0_NAME);
- struct rtc_time time;
- DWORD cur_time = ((DWORD)(_NORTC_YEAR - 1980) << 25 | (DWORD)_NORTC_MON << 21 | (DWORD)_NORTC_MDAY << 16);
- if (!rtc) {
- printf("rtc nul\n");
- return cur_time;
- }
- rtc_get_time(rtc, &time);
- cur_time = (DWORD)(time.tm_year + 1900 - 1980) << 25 | (DWORD)(time.tm_mon + 1) << 21 | (DWORD)(time.tm_mday << 16)
- | (DWORD)(time.tm_hour << 11) | (DWORD)(time.tm_min << 5) | (DWORD)(time.tm_sec / 2);
- return cur_time;
- }
- #endif
- static
- WORD ld_word (const BYTE* ptr)
- {
- WORD rv;
- rv = ptr[1];
- rv = rv << 8 | ptr[0];
- return rv;
- }
- static
- DWORD ld_dword (const BYTE* ptr)
- {
- DWORD rv;
- rv = ptr[3];
- rv = rv << 8 | ptr[2];
- rv = rv << 8 | ptr[1];
- rv = rv << 8 | ptr[0];
- return rv;
- }
- #if _FS_EXFAT
- static
- QWORD ld_qword (const BYTE* ptr)
- {
- QWORD rv;
- rv = ptr[7];
- rv = rv << 8 | ptr[6];
- rv = rv << 8 | ptr[5];
- rv = rv << 8 | ptr[4];
- rv = rv << 8 | ptr[3];
- rv = rv << 8 | ptr[2];
- rv = rv << 8 | ptr[1];
- rv = rv << 8 | ptr[0];
- return rv;
- }
- #endif
- #if !_FS_READONLY
- static
- void st_word (BYTE* ptr, WORD val)
- {
- *ptr++ = (BYTE)val; val >>= 8;
- *ptr++ = (BYTE)val;
- }
- static
- void st_dword (BYTE* ptr, DWORD val)
- {
- *ptr++ = (BYTE)val; val >>= 8;
- *ptr++ = (BYTE)val; val >>= 8;
- *ptr++ = (BYTE)val; val >>= 8;
- *ptr++ = (BYTE)val;
- }
- #if _FS_EXFAT
- static
- void st_qword (BYTE* ptr, QWORD val)
- {
- *ptr++ = (BYTE)val; val >>= 8;
- *ptr++ = (BYTE)val; val >>= 8;
- *ptr++ = (BYTE)val; val >>= 8;
- *ptr++ = (BYTE)val; val >>= 8;
- *ptr++ = (BYTE)val; val >>= 8;
- *ptr++ = (BYTE)val; val >>= 8;
- *ptr++ = (BYTE)val; val >>= 8;
- *ptr++ = (BYTE)val;
- }
- #endif
- #endif
- static
- void mem_cpy (void* dst, const void* src, UINT cnt) {
- BYTE *d = (BYTE*)dst;
- const BYTE *s = (const BYTE*)src;
- if (cnt) {
- do *d++ = *s++; while (--cnt);
- }
- }
- static
- void mem_set (void* dst, int val, UINT cnt) {
- BYTE *d = (BYTE*)dst;
- do *d++ = (BYTE)val; while (--cnt);
- }
- static
- int mem_cmp (const void* dst, const void* src, UINT cnt) {
- const BYTE *d = (const BYTE *)dst, *s = (const BYTE *)src;
- int r = 0;
- do {
- r = *d++ - *s++;
- } while (--cnt && r == 0);
- return r;
- }
- static
- int chk_chr (const char* str, int chr) {
- while (*str && *str != chr) str++;
- return *str;
- }
- #if _FS_REENTRANT
- static
- int lock_fs (
- FATFS* fs
- )
- {
- return ff_req_grant(fs->sobj);
- }
- static
- void unlock_fs (
- FATFS* fs,
- FRESULT res
- )
- {
- if (fs && res != FR_NOT_ENABLED && res != FR_INVALID_DRIVE && res != FR_TIMEOUT) {
- ff_rel_grant(fs->sobj);
- }
- }
- #endif
- #if _FS_LOCK != 0
- static
- FRESULT chk_lock (
- DIR* dp,
- int acc
- )
- {
- UINT i, be;
-
- for (i = be = 0; i < _FS_LOCK; i++) {
- if (Files[i].fs) {
- if (Files[i].fs == dp->obj.fs &&
- Files[i].clu == dp->obj.sclust &&
- Files[i].ofs == dp->dptr) break;
- } else {
- be = 1;
- }
- }
- if (i == _FS_LOCK) {
- return (be || acc == 2) ? FR_OK : FR_TOO_MANY_OPEN_FILES;
- }
-
- return (acc || Files[i].ctr == 0x100) ? FR_LOCKED : FR_OK;
- }
- static
- int enq_lock (void)
- {
- UINT i;
- for (i = 0; i < _FS_LOCK && Files[i].fs; i++) ;
- return (i == _FS_LOCK) ? 0 : 1;
- }
- static
- UINT inc_lock (
- DIR* dp,
- int acc
- )
- {
- UINT i;
- for (i = 0; i < _FS_LOCK; i++) {
- if (Files[i].fs == dp->obj.fs &&
- Files[i].clu == dp->obj.sclust &&
- Files[i].ofs == dp->dptr) break;
- }
- if (i == _FS_LOCK) {
- for (i = 0; i < _FS_LOCK && Files[i].fs; i++) ;
- if (i == _FS_LOCK) return 0;
- Files[i].fs = dp->obj.fs;
- Files[i].clu = dp->obj.sclust;
- Files[i].ofs = dp->dptr;
- Files[i].ctr = 0;
- }
- if (acc && Files[i].ctr) return 0;
- Files[i].ctr = acc ? 0x100 : Files[i].ctr + 1;
- return i + 1;
- }
- static
- FRESULT dec_lock (
- UINT i
- )
- {
- WORD n;
- FRESULT res;
- if (--i < _FS_LOCK) {
- n = Files[i].ctr;
- if (n == 0x100) n = 0;
- if (n > 0) n--;
- Files[i].ctr = n;
- if (n == 0) Files[i].fs = 0;
- res = FR_OK;
- } else {
- res = FR_INT_ERR;
- }
- return res;
- }
- static
- void clear_lock (
- FATFS *fs
- )
- {
- UINT i;
- for (i = 0; i < _FS_LOCK; i++) {
- if (Files[i].fs == fs) Files[i].fs = 0;
- }
- }
- #endif
- #if !_FS_READONLY
- static
- FRESULT sync_window (
- FATFS* fs
- )
- {
- DWORD wsect;
- UINT nf;
- FRESULT res = FR_OK;
- if (fs->wflag) {
- wsect = fs->winsect;
- if (disk_write(fs->drv, fs->win, wsect, 1) != RES_OK) {
- res = FR_DISK_ERR;
- } else {
- fs->wflag = 0;
- if (wsect - fs->fatbase < fs->fsize) {
- for (nf = fs->n_fats; nf >= 2; nf--) {
- wsect += fs->fsize;
- disk_write(fs->drv, fs->win, wsect, 1);
- }
- }
- }
- }
- return res;
- }
- #endif
- static
- FRESULT move_window (
- FATFS* fs,
- DWORD sector
- )
- {
- FRESULT res = FR_OK;
- if (sector != fs->winsect) {
- #if !_FS_READONLY
- res = sync_window(fs);
- #endif
- if (res == FR_OK) {
- if (disk_read(fs->drv, fs->win, sector, 1) != RES_OK) {
- sector = 0xFFFFFFFF;
- res = FR_DISK_ERR;
- }
- fs->winsect = sector;
- }
- }
- return res;
- }
- #if !_FS_READONLY
- static
- FRESULT sync_fs (
- FATFS* fs
- )
- {
- FRESULT res;
- res = sync_window(fs);
- if (res == FR_OK) {
-
- if (fs->fs_type == FS_FAT32 && fs->fsi_flag == 1) {
-
- mem_set(fs->win, 0, SS(fs));
- st_word(fs->win + BS_55AA, 0xAA55);
- st_dword(fs->win + FSI_LeadSig, 0x41615252);
- st_dword(fs->win + FSI_StrucSig, 0x61417272);
- st_dword(fs->win + FSI_Free_Count, fs->free_clst);
- st_dword(fs->win + FSI_Nxt_Free, fs->last_clst);
-
- fs->winsect = fs->volbase + 1;
- disk_write(fs->drv, fs->win, fs->winsect, 1);
- fs->fsi_flag = 0;
- }
-
- if (disk_ioctl(fs->drv, CTRL_SYNC, 0) != RES_OK) res = FR_DISK_ERR;
- }
- return res;
- }
- #endif
- static
- DWORD clust2sect (
- FATFS* fs,
- DWORD clst
- )
- {
- clst -= 2;
- if (clst >= fs->n_fatent - 2) return 0;
- return clst * fs->csize + fs->database;
- }
- static
- DWORD get_fat (
- _FDID* obj,
- DWORD clst
- )
- {
- UINT wc, bc;
- DWORD val;
- FATFS *fs = obj->fs;
- if (clst < 2 || clst >= fs->n_fatent) {
- val = 1;
- } else {
- val = 0xFFFFFFFF;
- switch (fs->fs_type) {
- case FS_FAT12 :
- bc = (UINT)clst; bc += bc / 2;
- if (move_window(fs, fs->fatbase + (bc / SS(fs))) != FR_OK) break;
- wc = fs->win[bc++ % SS(fs)];
- if (move_window(fs, fs->fatbase + (bc / SS(fs))) != FR_OK) break;
- wc |= fs->win[bc % SS(fs)] << 8;
- val = (clst & 1) ? (wc >> 4) : (wc & 0xFFF);
- break;
- case FS_FAT16 :
- if (move_window(fs, fs->fatbase + (clst / (SS(fs) / 2))) != FR_OK) break;
- val = ld_word(fs->win + clst * 2 % SS(fs));
- break;
- case FS_FAT32 :
- if (move_window(fs, fs->fatbase + (clst / (SS(fs) / 4))) != FR_OK) break;
- val = ld_dword(fs->win + clst * 4 % SS(fs)) & 0x0FFFFFFF;
- break;
- #if _FS_EXFAT
- case FS_EXFAT :
- if ((obj->objsize != 0 && obj->sclust != 0) || obj->stat == 0) {
- DWORD cofs = clst - obj->sclust;
- DWORD clen = (DWORD)((obj->objsize - 1) / SS(fs)) / fs->csize;
- if (obj->stat == 2) {
- if (cofs <= clen) {
- val = (cofs == clen) ? 0x7FFFFFFF : clst + 1;
- break;
- }
- }
- if (obj->stat == 3 && cofs < obj->n_cont) {
- val = clst + 1;
- break;
- }
- if (obj->stat != 2) {
- if (move_window(fs, fs->fatbase + (clst / (SS(fs) / 4))) != FR_OK) break;
- val = ld_dword(fs->win + clst * 4 % SS(fs)) & 0x7FFFFFFF;
- break;
- }
- }
-
- #endif
- default:
- val = 1;
- }
- }
- return val;
- }
- #if !_FS_READONLY
- static
- FRESULT put_fat (
- FATFS* fs,
- DWORD clst,
- DWORD val
- )
- {
- UINT bc;
- BYTE *p;
- FRESULT res = FR_INT_ERR;
- if (clst >= 2 && clst < fs->n_fatent) {
- switch (fs->fs_type) {
- case FS_FAT12 :
- bc = (UINT)clst; bc += bc / 2;
- res = move_window(fs, fs->fatbase + (bc / SS(fs)));
- if (res != FR_OK) break;
- p = fs->win + bc++ % SS(fs);
- *p = (clst & 1) ? ((*p & 0x0F) | ((BYTE)val << 4)) : (BYTE)val;
- fs->wflag = 1;
- res = move_window(fs, fs->fatbase + (bc / SS(fs)));
- if (res != FR_OK) break;
- p = fs->win + bc % SS(fs);
- *p = (clst & 1) ? (BYTE)(val >> 4) : ((*p & 0xF0) | ((BYTE)(val >> 8) & 0x0F));
- fs->wflag = 1;
- break;
- case FS_FAT16 :
- res = move_window(fs, fs->fatbase + (clst / (SS(fs) / 2)));
- if (res != FR_OK) break;
- st_word(fs->win + clst * 2 % SS(fs), (WORD)val);
- fs->wflag = 1;
- break;
- case FS_FAT32 :
- #if _FS_EXFAT
- case FS_EXFAT :
- #endif
- res = move_window(fs, fs->fatbase + (clst / (SS(fs) / 4)));
- if (res != FR_OK) break;
- if (!_FS_EXFAT || fs->fs_type != FS_EXFAT) {
- val = (val & 0x0FFFFFFF) | (ld_dword(fs->win + clst * 4 % SS(fs)) & 0xF0000000);
- }
- st_dword(fs->win + clst * 4 % SS(fs), val);
- fs->wflag = 1;
- break;
- }
- }
- return res;
- }
- #endif
- #if _FS_EXFAT && !_FS_READONLY
- static
- DWORD find_bitmap (
- FATFS* fs,
- DWORD clst,
- DWORD ncl
- )
- {
- BYTE bm, bv;
- UINT i;
- DWORD val, scl, ctr;
- clst -= 2;
- if (clst >= fs->n_fatent - 2) clst = 0;
- scl = val = clst; ctr = 0;
- for (;;) {
- if (move_window(fs, fs->database + val / 8 / SS(fs)) != FR_OK) return 0xFFFFFFFF;
- i = val / 8 % SS(fs); bm = 1 << (val % 8);
- do {
- do {
- bv = fs->win[i] & bm; bm <<= 1;
- if (++val >= fs->n_fatent - 2) {
- val = 0; bm = 0; i = 4096;
- }
- if (!bv) {
- if (++ctr == ncl) return scl + 2;
- } else {
- scl = val; ctr = 0;
- }
- if (val == clst) return 0;
- } while (bm);
- bm = 1;
- } while (++i < SS(fs));
- }
- }
- static
- FRESULT change_bitmap (
- FATFS* fs,
- DWORD clst,
- DWORD ncl,
- int bv
- )
- {
- BYTE bm;
- UINT i;
- DWORD sect;
- clst -= 2;
- sect = fs->database + clst / 8 / SS(fs);
- i = clst / 8 % SS(fs);
- bm = 1 << (clst % 8);
- for (;;) {
- if (move_window(fs, sect++) != FR_OK) return FR_DISK_ERR;
- do {
- do {
- if (bv == (int)((fs->win[i] & bm) != 0)) return FR_INT_ERR;
- fs->win[i] ^= bm;
- fs->wflag = 1;
- if (--ncl == 0) return FR_OK;
- } while (bm <<= 1);
- bm = 1;
- } while (++i < SS(fs));
- i = 0;
- }
- }
- static
- FRESULT fill_fat_chain (
- _FDID* obj
- )
- {
- FRESULT res;
- DWORD cl, n;
- if (obj->stat == 3) {
- for (cl = obj->sclust, n = obj->n_cont; n; cl++, n--) {
- res = put_fat(obj->fs, cl, cl + 1);
- if (res != FR_OK) return res;
- }
- obj->stat = 0;
- }
- return FR_OK;
- }
- #endif
- #if !_FS_READONLY
- static
- FRESULT remove_chain (
- _FDID* obj,
- DWORD clst,
- DWORD pclst
- )
- {
- FRESULT res = FR_OK;
- DWORD nxt;
- FATFS *fs = obj->fs;
- #if _FS_EXFAT || _USE_TRIM
- DWORD scl = clst, ecl = clst;
- #endif
- #if _USE_TRIM
- DWORD rt[2];
- #endif
- if (clst < 2 || clst >= fs->n_fatent) return FR_INT_ERR;
-
- if (pclst && (!_FS_EXFAT || fs->fs_type != FS_EXFAT || obj->stat != 2)) {
- res = put_fat(fs, pclst, 0xFFFFFFFF);
- if (res != FR_OK) return res;
- }
-
- do {
- nxt = get_fat(obj, clst);
- if (nxt == 0) break;
- if (nxt == 1) return FR_INT_ERR;
- if (nxt == 0xFFFFFFFF) return FR_DISK_ERR;
- if (!_FS_EXFAT || fs->fs_type != FS_EXFAT) {
- res = put_fat(fs, clst, 0);
- if (res != FR_OK) return res;
- }
- #if _FS_FAST_CHECK_NO_FREE_CLUSTER
-
- fs->no_free_clst = 0;
- #endif
- if (fs->free_clst < fs->n_fatent - 2) {
- fs->free_clst++;
- fs->fsi_flag |= 1;
- }
- #if _FS_EXFAT || _USE_TRIM
- if (ecl + 1 == nxt) {
- ecl = nxt;
- } else {
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- res = change_bitmap(fs, scl, ecl - scl + 1, 0);
- if (res != FR_OK) return res;
- }
- #endif
- #if _USE_TRIM
- rt[0] = clust2sect(fs, scl);
- rt[1] = clust2sect(fs, ecl) + fs->csize - 1;
- disk_ioctl(fs->drv, CTRL_TRIM, rt);
- #endif
- scl = ecl = nxt;
- }
- #endif
- clst = nxt;
- } while (clst < fs->n_fatent);
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- if (pclst == 0) {
- obj->stat = 0;
- } else {
- if (obj->stat == 3 && pclst >= obj->sclust && pclst <= obj->sclust + obj->n_cont) {
- obj->stat = 2;
- }
- }
- }
- #endif
- return FR_OK;
- }
- static
- DWORD create_chain (
- _FDID* obj,
- DWORD clst
- )
- {
- DWORD cs, ncl, scl;
- FRESULT res;
- FATFS *fs = obj->fs;
- #if _FS_FAST_CHECK_NO_FREE_CLUSTER
- if (fs->no_free_clst) {
-
- return 0;
- }
- #endif
- if (clst == 0) {
- scl = fs->last_clst;
- if (scl == 0 || scl >= fs->n_fatent) scl = 1;
- }
- else {
- cs = get_fat(obj, clst);
- if (cs < 2) return 1;
- if (cs == 0xFFFFFFFF) return cs;
- if (cs < fs->n_fatent) return cs;
- scl = clst;
- }
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- ncl = find_bitmap(fs, scl, 1);
- if (ncl == 0 || ncl == 0xFFFFFFFF) {
- #if _FS_FAST_CHECK_NO_FREE_CLUSTER
- if (ncl == 0) {
-
- fs->no_free_clst = 1;
- }
- #endif
- return ncl;
- }
- res = change_bitmap(fs, ncl, 1, 1);
- if (res == FR_INT_ERR) return 1;
- if (res == FR_DISK_ERR) return 0xFFFFFFFF;
- if (clst == 0) {
- obj->stat = 2;
- } else {
- if (obj->stat == 2 && ncl != scl + 1) {
- obj->n_cont = scl - obj->sclust;
- obj->stat = 3;
- }
- }
- } else
- #endif
- {
- ncl = scl;
- for (;;) {
- ncl++;
- if (ncl >= fs->n_fatent) {
- ncl = 2;
- if (ncl > scl) {
- #if _FS_FAST_CHECK_NO_FREE_CLUSTER
-
- fs->no_free_clst = 1;
- #endif
- return 0;
- }
- }
- cs = get_fat(obj, ncl);
- if (cs == 0) break;
- if (cs == 1 || cs == 0xFFFFFFFF) return cs;
- if (ncl == scl) {
- #if _FS_FAST_CHECK_NO_FREE_CLUSTER
-
- fs->no_free_clst = 1;
- #endif
- return 0;
- }
- }
- }
- if (_FS_EXFAT && fs->fs_type == FS_EXFAT && obj->stat == 2) {
- res = FR_OK;
- } else {
- res = put_fat(fs, ncl, 0xFFFFFFFF);
- if (res == FR_OK && clst) {
- res = put_fat(fs, clst, ncl);
- }
- }
- if (res == FR_OK) {
- fs->last_clst = ncl;
- if (fs->free_clst < fs->n_fatent - 2) fs->free_clst--;
- fs->fsi_flag |= 1;
- } else {
- ncl = (res == FR_DISK_ERR) ? 0xFFFFFFFF : 1;
- }
- return ncl;
- }
- #endif
- #if _USE_FASTSEEK
- static
- DWORD clmt_clust (
- FIL* fp,
- FSIZE_t ofs
- )
- {
- DWORD cl, ncl, *tbl;
- FATFS *fs = fp->obj.fs;
- tbl = fp->cltbl + 1;
- cl = (DWORD)(ofs / SS(fs) / fs->csize);
- for (;;) {
- ncl = *tbl++;
- if (ncl == 0) return 0;
- if (cl < ncl) break;
- cl -= ncl; tbl++;
- }
- return cl + *tbl;
- }
- #endif
- static
- FRESULT dir_sdi (
- DIR* dp,
- DWORD ofs
- )
- {
- DWORD csz, clst;
- FATFS *fs = dp->obj.fs;
- if (ofs >= (DWORD)((_FS_EXFAT && fs->fs_type == FS_EXFAT) ? MAX_DIR_EX : MAX_DIR) || ofs % SZDIRE) {
- return FR_INT_ERR;
- }
- dp->dptr = ofs;
- clst = dp->obj.sclust;
- if (clst == 0 && fs->fs_type >= FS_FAT32) {
- clst = fs->dirbase;
- if (_FS_EXFAT) dp->obj.stat = 0;
- }
- if (clst == 0) {
- if (ofs / SZDIRE >= fs->n_rootdir) return FR_INT_ERR;
- dp->sect = fs->dirbase;
- } else {
- csz = (DWORD)fs->csize * SS(fs);
- while (ofs >= csz) {
- clst = get_fat(&dp->obj, clst);
- if (clst == 0xFFFFFFFF) return FR_DISK_ERR;
- if (clst < 2 || clst >= fs->n_fatent) return FR_INT_ERR;
- ofs -= csz;
- }
- dp->sect = clust2sect(fs, clst);
- }
- dp->clust = clst;
- if (!dp->sect) return FR_INT_ERR;
- dp->sect += ofs / SS(fs);
- dp->dir = fs->win + (ofs % SS(fs));
- return FR_OK;
- }
- static
- FRESULT dir_next (
- DIR* dp,
- int stretch
- )
- {
- DWORD ofs, clst;
- FATFS *fs = dp->obj.fs;
- #if !_FS_READONLY
- UINT n;
- #endif
- ofs = dp->dptr + SZDIRE;
- if (!dp->sect || ofs >= (DWORD)((_FS_EXFAT && fs->fs_type == FS_EXFAT) ? MAX_DIR_EX : MAX_DIR)) return FR_NO_FILE;
- if (ofs % SS(fs) == 0) {
- dp->sect++;
- if (!dp->clust) {
- if (ofs / SZDIRE >= fs->n_rootdir) {
- dp->sect = 0; return FR_NO_FILE;
- }
- }
- else {
- if ((ofs / SS(fs) & (fs->csize - 1)) == 0) {
- clst = get_fat(&dp->obj, dp->clust);
- if (clst <= 1) return FR_INT_ERR;
- if (clst == 0xFFFFFFFF) return FR_DISK_ERR;
- if (clst >= fs->n_fatent) {
- #if !_FS_READONLY
- if (!stretch) {
- dp->sect = 0; return FR_NO_FILE;
- }
- clst = create_chain(&dp->obj, dp->clust);
- if (clst == 0) return FR_DENIED;
- if (clst == 1) return FR_INT_ERR;
- if (clst == 0xFFFFFFFF) return FR_DISK_ERR;
-
- if (_FS_EXFAT) dp->obj.stat |= 4;
- if (sync_window(fs) != FR_OK) return FR_DISK_ERR;
- mem_set(fs->win, 0, SS(fs));
- for (n = 0, fs->winsect = clust2sect(fs, clst); n < fs->csize; n++, fs->winsect++) {
- fs->wflag = 1;
- if (sync_window(fs) != FR_OK) return FR_DISK_ERR;
- }
- fs->winsect -= n;
- #else
- if (!stretch) dp->sect = 0;
- dp->sect = 0; return FR_NO_FILE;
- #endif
- }
- dp->clust = clst;
- dp->sect = clust2sect(fs, clst);
- }
- }
- }
- dp->dptr = ofs;
- dp->dir = fs->win + ofs % SS(fs);
- return FR_OK;
- }
- #if !_FS_READONLY
- static
- FRESULT dir_alloc (
- DIR* dp,
- UINT nent
- )
- {
- FRESULT res;
- UINT n;
- FATFS *fs = dp->obj.fs;
- res = dir_sdi(dp, 0);
- if (res == FR_OK) {
- n = 0;
- do {
- res = move_window(fs, dp->sect);
- if (res != FR_OK) break;
- #if _FS_EXFAT
- if ((fs->fs_type == FS_EXFAT) ? (int)((dp->dir[XDIR_Type] & 0x80) == 0) : (int)(dp->dir[DIR_Name] == DDEM || dp->dir[DIR_Name] == 0)) {
- #else
- if (dp->dir[DIR_Name] == DDEM || dp->dir[DIR_Name] == 0) {
- #endif
- if (++n == nent) break;
- } else {
- n = 0;
- }
- res = dir_next(dp, 1);
- } while (res == FR_OK);
- }
- if (res == FR_NO_FILE) res = FR_DENIED;
- return res;
- }
- #endif
- static
- DWORD ld_clust (
- FATFS* fs,
- const BYTE* dir
- )
- {
- DWORD cl;
- cl = ld_word(dir + DIR_FstClusLO);
- if (fs->fs_type == FS_FAT32) {
- cl |= (DWORD)ld_word(dir + DIR_FstClusHI) << 16;
- }
- return cl;
- }
- #if !_FS_READONLY
- static
- void st_clust (
- FATFS* fs,
- BYTE* dir,
- DWORD cl
- )
- {
- st_word(dir + DIR_FstClusLO, (WORD)cl);
- if (fs->fs_type == FS_FAT32) {
- st_word(dir + DIR_FstClusHI, (WORD)(cl >> 16));
- }
- }
- #endif
- #if _USE_LFN != 0
- static
- const BYTE LfnOfs[] = {1,3,5,7,9,14,16,18,20,22,24,28,30};
- static
- int cmp_lfn (
- const WCHAR* lfnbuf,
- BYTE* dir
- )
- {
- UINT i, s;
- WCHAR wc, uc;
- if (ld_word(dir + LDIR_FstClusLO) != 0) return 0;
- i = ((dir[LDIR_Ord] & 0x3F) - 1) * 13;
- for (wc = 1, s = 0; s < 13; s++) {
- uc = ld_word(dir + LfnOfs[s]);
- if (wc) {
- if (i >= _MAX_LFN || ff_wtoupper(uc) != ff_wtoupper(lfnbuf[i++])) {
- return 0;
- }
- wc = uc;
- } else {
- if (uc != 0xFFFF) return 0;
- }
- }
- if ((dir[LDIR_Ord] & LLEF) && wc && lfnbuf[i]) return 0;
- return 1;
- }
- #if _FS_MINIMIZE <= 1 || _FS_RPATH >= 2 || _USE_LABEL || _FS_EXFAT
- static
- int pick_lfn (
- WCHAR* lfnbuf,
- BYTE* dir
- )
- {
- UINT i, s;
- WCHAR wc, uc;
- if (ld_word(dir + LDIR_FstClusLO) != 0) return 0;
- i = ((dir[LDIR_Ord] & 0x3F) - 1) * 13;
- for (wc = 1, s = 0; s < 13; s++) {
- uc = ld_word(dir + LfnOfs[s]);
- if (wc) {
- if (i >= _MAX_LFN) return 0;
- lfnbuf[i++] = wc = uc;
- } else {
- if (uc != 0xFFFF) return 0;
- }
- }
- if (dir[LDIR_Ord] & LLEF) {
- if (i >= _MAX_LFN) return 0;
- lfnbuf[i] = 0;
- }
- return 1;
- }
- #endif
- #if !_FS_READONLY
- static
- void put_lfn (
- const WCHAR* lfn,
- BYTE* dir,
- BYTE ord,
- BYTE sum
- )
- {
- UINT i, s;
- WCHAR wc;
- dir[LDIR_Chksum] = sum;
- dir[LDIR_Attr] = AM_LFN;
- dir[LDIR_Type] = 0;
- st_word(dir + LDIR_FstClusLO, 0);
- i = (ord - 1) * 13;
- s = wc = 0;
- do {
- if (wc != 0xFFFF) wc = lfn[i++];
- st_word(dir + LfnOfs[s], wc);
- if (wc == 0) wc = 0xFFFF;
- } while (++s < 13);
- if (wc == 0xFFFF || !lfn[i]) ord |= LLEF;
- dir[LDIR_Ord] = ord;
- }
- #endif
- #endif
- #if _USE_LFN != 0 && !_FS_READONLY
- static
- void gen_numname (
- BYTE* dst,
- const BYTE* src,
- const WCHAR* lfn,
- UINT seq
- )
- {
- BYTE ns[8], c;
- UINT i, j;
- WCHAR wc;
- DWORD sr;
- mem_cpy(dst, src, 11);
- if (seq > 5) {
- sr = seq;
- while (*lfn) {
- wc = *lfn++;
- for (i = 0; i < 16; i++) {
- sr = (sr << 1) + (wc & 1);
- wc >>= 1;
- if (sr & 0x10000) sr ^= 0x11021;
- }
- }
- seq = (UINT)sr;
- }
-
- i = 7;
- do {
- c = (BYTE)((seq % 16) + '0');
- if (c > '9') c += 7;
- ns[i--] = c;
- seq /= 16;
- } while (seq);
- ns[i] = '~';
-
- for (j = 0; j < i && dst[j] != ' '; j++) {
- if (IsDBCS1(dst[j])) {
- if (j == i - 1) break;
- j++;
- }
- }
- do {
- dst[j++] = (i < 8) ? ns[i++] : ' ';
- } while (j < 8);
- }
- #endif
- #if _USE_LFN != 0
- static
- BYTE sum_sfn (
- const BYTE* dir
- )
- {
- BYTE sum = 0;
- UINT n = 11;
- do sum = (sum >> 1) + (sum << 7) + *dir++; while (--n);
- return sum;
- }
- #endif
- #if _FS_EXFAT
- static
- WORD xdir_sum (
- const BYTE* dir
- )
- {
- UINT i, szblk;
- WORD sum;
- szblk = (dir[XDIR_NumSec] + 1) * SZDIRE;
- for (i = sum = 0; i < szblk; i++) {
- if (i == XDIR_SetSum) {
- i++;
- } else {
- sum = ((sum & 1) ? 0x8000 : 0) + (sum >> 1) + dir[i];
- }
- }
- return sum;
- }
- static
- WORD xname_sum (
- const WCHAR* name
- )
- {
- WCHAR chr;
- WORD sum = 0;
- while ((chr = *name++) != 0) {
- chr = ff_wtoupper(chr);
- sum = ((sum & 1) ? 0x8000 : 0) + (sum >> 1) + (chr & 0xFF);
- sum = ((sum & 1) ? 0x8000 : 0) + (sum >> 1) + (chr >> 8);
- }
- return sum;
- }
- #if !_FS_READONLY && _USE_MKFS
- static
- DWORD xsum32 (
- BYTE dat,
- DWORD sum
- )
- {
- sum = ((sum & 1) ? 0x80000000 : 0) + (sum >> 1) + dat;
- return sum;
- }
- #endif
- #if _FS_MINIMIZE <= 1 || _FS_RPATH >= 2
- static
- void get_xdir_info (
- BYTE* dirb,
- FILINFO* fno
- )
- {
- UINT di, si;
- WCHAR w;
- #if !_LFN_UNICODE
- UINT nc;
- #endif
-
- #if _LFN_UNICODE
- if (dirb[XDIR_NumName] <= _MAX_LFN) {
- for (si = SZDIRE * 2, di = 0; di < dirb[XDIR_NumName]; si += 2, di++) {
- if ((si % SZDIRE) == 0) si += 2;
- w = ld_word(dirb + si);
- fno->fname[di] = w;
- }
- } else {
- di = 0;
- }
- #else
- for (si = SZDIRE * 2, di = nc = 0; nc < dirb[XDIR_NumName]; si += 2, nc++) {
- if ((si % SZDIRE) == 0) si += 2;
- w = ld_word(dirb + si);
- #if _USE_UTF8
-
- int count;
- u32_t utf8;
- count = nls_utf8_uni2char(w, (u8_t *)&utf8, 3);
- if (count <= 0) {
- di = 0;
- break;
- } else if (count == 1) {
- w = *((u8_t *)&utf8);
- } else if (count == 2) {
- fno->fname[di++] = *(u8_t *)&utf8;
- w = *((u8_t *)&utf8 + 1);
- } else if (count == 3) {
- fno->fname[di++] = *((u8_t *)&utf8);
- fno->fname[di++] = *((u8_t *)&utf8 + 1);
- w = *((u8_t *)&utf8 + 2);
- }
- #else
- w = ff_convert(w, 0);
- if (w == 0) { di = 0; break; }
- if (_DF1S && w >= 0x100) {
- fno->fname[di++] = (char)(w >> 8);
- }
- #endif
- if (di >= _MAX_LFN) { di = 0; break; }
- fno->fname[di++] = (char)w;
- }
- #endif
- if (di == 0) fno->fname[di++] = '?';
- fno->fname[di] = 0;
- fno->altname[0] = 0;
- fno->fattrib = dirb[XDIR_Attr];
- fno->fsize = (fno->fattrib & AM_DIR) ? 0 : ld_qword(dirb + XDIR_FileSize);
- fno->ftime = ld_word(dirb + XDIR_ModTime + 0);
- fno->fdate = ld_word(dirb + XDIR_ModTime + 2);
- }
- #endif
- static
- FRESULT load_xdir (
- DIR* dp
- )
- {
- FRESULT res;
- UINT i, nent;
- BYTE* dirb = dp->obj.fs->dirbuf;
-
- res = move_window(dp->obj.fs, dp->sect);
- if (res != FR_OK) return res;
- if (dp->dir[XDIR_Type] != 0x85) return FR_INT_ERR;
- mem_cpy(dirb, dp->dir, SZDIRE);
- nent = dirb[XDIR_NumSec] + 1;
-
- res = dir_next(dp, 0);
- if (res != FR_OK) return res;
- res = move_window(dp->obj.fs, dp->sect);
- if (res != FR_OK) return res;
- if (dp->dir[XDIR_Type] != 0xC0) return FR_INT_ERR;
- mem_cpy(dirb + SZDIRE, dp->dir, SZDIRE);
-
- if (nent < 3 || nent > 19) return FR_NO_FILE;
- i = SZDIRE * 2; nent *= SZDIRE;
- do {
- res = dir_next(dp, 0);
- if (res != FR_OK) return res;
- res = move_window(dp->obj.fs, dp->sect);
- if (res != FR_OK) return res;
- if (dp->dir[XDIR_Type] != 0xC1) return FR_INT_ERR;
- mem_cpy(dirb + i, dp->dir, SZDIRE);
- i += SZDIRE;
- } while (i < nent);
-
- if (xdir_sum(dirb) != ld_word(dirb + XDIR_SetSum)) return FR_INT_ERR;
- return FR_OK;
- }
- #if !_FS_READONLY || _FS_RPATH != 0
- static
- FRESULT load_obj_dir (
- DIR* dp,
- const _FDID* obj
- )
- {
- FRESULT res;
-
- dp->obj.fs = obj->fs;
- dp->obj.sclust = obj->c_scl;
- dp->obj.stat = (BYTE)obj->c_size;
- dp->obj.objsize = obj->c_size & 0xFFFFFF00;
- dp->blk_ofs = obj->c_ofs;
- res = dir_sdi(dp, dp->blk_ofs);
- if (res == FR_OK) {
- res = load_xdir(dp);
- }
- return res;
- }
- #endif
- #if !_FS_READONLY
- static
- FRESULT store_xdir (
- DIR* dp
- )
- {
- FRESULT res;
- UINT nent;
- BYTE* dirb = dp->obj.fs->dirbuf;
-
- st_word(dirb + XDIR_SetSum, xdir_sum(dirb));
- nent = dirb[XDIR_NumSec] + 1;
-
- res = dir_sdi(dp, dp->blk_ofs);
- while (res == FR_OK) {
- res = move_window(dp->obj.fs, dp->sect);
- if (res != FR_OK) break;
- mem_cpy(dp->dir, dirb, SZDIRE);
- dp->obj.fs->wflag = 1;
- if (--nent == 0) break;
- dirb += SZDIRE;
- res = dir_next(dp, 0);
- }
- return (res == FR_OK || res == FR_DISK_ERR) ? res : FR_INT_ERR;
- }
- static
- void create_xdir (
- BYTE* dirb,
- const WCHAR* lfn
- )
- {
- UINT i;
- BYTE nb, nc;
- WCHAR chr;
- mem_set(dirb, 0, 2 * SZDIRE);
- dirb[XDIR_Type] = 0x85;
- dirb[XDIR_Type + SZDIRE] = 0xC0;
- st_word(dirb + XDIR_NameHash, xname_sum(lfn));
- i = SZDIRE * 2;
- nc = 0; nb = 1; chr = 1;
- do {
- dirb[i++] = 0xC1; dirb[i++] = 0;
- do {
- if (chr && (chr = lfn[nc]) != 0) nc++;
- st_word(dirb + i, chr); i += 2;
- } while (i % SZDIRE);
- nb++;
- } while (lfn[nc]);
- dirb[XDIR_NumName] = nc;
- dirb[XDIR_NumSec] = nb;
- }
- #endif
- #endif
- #if _FS_MINIMIZE <= 1 || _FS_RPATH >= 2 || _USE_LABEL || _FS_EXFAT
- static
- FRESULT dir_read (
- DIR* dp,
- int vol
- )
- {
- FRESULT res = FR_NO_FILE;
- FATFS *fs = dp->obj.fs;
- BYTE a, c;
- #if _USE_LFN != 0
- BYTE ord = 0xFF, sum = 0xFF;
- #endif
- while (dp->sect) {
- res = move_window(fs, dp->sect);
- if (res != FR_OK) break;
- c = dp->dir[DIR_Name];
- if (c == 0) { res = FR_NO_FILE; break; }
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- if (_USE_LABEL && vol) {
- if (c == 0x83) break;
- } else {
- if (c == 0x85) {
- dp->blk_ofs = dp->dptr;
- res = load_xdir(dp);
- if (res == FR_OK) {
- dp->obj.attr = fs->dirbuf[XDIR_Attr] & AM_MASK;
- }
- break;
- }
- }
- } else
- #endif
- {
- dp->obj.attr = a = dp->dir[DIR_Attr] & AM_MASK;
- #if _USE_LFN != 0
- if (c == DDEM || c == '.' || (int)((a & ~AM_ARC) == AM_VOL) != vol) {
- ord = 0xFF;
- } else {
- if (a == AM_LFN) {
- if (c & LLEF) {
- sum = dp->dir[LDIR_Chksum];
- c &= (BYTE)~LLEF; ord = c;
- dp->blk_ofs = dp->dptr;
- }
-
- ord = (c == ord && sum == dp->dir[LDIR_Chksum] && pick_lfn(fs->lfnbuf, dp->dir)) ? ord - 1 : 0xFF;
- } else {
- if (ord || sum != sum_sfn(dp->dir)) {
- dp->blk_ofs = 0xFFFFFFFF;
- }
- break;
- }
- }
- #else
- if (c != DDEM && c != '.' && a != AM_LFN && (int)((a & ~AM_ARC) == AM_VOL) == vol) {
- break;
- }
- #endif
- }
- res = dir_next(dp, 0);
- if (res != FR_OK) break;
- }
- if (res != FR_OK) dp->sect = 0;
- return res;
- }
- #endif
- static
- FRESULT dir_find (
- DIR* dp
- )
- {
- FRESULT res;
- FATFS *fs = dp->obj.fs;
- BYTE c;
- #if _USE_LFN != 0
- BYTE a, ord, sum;
- #endif
- res = dir_sdi(dp, 0);
- if (res != FR_OK) return res;
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- BYTE nc;
- UINT di, ni;
- WORD hash = xname_sum(fs->lfnbuf);
- while ((res = dir_read(dp, 0)) == FR_OK) {
- if (ld_word(fs->dirbuf + XDIR_NameHash) != hash) continue;
- for (nc = fs->dirbuf[XDIR_NumName], di = SZDIRE * 2, ni = 0; nc; nc--, di += 2, ni++) {
- if ((di % SZDIRE) == 0) di += 2;
- if (ff_wtoupper(ld_word(fs->dirbuf + di)) != ff_wtoupper(fs->lfnbuf[ni])) break;
- }
- if (nc == 0 && !fs->lfnbuf[ni]) break;
- }
- return res;
- }
- #endif
-
- #if _USE_LFN != 0
- ord = sum = 0xFF; dp->blk_ofs = 0xFFFFFFFF;
- #endif
- do {
- res = move_window(fs, dp->sect);
- if (res != FR_OK) break;
- c = dp->dir[DIR_Name];
- if (c == 0) { res = FR_NO_FILE; break; }
- #if _USE_LFN != 0
- dp->obj.attr = a = dp->dir[DIR_Attr] & AM_MASK;
- if (c == DDEM || ((a & AM_VOL) && a != AM_LFN)) {
- ord = 0xFF; dp->blk_ofs = 0xFFFFFFFF;
- } else {
- if (a == AM_LFN) {
- if (!(dp->fn[NSFLAG] & NS_NOLFN)) {
- if (c & LLEF) {
- sum = dp->dir[LDIR_Chksum];
- c &= (BYTE)~LLEF; ord = c;
- dp->blk_ofs = dp->dptr;
- }
-
- ord = (c == ord && sum == dp->dir[LDIR_Chksum] && cmp_lfn(fs->lfnbuf, dp->dir)) ? ord - 1 : 0xFF;
- }
- } else {
- if (!ord && sum == sum_sfn(dp->dir)) break;
- if (!(dp->fn[NSFLAG] & NS_LOSS) && !mem_cmp(dp->dir, dp->fn, 11)) break;
- ord = 0xFF; dp->blk_ofs = 0xFFFFFFFF;
- }
- }
- #else
- dp->obj.attr = dp->dir[DIR_Attr] & AM_MASK;
- if (!(dp->dir[DIR_Attr] & AM_VOL) && !mem_cmp(dp->dir, dp->fn, 11)) break;
- #endif
- res = dir_next(dp, 0);
- } while (res == FR_OK);
- return res;
- }
- #if !_FS_READONLY
- static
- FRESULT dir_register (
- DIR* dp
- )
- {
- FRESULT res;
- FATFS *fs = dp->obj.fs;
- #if _USE_LFN != 0
- UINT n, nlen, nent;
- BYTE sn[12], sum;
- if (dp->fn[NSFLAG] & (NS_DOT | NS_NONAME)) return FR_INVALID_NAME;
- for (nlen = 0; fs->lfnbuf[nlen]; nlen++) ;
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- DIR dj;
- nent = (nlen + 14) / 15 + 2;
- res = dir_alloc(dp, nent);
- if (res != FR_OK) return res;
- dp->blk_ofs = dp->dptr - SZDIRE * (nent - 1);
- if (dp->obj.sclust != 0 && (dp->obj.stat & 4)) {
- dp->obj.stat &= 3;
- dp->obj.objsize += (DWORD)fs->csize * SS(fs);
- res = fill_fat_chain(&dp->obj);
- if (res != FR_OK) return res;
- res = load_obj_dir(&dj, &dp->obj);
- if (res != FR_OK) return res;
- st_qword(fs->dirbuf + XDIR_FileSize, dp->obj.objsize);
- st_qword(fs->dirbuf + XDIR_ValidFileSize, dp->obj.objsize);
- fs->dirbuf[XDIR_GenFlags] = dp->obj.stat | 1;
- res = store_xdir(&dj);
- if (res != FR_OK) return res;
- }
- create_xdir(fs->dirbuf, fs->lfnbuf);
- return FR_OK;
- }
- #endif
-
- mem_cpy(sn, dp->fn, 12);
- if (sn[NSFLAG] & NS_LOSS) {
- dp->fn[NSFLAG] = NS_NOLFN;
- for (n = 1; n < 100; n++) {
- gen_numname(dp->fn, sn, fs->lfnbuf, n);
- res = dir_find(dp);
- if (res != FR_OK) break;
- }
- if (n == 100) return FR_DENIED;
- if (res != FR_NO_FILE) return res;
- dp->fn[NSFLAG] = sn[NSFLAG];
- }
-
- nent = (sn[NSFLAG] & NS_LFN) ? (nlen + 12) / 13 + 1 : 1;
- res = dir_alloc(dp, nent);
- if (res == FR_OK && --nent) {
- res = dir_sdi(dp, dp->dptr - nent * SZDIRE);
- if (res == FR_OK) {
- sum = sum_sfn(dp->fn);
- do {
- res = move_window(fs, dp->sect);
- if (res != FR_OK) break;
- put_lfn(fs->lfnbuf, dp->dir, (BYTE)nent, sum);
- fs->wflag = 1;
- res = dir_next(dp, 0);
- } while (res == FR_OK && --nent);
- }
- }
- #else
- res = dir_alloc(dp, 1);
- #endif
-
- if (res == FR_OK) {
- res = move_window(fs, dp->sect);
- if (res == FR_OK) {
- mem_set(dp->dir, 0, SZDIRE);
- mem_cpy(dp->dir + DIR_Name, dp->fn, 11);
- #if _USE_LFN != 0
- dp->dir[DIR_NTres] = dp->fn[NSFLAG] & (NS_BODY | NS_EXT);
- #endif
- fs->wflag = 1;
- }
- }
- return res;
- }
- #endif
- #if !_FS_READONLY && _FS_MINIMIZE == 0
- static
- FRESULT dir_remove (
- DIR* dp
- )
- {
- FRESULT res;
- FATFS *fs = dp->obj.fs;
- #if _USE_LFN != 0
- DWORD last = dp->dptr;
- res = (dp->blk_ofs == 0xFFFFFFFF) ? FR_OK : dir_sdi(dp, dp->blk_ofs);
- if (res == FR_OK) {
- do {
- res = move_window(fs, dp->sect);
- if (res != FR_OK) break;
-
- if (_FS_EXFAT && fs->fs_type == FS_EXFAT) {
- dp->dir[XDIR_Type] &= 0x7F;
- } else {
- dp->dir[DIR_Name] = DDEM;
- }
- fs->wflag = 1;
- if (dp->dptr >= last) break;
- res = dir_next(dp, 0);
- } while (res == FR_OK);
- if (res == FR_NO_FILE) res = FR_INT_ERR;
- }
- #else
- res = move_window(fs, dp->sect);
- if (res == FR_OK) {
- dp->dir[DIR_Name] = DDEM;
- fs->wflag = 1;
- }
- #endif
- return res;
- }
- #endif
- #if _FS_MINIMIZE <= 1 || _FS_RPATH >= 2
- static
- void get_fileinfo (
- DIR* dp,
- FILINFO* fno
- )
- {
- UINT i, j;
- TCHAR c;
- DWORD tm;
- #if _USE_LFN != 0
- WCHAR w, lfv;
- FATFS *fs = dp->obj.fs;
- #endif
- fno->fname[0] = 0;
- if (!dp->sect) return;
- #if _USE_LFN != 0
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- get_xdir_info(fs->dirbuf, fno);
- return;
- } else
- #endif
- {
- if (dp->blk_ofs != 0xFFFFFFFF) {
- i = j = 0;
- while ((w = fs->lfnbuf[j++]) != 0) {
- #if !_LFN_UNICODE
- #if _USE_UTF8
-
- int count;
- u32_t utf8;
- count = nls_utf8_uni2char(w, (u8_t *)&utf8, 3);
- if (count <= 0) {
- i = 0;
- break;
- } else if (count == 1) {
- w = *((u8_t *)&utf8);
- } else if (count == 2) {
- fno->fname[i++] = *(u8_t *)&utf8;
- w = *((u8_t *)&utf8 + 1);
- } else if (count == 3) {
- fno->fname[i++] = *((u8_t *)&utf8);
- fno->fname[i++] = *((u8_t *)&utf8 + 1);
- w = *((u8_t *)&utf8 + 2);
- }
- #else
- w = ff_convert(w, 0);
- if (w == 0) { i = 0; break; }
- if (_DF1S && w >= 0x100) {
- fno->fname[i++] = (char)(w >> 8);
- }
- #endif
- #endif
- if (i >= _MAX_LFN) { i = 0; break; }
- fno->fname[i++] = (TCHAR)w;
- }
- fno->fname[i] = 0;
- } else {
- dp->blk_ofs = dp->dptr;
- }
- }
- i = j = 0;
- lfv = fno->fname[i];
- while (i < 11) {
- c = (TCHAR)dp->dir[i++];
- if (c == ' ') continue;
- if (c == RDDEM) c = (TCHAR)DDEM;
- if (i == 9) {
- if (!lfv) fno->fname[j] = '.';
- fno->altname[j++] = '.';
- }
- #if _LFN_UNICODE
- if (IsDBCS1(c) && i != 8 && i != 11 && IsDBCS2(dp->dir[i])) {
- c = c << 8 | dp->dir[i++];
- }
- c = ff_convert(c, 1);
- if (!c) c = '?';
- #endif
- fno->altname[j] = c;
- if (!lfv) {
- if (IsUpper(c) && (dp->dir[DIR_NTres] & (i >= 9 ? NS_EXT : NS_BODY))) {
- c += 0x20;
- }
- fno->fname[j] = c;
- }
- j++;
- }
- if (!lfv) {
- fno->fname[j] = 0;
- if (!dp->dir[DIR_NTres]) j = 0;
- }
- fno->altname[j] = 0;
- #else
- i = j = 0;
- while (i < 11) {
- c = (TCHAR)dp->dir[i++];
- if (c == ' ') continue;
- if (c == RDDEM) c = (TCHAR)DDEM;
- if (i == 9) fno->fname[j++] = '.';
- fno->fname[j++] = c;
- }
- fno->fname[j] = 0;
- #endif
- fno->fattrib = dp->dir[DIR_Attr];
- fno->fsize = ld_dword(dp->dir + DIR_FileSize);
- tm = ld_dword(dp->dir + DIR_ModTime);
- fno->ftime = (WORD)tm; fno->fdate = (WORD)(tm >> 16);
- }
- #endif
- #if _USE_FIND && _FS_MINIMIZE <= 1
- static
- WCHAR get_achar (
- const TCHAR** ptr
- )
- {
- #if !_LFN_UNICODE
- WCHAR chr;
- chr = (BYTE)*(*ptr)++;
- if (IsLower(chr)) chr -= 0x20;
- #ifdef _EXCVT
- if (chr >= 0x80) chr = ExCvt[chr - 0x80];
- #else
- if (IsDBCS1(chr) && IsDBCS2(**ptr)) {
- chr = chr << 8 | (BYTE)*(*ptr)++;
- }
- #endif
- return chr;
- #else
- return ff_wtoupper(*(*ptr)++);
- #endif
- }
- static
- int pattern_matching (
- const TCHAR* pat,
- const TCHAR* nam,
- int skip,
- int inf
- )
- {
- const TCHAR *pp, *np;
- WCHAR pc, nc;
- int nm, nx;
- while (skip--) {
- if (!get_achar(&nam)) return 0;
- }
- if (!*pat && inf) return 1;
- do {
- pp = pat; np = nam;
- for (;;) {
- if (*pp == '?' || *pp == '*') {
- nm = nx = 0;
- do {
- if (*pp++ == '?') nm++; else nx = 1;
- } while (*pp == '?' || *pp == '*');
- if (pattern_matching(pp, np, nm, nx)) return 1;
- nc = *np; break;
- }
- pc = get_achar(&pp);
- nc = get_achar(&np);
- if (pc != nc) break;
- if (pc == 0) return 1;
- }
- get_achar(&nam);
- } while (inf && nc);
- return 0;
- }
- #endif
- static
- FRESULT create_name (
- DIR* dp,
- const TCHAR** path
- )
- {
- #if _USE_LFN != 0
- BYTE b, cf;
- WCHAR w, *lfn;
- UINT i, ni, si, di;
- const TCHAR *p;
-
- p = *path; lfn = dp->obj.fs->lfnbuf; si = di = 0;
- for (;;) {
- w = p[si++];
- if (w < ' ') break;
- if (w == '/' || w == '\\') {
- while (p[si] == '/' || p[si] == '\\') si++;
- break;
- }
- if (di >= _MAX_LFN) return FR_INVALID_NAME;
- #if !_LFN_UNICODE
- #if _USE_UTF8
-
- int count;
- count = nls_utf8_char2uni((const u8_t *)&p[--si], 3, &w);
- if (count < 0) {
- return FR_INVALID_NAME;
- }
- si += count;
- #else
- w &= 0xFF;
- if (IsDBCS1(w)) {
- b = (BYTE)p[si++];
- w = (w << 8) + b;
- if (!IsDBCS2(b)) return FR_INVALID_NAME;
- }
- w = ff_convert(w, 1);
- if (!w) return FR_INVALID_NAME;
- #endif
- #endif
- if (w < 0x80 && chk_chr("\"*:<>\?|\x7F", w)) return FR_INVALID_NAME;
- lfn[di++] = w;
- }
- *path = &p[si];
- cf = (w < ' ') ? NS_LAST : 0;
- #if _FS_RPATH != 0
- if ((di == 1 && lfn[di - 1] == '.') ||
- (di == 2 && lfn[di - 1] == '.' && lfn[di - 2] == '.')) {
- lfn[di] = 0;
- for (i = 0; i < 11; i++)
- dp->fn[i] = (i < di) ? '.' : ' ';
- dp->fn[i] = cf | NS_DOT;
- return FR_OK;
- }
- #endif
- while (di) {
- w = lfn[di - 1];
- if (w != ' ' && w != '.') break;
- di--;
- }
- lfn[di] = 0;
- if (di == 0) return FR_INVALID_NAME;
-
- mem_set(dp->fn, ' ', 11);
- for (si = 0; lfn[si] == ' ' || lfn[si] == '.'; si++) ;
- if (si) cf |= NS_LOSS | NS_LFN;
- while (di && lfn[di - 1] != '.') di--;
- i = b = 0; ni = 8;
- for (;;) {
- w = lfn[si++];
- if (!w) break;
- if (w == ' ' || (w == '.' && si != di)) {
- cf |= NS_LOSS | NS_LFN; continue;
- }
- if (i >= ni || si == di) {
- if (ni == 11) {
- cf |= NS_LOSS | NS_LFN; break;
- }
- if (si != di) cf |= NS_LOSS | NS_LFN;
- if (si > di) break;
- si = di; i = 8; ni = 11;
- b <<= 2; continue;
- }
- if (w >= 0x80) {
- #ifdef _EXCVT
- w = ff_convert(w, 0);
- if (w) w = ExCvt[w - 0x80];
- #else
- w = ff_convert(ff_wtoupper(w), 0);
- #endif
- cf |= NS_LFN;
- }
- if (_DF1S && w >= 0x100) {
- if (i >= ni - 1) {
- cf |= NS_LOSS | NS_LFN; i = ni; continue;
- }
- dp->fn[i++] = (BYTE)(w >> 8);
- } else {
- if (!w || chk_chr("+,;=[]", w)) {
- w = '_'; cf |= NS_LOSS | NS_LFN;
- } else {
- if (IsUpper(w)) {
- b |= 2;
- } else {
- if (IsLower(w)) {
- b |= 1; w -= 0x20;
- }
- }
- }
- }
- dp->fn[i++] = (BYTE)w;
- }
- if (dp->fn[0] == DDEM) dp->fn[0] = RDDEM;
- if (ni == 8) b <<= 2;
- if ((b & 0x0C) == 0x0C || (b & 0x03) == 0x03) cf |= NS_LFN;
- if (!(cf & NS_LFN)) {
- if ((b & 0x03) == 0x01) cf |= NS_EXT;
- if ((b & 0x0C) == 0x04) cf |= NS_BODY;
- }
- dp->fn[NSFLAG] = cf;
- return FR_OK;
- #else
- BYTE c, d, *sfn;
- UINT ni, si, i;
- const char *p;
-
- p = *path; sfn = dp->fn;
- mem_set(sfn, ' ', 11);
- si = i = 0; ni = 8;
- #if _FS_RPATH != 0
- if (p[si] == '.') {
- for (;;) {
- c = (BYTE)p[si++];
- if (c != '.' || si >= 3) break;
- sfn[i++] = c;
- }
- if (c != '/' && c != '\\' && c > ' ') return FR_INVALID_NAME;
- *path = p + si;
- sfn[NSFLAG] = (c <= ' ') ? NS_LAST | NS_DOT : NS_DOT;
- return FR_OK;
- }
- #endif
- for (;;) {
- c = (BYTE)p[si++];
- if (c <= ' ') break;
- if (c == '/' || c == '\\') {
- while (p[si] == '/' || p[si] == '\\') si++;
- break;
- }
- if (c == '.' || i >= ni) {
- if (ni == 11 || c != '.') return FR_INVALID_NAME;
- i = 8; ni = 11;
- continue;
- }
- if (c >= 0x80) {
- #ifdef _EXCVT
- c = ExCvt[c - 0x80];
- #else
- #if !_DF1S
- return FR_INVALID_NAME;
- #endif
- #endif
- }
- if (IsDBCS1(c)) {
- d = (BYTE)p[si++];
- if (!IsDBCS2(d) || i >= ni - 1) return FR_INVALID_NAME;
- sfn[i++] = c;
- sfn[i++] = d;
- } else {
- if (chk_chr("\"*+,:;<=>\?[]|\x7F", c)) return FR_INVALID_NAME;
- if (IsLower(c)) c -= 0x20;
- sfn[i++] = c;
- }
- }
- *path = p + si;
- if (i == 0) return FR_INVALID_NAME;
- if (sfn[0] == DDEM) sfn[0] = RDDEM;
- sfn[NSFLAG] = (c <= ' ') ? NS_LAST : 0;
- return FR_OK;
- #endif
- }
- static
- FRESULT follow_path (
- DIR* dp,
- const TCHAR* path
- )
- {
- FRESULT res;
- BYTE ns;
- _FDID *obj = &dp->obj;
- FATFS *fs = obj->fs;
- #if _FS_RPATH != 0
- if (*path != '/' && *path != '\\') {
- obj->sclust = fs->cdir;
- } else
- #endif
- {
- while (*path == '/' || *path == '\\') path++;
- obj->sclust = 0;
- }
- #if _FS_EXFAT && _FS_RPATH != 0
- if (fs->fs_type == FS_EXFAT && obj->sclust) {
- DIR dj;
- obj->c_scl = fs->cdc_scl;
- obj->c_size = fs->cdc_size;
- obj->c_ofs = fs->cdc_ofs;
- res = load_obj_dir(&dj, obj);
- if (res != FR_OK) return res;
- obj->objsize = ld_dword(fs->dirbuf + XDIR_FileSize);
- obj->stat = fs->dirbuf[XDIR_GenFlags] & 2;
- }
- #endif
- if ((UINT)*path < ' ') {
- dp->fn[NSFLAG] = NS_NONAME;
- res = dir_sdi(dp, 0);
- } else {
- for (;;) {
- res = create_name(dp, &path);
- if (res != FR_OK) break;
- res = dir_find(dp);
- ns = dp->fn[NSFLAG];
- if (res != FR_OK) {
- if (res == FR_NO_FILE) {
- if (_FS_RPATH && (ns & NS_DOT)) {
- if (!(ns & NS_LAST)) continue;
- dp->fn[NSFLAG] = NS_NONAME;
- res = FR_OK;
- } else {
- if (!(ns & NS_LAST)) res = FR_NO_PATH;
- }
- }
- break;
- }
- if (ns & NS_LAST) break;
-
- if (!(obj->attr & AM_DIR)) {
- res = FR_NO_PATH; break;
- }
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- obj->c_scl = obj->sclust;
- obj->c_size = ((DWORD)obj->objsize & 0xFFFFFF00) | obj->stat;
- obj->c_ofs = dp->blk_ofs;
- obj->sclust = ld_dword(fs->dirbuf + XDIR_FstClus);
- obj->stat = fs->dirbuf[XDIR_GenFlags] & 2;
- obj->objsize = ld_qword(fs->dirbuf + XDIR_FileSize);
- } else
- #endif
- {
- obj->sclust = ld_clust(fs, fs->win + dp->dptr % SS(fs));
- }
- }
- }
- return res;
- }
- static
- int get_ldnumber (
- const TCHAR** path
- )
- {
- const TCHAR *tp, *tt;
- UINT i;
- int vol = -1;
- #if _STR_VOLUME_ID
- static const char* const str[] = {_VOLUME_STRS};
- const char *sp;
- char c;
- TCHAR tc;
- #endif
- if (*path) {
- for (tt = *path; (UINT)*tt >= (_USE_LFN ? ' ' : '!') && *tt != ':'; tt++) ;
- if (*tt == ':') {
- tp = *path;
- i = *tp++ - '0';
- if (i < 10 && tp == tt) {
- if (i < _VOLUMES) {
- vol = (int)i;
- *path = ++tt;
- }
- }
- #if _STR_VOLUME_ID
- else {
- i = 0; tt++;
- do {
- sp = str[i]; tp = *path;
- do {
- c = *sp++; tc = *tp++;
- if (IsLower(tc)) tc -= 0x20;
- } while (c && (TCHAR)c == tc);
- } while ((c || tp != tt) && ++i < _VOLUMES);
- if (i < _VOLUMES) {
- vol = (int)i;
- *path = tt;
- }
- }
- #endif
- return vol;
- }
- #if _FS_RPATH != 0 && _VOLUMES >= 2
- vol = CurrVol;
- #else
- vol = 0;
- #endif
- }
- return vol;
- }
- static
- BYTE check_fs (
- FATFS* fs,
- DWORD sect
- )
- {
- fs->wflag = 0; fs->winsect = 0xFFFFFFFF;
- if (move_window(fs, sect) != FR_OK) return 4;
- if (ld_word(fs->win + BS_55AA) != 0xAA55) return 3;
- if (fs->win[BS_JmpBoot] == 0xE9 || (fs->win[BS_JmpBoot] == 0xEB && fs->win[BS_JmpBoot + 2] == 0x90)) {
- if ((ld_dword(fs->win + BS_FilSysType) & 0xFFFFFF) == 0x544146) return 0;
- if (ld_dword(fs->win + BS_FilSysType32) == 0x33544146) return 0;
- }
- #if _FS_EXFAT
- if (!mem_cmp(fs->win + BS_JmpBoot, "\xEB\x76\x90" "EXFAT ", 11)) return 1;
- #endif
- return 2;
- }
- static
- FRESULT find_volume (
- const TCHAR** path,
- FATFS** rfs,
- BYTE mode
- )
- {
- BYTE fmt, old_fmt, *pt;
- int vol;
- DSTATUS stat;
- DWORD bsect, fasize, tsect, sysect, nclst, szbfat, br[4];
- WORD nrsv;
- FATFS *fs;
- UINT i;
-
- *rfs = 0;
- vol = get_ldnumber(path);
- if (vol < 0) return FR_INVALID_DRIVE;
-
- fs = FatFs[vol];
- if (!fs) return FR_NOT_ENABLED;
- ENTER_FF(fs);
- *rfs = fs;
- mode &= (BYTE)~FA_READ;
- if (fs->fs_type) {
- stat = disk_status(fs->drv);
- if (!(stat & STA_NOINIT)) {
- if (!_FS_READONLY && mode && (stat & STA_PROTECT)) {
- return FR_WRITE_PROTECTED;
- }
- return FR_OK;
- }
- }
-
-
- fs->fs_type = 0;
- fs->drv = LD2PD(vol);
- stat = disk_initialize(fs->drv);
- if (stat & STA_NOINIT) {
- return FR_NOT_READY;
- }
- if (!_FS_READONLY && mode && (stat & STA_PROTECT)) {
- return FR_WRITE_PROTECTED;
- }
- #if _MAX_SS != _MIN_SS
- if (disk_ioctl(fs->drv, GET_SECTOR_SIZE, &SS(fs)) != RES_OK) return FR_DISK_ERR;
- if (SS(fs) > _MAX_SS || SS(fs) < _MIN_SS || (SS(fs) & (SS(fs) - 1))) return FR_DISK_ERR;
- #endif
-
- bsect = 0;
- fmt = check_fs(fs, bsect);
- old_fmt = fmt;
-
- if (fmt <= 2) {
- for (i = 0; i < 4; i++) {
- pt = fs->win + (MBR_Table + i * SZ_PTE);
-
- if (pt[0] != 0x0 && pt[0] != 0x80) {
-
- br[i] = 0;
- } else {
- br[i] = pt[PTE_System] ? ld_dword(pt + PTE_StLba) : 0;
- }
- }
- i = LD2PT(vol);
- if (i) i--;
- do {
- bsect = br[i];
- fmt = bsect ? check_fs(fs, bsect) : 3;
- } while (!LD2PT(vol) && fmt >= 2 && ++i < 4);
- }
-
- if (fmt >= 2) {
- fmt = old_fmt;
- }
- if (fmt == 4) return FR_DISK_ERR;
- if (fmt >= 2) return FR_NO_FILESYSTEM;
-
- #if _FS_EXFAT
- if (fmt == 1) {
- QWORD maxlba;
- for (i = BPB_ZeroedEx; i < BPB_ZeroedEx + 53 && fs->win[i] == 0; i++) ;
- if (i < BPB_ZeroedEx + 53) return FR_NO_FILESYSTEM;
- if (ld_word(fs->win + BPB_FSVerEx) != 0x100) return FR_NO_FILESYSTEM;
- if (1 << fs->win[BPB_BytsPerSecEx] != SS(fs))
- return FR_NO_FILESYSTEM;
- maxlba = ld_qword(fs->win + BPB_TotSecEx) + bsect;
- if (maxlba >= 0x100000000) return FR_NO_FILESYSTEM;
- fs->fsize = ld_dword(fs->win + BPB_FatSzEx);
- fs->n_fats = fs->win[BPB_NumFATsEx];
- if (fs->n_fats != 1) return FR_NO_FILESYSTEM;
- fs->csize = 1 << fs->win[BPB_SecPerClusEx];
- if (fs->csize == 0) return FR_NO_FILESYSTEM;
- nclst = ld_dword(fs->win + BPB_NumClusEx);
- if (nclst > MAX_EXFAT) return FR_NO_FILESYSTEM;
- fs->n_fatent = nclst + 2;
-
- fs->volbase = bsect;
- fs->database = bsect + ld_dword(fs->win + BPB_DataOfsEx);
- fs->fatbase = bsect + ld_dword(fs->win + BPB_FatOfsEx);
- if (maxlba < (QWORD)fs->database + nclst * fs->csize) return FR_NO_FILESYSTEM;
- fs->dirbase = ld_dword(fs->win + BPB_RootClusEx);
-
- if (move_window(fs, clust2sect(fs, fs->dirbase)) != FR_OK) return FR_DISK_ERR;
- for (i = 0; i < SS(fs); i += SZDIRE) {
- if (fs->win[i] == 0x81 && ld_dword(fs->win + i + 20) == 2) break;
- }
- if (i == SS(fs)) return FR_NO_FILESYSTEM;
- #if !_FS_READONLY
- fs->last_clst = fs->free_clst = 0xFFFFFFFF;
- #endif
- fmt = FS_EXFAT;
- } else
- #endif
- {
- if (ld_word(fs->win + BPB_BytsPerSec) != SS(fs)) return FR_NO_FILESYSTEM;
- fasize = ld_word(fs->win + BPB_FATSz16);
- if (fasize == 0) fasize = ld_dword(fs->win + BPB_FATSz32);
- fs->fsize = fasize;
- fs->n_fats = fs->win[BPB_NumFATs];
- if (fs->n_fats != 1 && fs->n_fats != 2) return FR_NO_FILESYSTEM;
- fasize *= fs->n_fats;
- fs->csize = fs->win[BPB_SecPerClus];
- if (fs->csize == 0 || (fs->csize & (fs->csize - 1))) return FR_NO_FILESYSTEM;
- fs->n_rootdir = ld_word(fs->win + BPB_RootEntCnt);
- if (fs->n_rootdir % (SS(fs) / SZDIRE)) return FR_NO_FILESYSTEM;
- tsect = ld_word(fs->win + BPB_TotSec16);
- if (tsect == 0) tsect = ld_dword(fs->win + BPB_TotSec32);
- nrsv = ld_word(fs->win + BPB_RsvdSecCnt);
- if (nrsv == 0) return FR_NO_FILESYSTEM;
-
- sysect = nrsv + fasize + fs->n_rootdir / (SS(fs) / SZDIRE);
- if (tsect < sysect) return FR_NO_FILESYSTEM;
- nclst = (tsect - sysect) / fs->csize;
- if (nclst == 0) return FR_NO_FILESYSTEM;
- fmt = FS_FAT32;
- if (nclst <= MAX_FAT16) fmt = FS_FAT16;
- if (nclst <= MAX_FAT12) fmt = FS_FAT12;
-
- fs->n_fatent = nclst + 2;
- fs->volbase = bsect;
- fs->fatbase = bsect + nrsv;
- fs->database = bsect + sysect;
- if (fmt == FS_FAT32) {
- if (ld_word(fs->win + BPB_FSVer32) != 0) return FR_NO_FILESYSTEM;
- if (fs->n_rootdir) return FR_NO_FILESYSTEM;
- fs->dirbase = ld_dword(fs->win + BPB_RootClus32);
- szbfat = fs->n_fatent * 4;
- } else {
- if (fs->n_rootdir == 0) return FR_NO_FILESYSTEM;
- fs->dirbase = fs->fatbase + fasize;
- szbfat = (fmt == FS_FAT16) ?
- fs->n_fatent * 2 : fs->n_fatent * 3 / 2 + (fs->n_fatent & 1);
- }
- if (fs->fsize < (szbfat + (SS(fs) - 1)) / SS(fs)) return FR_NO_FILESYSTEM;
- #if !_FS_READONLY
-
- fs->last_clst = fs->free_clst = 0xFFFFFFFF;
- fs->fsi_flag = 0x80;
- #if (_FS_NOFSINFO & 3) != 3
- if (fmt == FS_FAT32
- && ld_word(fs->win + BPB_FSInfo32) == 1
- && move_window(fs, bsect + 1) == FR_OK)
- {
- fs->fsi_flag = 0;
- if (ld_word(fs->win + BS_55AA) == 0xAA55
- && ld_dword(fs->win + FSI_LeadSig) == 0x41615252
- && ld_dword(fs->win + FSI_StrucSig) == 0x61417272)
- {
- #if (_FS_NOFSINFO & 1) == 0
- fs->free_clst = ld_dword(fs->win + FSI_Free_Count);
- #endif
- #if (_FS_NOFSINFO & 2) == 0
- fs->last_clst = ld_dword(fs->win + FSI_Nxt_Free);
- #endif
- }
- }
- #endif
- #endif
- }
- fs->fs_type = fmt;
- fs->id = ++Fsid;
- #if _USE_LFN == 1
- fs->lfnbuf = LfnBuf;
- #if _FS_EXFAT
- fs->dirbuf = DirBuf;
- #endif
- #endif
- #if _FS_RPATH != 0
- fs->cdir = 0;
- #endif
- #if _FS_LOCK != 0
- clear_lock(fs);
- #endif
- return FR_OK;
- }
- static
- FRESULT validate (
- _FDID* obj,
- FATFS** fs
- )
- {
- FRESULT res;
- if (!obj || !obj->fs || !obj->fs->fs_type || obj->fs->id != obj->id || (disk_status(obj->fs->drv) & STA_NOINIT)) {
- *fs = 0;
- res = FR_INVALID_OBJECT;
- } else {
- *fs = obj->fs;
- ENTER_FF(obj->fs);
- res = FR_OK;
- }
- return res;
- }
- FRESULT f_mount (
- FATFS* fs,
- const TCHAR* path,
- BYTE opt
- )
- {
- FATFS *cfs;
- int vol;
- FRESULT res;
- const TCHAR *rp = path;
-
- vol = get_ldnumber(&rp);
- if (vol < 0) return FR_INVALID_DRIVE;
- cfs = FatFs[vol];
- if (cfs) {
- if (fs != 0) {
- return FR_OK;
- }
- disk_ioctl(cfs->drv, CTRL_SYNC, 0);
- #if _FS_REENTRANT
- lock_fs(cfs);
- #endif
- FatFs[vol] = 0;
- cfs->fs_type = 0;
- #if _FS_LOCK != 0
- clear_lock(cfs);
- #endif
- #if _FS_REENTRANT
- unlock_fs(cfs, FR_OK);
- #endif
- #if _FS_REENTRANT
- if (!ff_del_syncobj(cfs->sobj)) return FR_INT_ERR;
- #if 0
-
- cfs->sobj = 0;
- #endif
- #endif
- return FR_OK;
- }
- if (fs) {
- fs->fs_type = 0;
- #if _FS_REENTRANT
- if (!ff_cre_syncobj((BYTE)vol, &fs->sobj)) return FR_INT_ERR;
- #endif
- }
- FatFs[vol] = fs;
- #if _FS_FAST_CHECK_NO_FREE_CLUSTER
- if (fs) {
-
- fs->no_free_clst = 0;
- }
- #endif
- if (!fs || opt != 1) return FR_OK;
- res = find_volume(&path, &fs, 0);
- #if _FS_REENTRANT
- unlock_fs(fs, res);
- #endif
- if (res != FR_OK) {
- #if _FS_REENTRANT
- ff_del_syncobj(fs->sobj);
- #if 0
-
- fs->sobj = 0;
- #endif
- #endif
- FatFs[vol] = 0;
- }
- return res;
- }
- FRESULT f_open_cluster(
- FIL* fp,
- const TCHAR* path,
- DWORD cluster,
- DWORD blk_ofs,
- BYTE mode
- )
- {
- FRESULT res;
- DIR dj;
- FATFS *fs;
- #if !_FS_READONLY
- DWORD bcs, clst, sc;
- FSIZE_t ofs;
- #endif
- DEF_NAMBUF
- if (!fp) return FR_INVALID_OBJECT;
-
- mode &= _FS_READONLY ? FA_READ : FA_READ | FA_WRITE | FA_CREATE_ALWAYS | FA_CREATE_NEW | FA_OPEN_ALWAYS | FA_OPEN_APPEND | FA_SEEKEND;
- res = find_volume(&path, &fs, mode);
- if (res == FR_OK) {
- dj.obj.fs = fs;
- INIT_NAMBUF(fs);
- dj.obj.sclust = cluster;
- dj.blk_ofs = blk_ofs;
- res = dir_sdi(&dj, dj.blk_ofs);
- if (res == FR_OK) {
- res = dir_read(&dj, 0);
- #if !_FS_READONLY
- if (res == FR_OK) {
- #if _FS_LOCK != 0
- res = chk_lock(&dj, (mode & ~FA_READ) ? 1 : 0);
- #endif
- }
- if (res == FR_OK) {
- if (dj.obj.attr & AM_DIR) {
- res = FR_NO_FILE;
- } else {
- if ((mode & FA_WRITE) && (dj.obj.attr & AM_RDO)) {
- res = FR_DENIED;
- }
- }
- }
- if (res == FR_OK) {
- if (mode & FA_CREATE_ALWAYS)
- mode |= FA_MODIFIED;
- fp->dir_sect = fs->winsect;
- fp->dir_ptr = dj.dir;
- #if _FS_LOCK != 0
- fp->obj.lockid = inc_lock(&dj, (mode & ~FA_READ) ? 1 : 0);
- if (!fp->obj.lockid) res = FR_INT_ERR;
- #endif
- }
- #else
- if (res == FR_OK) {
- if (dj.obj.attr & AM_DIR) {
- res = FR_NO_FILE;
- }
- }
- #endif
- }
- if (res == FR_OK) {
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- fp->obj.sclust = ld_dword(fs->dirbuf + XDIR_FstClus);
- fp->obj.objsize = ld_qword(fs->dirbuf + XDIR_FileSize);
- fp->obj.stat = fs->dirbuf[XDIR_GenFlags] & 2;
- fp->obj.c_scl = dj.obj.sclust;
- fp->obj.c_size = ((DWORD)dj.obj.objsize & 0xFFFFFF00) | dj.obj.stat;
- fp->obj.c_ofs = dj.blk_ofs;
- } else
- #endif
- {
- fp->obj.sclust = ld_clust(fs, dj.dir);
- fp->obj.objsize = ld_dword(dj.dir + DIR_FileSize);
- }
- #if _USE_FASTSEEK
- fp->cltbl = 0;
- #endif
- fp->obj.fs = fs;
- fp->obj.id = fs->id;
- fp->flag = mode;
- fp->err = 0;
- fp->sect = 0;
- fp->fptr = 0;
- #if !_FS_READONLY
- #if !_FS_TINY
- mem_set(fp->buf, 0, _MAX_SS);
- #endif
- if ((mode & FA_SEEKEND) && fp->obj.objsize > 0) {
- fp->fptr = fp->obj.objsize;
- bcs = (DWORD)fs->csize * SS(fs);
- clst = fp->obj.sclust;
- for (ofs = fp->obj.objsize; res == FR_OK && ofs > bcs; ofs -= bcs) {
- clst = get_fat(&fp->obj, clst);
- if (clst <= 1) res = FR_INT_ERR;
- if (clst == 0xFFFFFFFF) res = FR_DISK_ERR;
- }
- fp->clust = clst;
- if (res == FR_OK && ofs % SS(fs)) {
- if ((sc = clust2sect(fs, clst)) == 0) {
- res = FR_INT_ERR;
- } else {
- fp->sect = sc + (DWORD)(ofs / SS(fs));
- #if !_FS_TINY
- if (disk_read(fs->drv, fp->buf, fp->sect, 1) != RES_OK) res = FR_DISK_ERR;
- #endif
- }
- }
- }
- #endif
- }
- FREE_NAMBUF();
- }
- if (res != FR_OK) fp->obj.fs = 0;
- LEAVE_FF(fs, res);
- }
- FRESULT f_open (
- FIL* fp,
- const TCHAR* path,
- BYTE mode
- )
- {
- FRESULT res;
- DIR dj;
- FATFS *fs;
- #if !_FS_READONLY
- DWORD dw, cl, bcs, clst, sc;
- FSIZE_t ofs;
- #endif
- DEF_NAMBUF
- if (!fp) return FR_INVALID_OBJECT;
-
- mode &= _FS_READONLY ? FA_READ : FA_READ | FA_WRITE | FA_CREATE_ALWAYS | FA_CREATE_NEW | FA_OPEN_ALWAYS | FA_OPEN_APPEND | FA_SEEKEND;
- res = find_volume(&path, &fs, mode);
- if (res == FR_OK) {
- dj.obj.fs = fs;
- INIT_NAMBUF(fs);
- res = follow_path(&dj, path);
- #if !_FS_READONLY
- if (res == FR_OK) {
- if (dj.fn[NSFLAG] & NS_NONAME) {
- res = FR_INVALID_NAME;
- }
- #if _FS_LOCK != 0
- else {
- res = chk_lock(&dj, (mode & ~FA_READ) ? 1 : 0);
- }
- #endif
- }
-
- if (mode & (FA_CREATE_ALWAYS | FA_OPEN_ALWAYS | FA_CREATE_NEW)) {
- if (res != FR_OK) {
- if (res == FR_NO_FILE)
- #if _FS_LOCK != 0
- res = enq_lock() ? dir_register(&dj) : FR_TOO_MANY_OPEN_FILES;
- #else
- res = dir_register(&dj);
- #endif
- mode |= FA_CREATE_ALWAYS;
- }
- else {
- if (dj.obj.attr & (AM_RDO | AM_DIR)) {
- res = FR_DENIED;
- } else {
- if (mode & FA_CREATE_NEW) res = FR_EXIST;
- }
- }
- if (res == FR_OK && (mode & FA_CREATE_ALWAYS)) {
- dw = GET_FATTIME();
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
-
- fp->obj.fs = fs;
- fp->obj.sclust = ld_dword(fs->dirbuf + XDIR_FstClus);
- fp->obj.objsize = ld_qword(fs->dirbuf + XDIR_FileSize);
- fp->obj.stat = fs->dirbuf[XDIR_GenFlags] & 2;
-
- st_dword(fs->dirbuf + XDIR_CrtTime, dw);
- fs->dirbuf[XDIR_CrtTime10] = 0;
- st_dword(fs->dirbuf + XDIR_ModTime, dw);
- fs->dirbuf[XDIR_ModTime10] = 0;
- fs->dirbuf[XDIR_Attr] = AM_ARC;
- st_dword(fs->dirbuf + XDIR_FstClus, 0);
- st_qword(fs->dirbuf + XDIR_FileSize, 0);
- st_qword(fs->dirbuf + XDIR_ValidFileSize, 0);
- fs->dirbuf[XDIR_GenFlags] = 1;
- res = store_xdir(&dj);
- if (res == FR_OK && fp->obj.sclust) {
- res = remove_chain(&fp->obj, fp->obj.sclust, 0);
- fs->last_clst = fp->obj.sclust - 1;
- }
- } else
- #endif
- {
-
- st_dword(dj.dir + DIR_CrtTime, dw);
- st_dword(dj.dir + DIR_ModTime, dw);
- dj.dir[DIR_Attr] = AM_ARC;
- cl = ld_clust(fs, dj.dir);
- st_clust(fs, dj.dir, 0);
- st_dword(dj.dir + DIR_FileSize, 0);
- fs->wflag = 1;
- if (cl) {
- dw = fs->winsect;
- res = remove_chain(&dj.obj, cl, 0);
- if (res == FR_OK) {
- res = move_window(fs, dw);
- fs->last_clst = cl - 1;
- }
- }
- }
- }
- }
- else {
- if (res == FR_OK) {
- if (dj.obj.attr & AM_DIR) {
- res = FR_NO_FILE;
- } else {
- if ((mode & FA_WRITE) && (dj.obj.attr & AM_RDO)) {
- res = FR_DENIED;
- }
- }
- }
- }
- if (res == FR_OK) {
- if (mode & FA_CREATE_ALWAYS)
- mode |= FA_MODIFIED;
- fp->dir_sect = fs->winsect;
- fp->dir_ptr = dj.dir;
- #if _FS_LOCK != 0
- fp->obj.lockid = inc_lock(&dj, (mode & ~FA_READ) ? 1 : 0);
- if (!fp->obj.lockid) res = FR_INT_ERR;
- #endif
- }
- #else
- if (res == FR_OK) {
- if (dj.fn[NSFLAG] & NS_NONAME) {
- res = FR_INVALID_NAME;
- } else {
- if (dj.obj.attr & AM_DIR) {
- res = FR_NO_FILE;
- }
- }
- }
- #endif
- if (res == FR_OK) {
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- fp->obj.sclust = ld_dword(fs->dirbuf + XDIR_FstClus);
- fp->obj.objsize = ld_qword(fs->dirbuf + XDIR_FileSize);
- fp->obj.stat = fs->dirbuf[XDIR_GenFlags] & 2;
- fp->obj.c_scl = dj.obj.sclust;
- fp->obj.c_size = ((DWORD)dj.obj.objsize & 0xFFFFFF00) | dj.obj.stat;
- fp->obj.c_ofs = dj.blk_ofs;
- } else
- #endif
- {
- fp->obj.sclust = ld_clust(fs, dj.dir);
- fp->obj.objsize = ld_dword(dj.dir + DIR_FileSize);
- }
- #if _USE_FASTSEEK
- fp->cltbl = 0;
- #endif
- fp->obj.fs = fs;
- fp->obj.id = fs->id;
- fp->flag = mode;
- fp->err = 0;
- fp->sect = 0;
- fp->fptr = 0;
- #if !_FS_READONLY
- #if !_FS_TINY
- mem_set(fp->buf, 0, _MAX_SS);
- #endif
- if ((mode & FA_SEEKEND) && fp->obj.objsize > 0) {
- fp->fptr = fp->obj.objsize;
- bcs = (DWORD)fs->csize * SS(fs);
- clst = fp->obj.sclust;
- for (ofs = fp->obj.objsize; res == FR_OK && ofs > bcs; ofs -= bcs) {
- clst = get_fat(&fp->obj, clst);
- if (clst <= 1) res = FR_INT_ERR;
- if (clst == 0xFFFFFFFF) res = FR_DISK_ERR;
- }
- fp->clust = clst;
- if (res == FR_OK && ofs % SS(fs)) {
- if ((sc = clust2sect(fs, clst)) == 0) {
- res = FR_INT_ERR;
- } else {
- fp->sect = sc + (DWORD)(ofs / SS(fs));
- #if !_FS_TINY
- if (disk_read(fs->drv, fp->buf, fp->sect, 1) != RES_OK) res = FR_DISK_ERR;
- #endif
- }
- }
- }
- #endif
- }
- FREE_NAMBUF();
- }
- if (res != FR_OK) fp->obj.fs = 0;
- LEAVE_FF(fs, res);
- }
- FRESULT f_disk_detect(
- const TCHAR* path,
- BYTE *state
- )
- {
- FRESULT res = FR_OK;
- int vol;
-
- vol = get_ldnumber(&path);
- if (vol < 0) return FR_INVALID_DRIVE;
- if(disk_ioctl((BYTE)vol, DISK_HW_DETECT, state) != 0){
- res = FR_DISK_ERR;
- }
- return res;
- }
- FRESULT f_read (
- FIL* fp,
- void* buff,
- UINT btr,
- UINT* br
- )
- {
- FRESULT res;
- FATFS *fs;
- DWORD clst, sect;
- FSIZE_t remain;
- UINT rcnt, cc, csect;
- BYTE *rbuff = (BYTE*)buff;
- *br = 0;
- res = validate(&fp->obj, &fs);
- if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res);
- if (!(fp->flag & FA_READ)) LEAVE_FF(fs, FR_DENIED);
- remain = fp->obj.objsize - fp->fptr;
- if (btr > remain) btr = (UINT)remain;
- for ( ; btr;
- rbuff += rcnt, fp->fptr += rcnt, *br += rcnt, btr -= rcnt) {
- if (fp->fptr % SS(fs) == 0) {
- csect = (UINT)(fp->fptr / SS(fs) & (fs->csize - 1));
- if (csect == 0) {
- if (fp->fptr == 0) {
- clst = fp->obj.sclust;
- } else {
- #if _USE_FASTSEEK
- if (fp->cltbl) {
- clst = clmt_clust(fp, fp->fptr);
- } else
- #endif
- {
- clst = get_fat(&fp->obj, fp->clust);
- }
- }
- if (clst < 2) ABORT(fs, FR_INT_ERR);
- if (clst == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR);
- fp->clust = clst;
- }
- sect = clust2sect(fs, fp->clust);
- if (!sect) ABORT(fs, FR_INT_ERR);
- sect += csect;
- cc = btr / SS(fs);
- if (cc) {
- if (csect + cc > fs->csize) {
- cc = fs->csize - csect;
- }
- if (disk_read(fs->drv, rbuff, sect, cc) != RES_OK) ABORT(fs, FR_DISK_ERR);
- #if !_FS_READONLY && _FS_MINIMIZE <= 2
- #if _FS_TINY
- if (fs->wflag && fs->winsect - sect < cc) {
- mem_cpy(rbuff + ((fs->winsect - sect) * SS(fs)), fs->win, SS(fs));
- }
- #else
- if ((fp->flag & FA_DIRTY) && fp->sect - sect < cc) {
- mem_cpy(rbuff + ((fp->sect - sect) * SS(fs)), fp->buf, SS(fs));
- }
- #endif
- #endif
- rcnt = SS(fs) * cc;
- continue;
- }
- #if !_FS_TINY
- if (fp->sect != sect) {
- #if !_FS_READONLY
- if (fp->flag & FA_DIRTY) {
- if (disk_write(fs->drv, fp->buf, fp->sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR);
- fp->flag &= (BYTE)~FA_DIRTY;
- }
- #endif
- if (disk_read(fs->drv, fp->buf, sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR);
- }
- #endif
- fp->sect = sect;
- }
- rcnt = SS(fs) - (UINT)fp->fptr % SS(fs);
- if (rcnt > btr) rcnt = btr;
- #if _FS_TINY
- if (move_window(fs, fp->sect) != FR_OK) ABORT(fs, FR_DISK_ERR);
- mem_cpy(rbuff, fs->win + fp->fptr % SS(fs), rcnt);
- #else
- mem_cpy(rbuff, fp->buf + fp->fptr % SS(fs), rcnt);
- #endif
- }
- LEAVE_FF(fs, FR_OK);
- }
- #if !_FS_READONLY
- FRESULT f_write (
- FIL* fp,
- const void* buff,
- UINT btw,
- UINT* bw
- )
- {
- FRESULT res;
- FATFS *fs;
- DWORD clst, sect;
- UINT wcnt, cc, csect;
- const BYTE *wbuff = (const BYTE*)buff;
- *bw = 0;
- res = validate(&fp->obj, &fs);
- if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res);
- if (!(fp->flag & FA_WRITE)) LEAVE_FF(fs, FR_DENIED);
-
- if ((!_FS_EXFAT || fs->fs_type != FS_EXFAT) && (DWORD)(fp->fptr + btw) < (DWORD)fp->fptr) {
- btw = (UINT)(0xFFFFFFFF - (DWORD)fp->fptr);
- }
- for ( ; btw;
- wbuff += wcnt, fp->fptr += wcnt, fp->obj.objsize = (fp->fptr > fp->obj.objsize) ? fp->fptr : fp->obj.objsize, *bw += wcnt, btw -= wcnt) {
- if (fp->fptr % SS(fs) == 0) {
- csect = (UINT)(fp->fptr / SS(fs)) & (fs->csize - 1);
- if (csect == 0) {
- if (fp->fptr == 0) {
- clst = fp->obj.sclust;
- if (clst == 0) {
- clst = create_chain(&fp->obj, 0);
- }
- } else {
- #if _USE_FASTSEEK
- if (fp->cltbl) {
- clst = clmt_clust(fp, fp->fptr);
- } else
- #endif
- {
- clst = create_chain(&fp->obj, fp->clust);
- }
- }
- if (clst == 0) break;
- if (clst == 1) ABORT(fs, FR_INT_ERR);
- if (clst == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR);
- fp->clust = clst;
- if (fp->obj.sclust == 0) fp->obj.sclust = clst;
- }
- #if _FS_TINY
- if (fs->winsect == fp->sect && sync_window(fs) != FR_OK) ABORT(fs, FR_DISK_ERR);
- #else
- if (fp->flag & FA_DIRTY) {
- if (disk_write(fs->drv, fp->buf, fp->sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR);
- fp->flag &= (BYTE)~FA_DIRTY;
- }
- #endif
- sect = clust2sect(fs, fp->clust);
- if (!sect) ABORT(fs, FR_INT_ERR);
- sect += csect;
- cc = btw / SS(fs);
- if (cc) {
- if (csect + cc > fs->csize) {
- cc = fs->csize - csect;
- }
- if (disk_write(fs->drv, wbuff, sect, cc) != RES_OK) ABORT(fs, FR_DISK_ERR);
- #if _FS_MINIMIZE <= 2
- #if _FS_TINY
- if (fs->winsect - sect < cc) {
- mem_cpy(fs->win, wbuff + ((fs->winsect - sect) * SS(fs)), SS(fs));
- fs->wflag = 0;
- }
- #else
- if (fp->sect - sect < cc) {
- mem_cpy(fp->buf, wbuff + ((fp->sect - sect) * SS(fs)), SS(fs));
- fp->flag &= (BYTE)~FA_DIRTY;
- }
- #endif
- #endif
- wcnt = SS(fs) * cc;
- continue;
- }
- #if _FS_TINY
- if (fp->fptr >= fp->obj.objsize) {
- if (sync_window(fs) != FR_OK) ABORT(fs, FR_DISK_ERR);
- fs->winsect = sect;
- }
- #else
- if (fp->sect != sect &&
- fp->fptr < fp->obj.objsize &&
- disk_read(fs->drv, fp->buf, sect, 1) != RES_OK) {
- ABORT(fs, FR_DISK_ERR);
- }
- #endif
- fp->sect = sect;
- }
- wcnt = SS(fs) - (UINT)fp->fptr % SS(fs);
- if (wcnt > btw) wcnt = btw;
- #if _FS_TINY
- if (move_window(fs, fp->sect) != FR_OK) ABORT(fs, FR_DISK_ERR);
- mem_cpy(fs->win + fp->fptr % SS(fs), wbuff, wcnt);
- fs->wflag = 1;
- #else
- mem_cpy(fp->buf + fp->fptr % SS(fs), wbuff, wcnt);
- fp->flag |= FA_DIRTY;
- #endif
- }
- fp->flag |= FA_MODIFIED;
- LEAVE_FF(fs, FR_OK);
- }
- FRESULT f_sync (
- FIL* fp
- )
- {
- FRESULT res;
- FATFS *fs;
- DWORD tm;
- BYTE *dir;
- DEF_NAMBUF
- res = validate(&fp->obj, &fs);
- if (res == FR_OK) {
- if (fp->flag & FA_MODIFIED) {
- #if !_FS_TINY
- if (fp->flag & FA_DIRTY) {
- if (disk_write(fs->drv, fp->buf, fp->sect, 1) != RES_OK) LEAVE_FF(fs, FR_DISK_ERR);
- fp->flag &= (BYTE)~FA_DIRTY;
- }
- #endif
-
- tm = GET_FATTIME();
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- res = fill_fat_chain(&fp->obj);
- if (res == FR_OK) {
- DIR dj;
- INIT_NAMBUF(fs);
- res = load_obj_dir(&dj, &fp->obj);
- if (res == FR_OK) {
- fs->dirbuf[XDIR_Attr] |= AM_ARC;
- fs->dirbuf[XDIR_GenFlags] = fp->obj.stat | 1;
- st_dword(fs->dirbuf + XDIR_FstClus, fp->obj.sclust);
- st_qword(fs->dirbuf + XDIR_FileSize, fp->obj.objsize);
- st_qword(fs->dirbuf + XDIR_ValidFileSize, fp->obj.objsize);
- st_dword(fs->dirbuf + XDIR_ModTime, tm);
- fs->dirbuf[XDIR_ModTime10] = 0;
- st_dword(fs->dirbuf + XDIR_AccTime, 0);
- res = store_xdir(&dj);
- if (res == FR_OK) {
- res = sync_fs(fs);
- fp->flag &= (BYTE)~FA_MODIFIED;
- }
- }
- FREE_NAMBUF();
- }
- } else
- #endif
- {
- res = move_window(fs, fp->dir_sect);
- if (res == FR_OK) {
- dir = fp->dir_ptr;
- dir[DIR_Attr] |= AM_ARC;
- st_clust(fp->obj.fs, dir, fp->obj.sclust);
- st_dword(dir + DIR_FileSize, (DWORD)fp->obj.objsize);
- st_dword(dir + DIR_ModTime, tm);
- st_word(dir + DIR_LstAccDate, 0);
- fs->wflag = 1;
- res = sync_fs(fs);
- fp->flag &= (BYTE)~FA_MODIFIED;
- }
- }
- }
- }
- LEAVE_FF(fs, res);
- }
- #endif
- FRESULT f_close (
- FIL* fp
- )
- {
- FRESULT res;
- FATFS *fs;
- #if !_FS_READONLY
- res = f_sync(fp);
- if (res == FR_OK)
- #endif
- {
- res = validate(&fp->obj, &fs);
- if (res == FR_OK) {
- #if _FS_LOCK != 0
- res = dec_lock(fp->obj.lockid);
- if (res == FR_OK)
- #endif
- {
- fp->obj.fs = 0;
- }
- #if _FS_REENTRANT
- unlock_fs(fs, FR_OK);
- #endif
- }
- }
- return res;
- }
- #if _FS_RPATH >= 1
- #if _VOLUMES >= 2
- FRESULT f_chdrive (
- const TCHAR* path
- )
- {
- int vol;
-
- vol = get_ldnumber(&path);
- if (vol < 0) return FR_INVALID_DRIVE;
- CurrVol = (BYTE)vol;
- return FR_OK;
- }
- #endif
- FRESULT f_chdir (
- const TCHAR* path
- )
- {
- FRESULT res;
- DIR dj;
- FATFS *fs;
- DEF_NAMBUF
-
- res = find_volume(&path, &fs, 0);
- if (res == FR_OK) {
- dj.obj.fs = fs;
- INIT_NAMBUF(fs);
- res = follow_path(&dj, path);
- if (res == FR_OK) {
- if (dj.fn[NSFLAG] & NS_NONAME) {
- fs->cdir = dj.obj.sclust;
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- fs->cdc_scl = dj.obj.c_scl;
- fs->cdc_size = dj.obj.c_size;
- fs->cdc_ofs = dj.obj.c_ofs;
- }
- #endif
- } else {
- if (dj.obj.attr & AM_DIR) {
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- fs->cdir = ld_dword(fs->dirbuf + XDIR_FstClus);
- fs->cdc_scl = dj.obj.sclust;
- fs->cdc_size = ((DWORD)dj.obj.objsize & 0xFFFFFF00) | dj.obj.stat;
- fs->cdc_ofs = dj.blk_ofs;
- } else
- #endif
- {
- fs->cdir = ld_clust(fs, dj.dir);
- }
- } else {
- res = FR_NO_PATH;
- }
- }
- }
- FREE_NAMBUF();
- if (res == FR_NO_FILE) res = FR_NO_PATH;
- }
- LEAVE_FF(fs, res);
- }
- #if _FS_RPATH >= 2
- FRESULT f_getcwd (
- TCHAR* buff,
- UINT len
- )
- {
- FRESULT res;
- DIR dj;
- FATFS *fs;
- UINT i, n;
- DWORD ccl;
- TCHAR *tp;
- FILINFO fno;
- DEF_NAMBUF
- *buff = 0;
-
- res = find_volume((const TCHAR**)&buff, &fs, 0);
- if (res == FR_OK) {
- dj.obj.fs = fs;
- INIT_NAMBUF(fs);
- i = len;
- if (!_FS_EXFAT || fs->fs_type != FS_EXFAT) {
- dj.obj.sclust = fs->cdir;
- while ((ccl = dj.obj.sclust) != 0) {
- res = dir_sdi(&dj, 1 * SZDIRE);
- if (res != FR_OK) break;
- res = move_window(fs, dj.sect);
- if (res != FR_OK) break;
- dj.obj.sclust = ld_clust(fs, dj.dir);
- res = dir_sdi(&dj, 0);
- if (res != FR_OK) break;
- do {
- res = dir_read(&dj, 0);
- if (res != FR_OK) break;
- if (ccl == ld_clust(fs, dj.dir)) break;
- res = dir_next(&dj, 0);
- } while (res == FR_OK);
- if (res == FR_NO_FILE) res = FR_INT_ERR;
- if (res != FR_OK) break;
- get_fileinfo(&dj, &fno);
- for (n = 0; fno.fname[n]; n++) ;
- if (i < n + 3) {
- res = FR_NOT_ENOUGH_CORE; break;
- }
- while (n) buff[--i] = fno.fname[--n];
- buff[--i] = '/';
- }
- }
- tp = buff;
- if (res == FR_OK) {
- #if _VOLUMES >= 2
- *tp++ = '0' + CurrVol;
- *tp++ = ':';
- #endif
- if (i == len) {
- *tp++ = '/';
- } else {
- do
- *tp++ = buff[i++];
- while (i < len);
- }
- }
- *tp = 0;
- FREE_NAMBUF();
- }
- LEAVE_FF(fs, res);
- }
- #endif
- #endif
- #if _FS_MINIMIZE <= 2
- FRESULT f_lseek (
- FIL* fp,
- FSIZE_t ofs
- )
- {
- FRESULT res;
- FATFS *fs;
- DWORD clst, bcs, nsect;
- FSIZE_t ifptr;
- #if _USE_FASTSEEK
- DWORD cl, pcl, ncl, tcl, dsc, tlen, ulen, *tbl;
- #endif
- res = validate(&fp->obj, &fs);
- if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res);
- #if _USE_FASTSEEK
- if (fp->cltbl) {
- if (ofs == CREATE_LINKMAP) {
- tbl = fp->cltbl;
- tlen = *tbl++; ulen = 2;
- cl = fp->obj.sclust;
- if (cl) {
- do {
-
- tcl = cl; ncl = 0; ulen += 2;
- do {
- pcl = cl; ncl++;
- cl = get_fat(&fp->obj, cl);
- if (cl <= 1) ABORT(fs, FR_INT_ERR);
- if (cl == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR);
- } while (cl == pcl + 1);
- if (ulen <= tlen) {
- *tbl++ = ncl; *tbl++ = tcl;
- }
- } while (cl < fs->n_fatent);
- }
- *fp->cltbl = ulen;
- if (ulen <= tlen) {
- *tbl = 0;
- } else {
- res = FR_NOT_ENOUGH_CORE;
- }
- } else {
- if (ofs > fp->obj.objsize) ofs = fp->obj.objsize;
- fp->fptr = ofs;
- if (ofs) {
- fp->clust = clmt_clust(fp, ofs - 1);
- dsc = clust2sect(fs, fp->clust);
- if (!dsc) ABORT(fs, FR_INT_ERR);
- dsc += (DWORD)((ofs - 1) / SS(fs)) & (fs->csize - 1);
- if (fp->fptr % SS(fs) && dsc != fp->sect) {
- #if !_FS_TINY
- #if !_FS_READONLY
- if (fp->flag & FA_DIRTY) {
- if (disk_write(fs->drv, fp->buf, fp->sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR);
- fp->flag &= (BYTE)~FA_DIRTY;
- }
- #endif
- if (disk_read(fs->drv, fp->buf, dsc, 1) != RES_OK) ABORT(fs, FR_DISK_ERR);
- #endif
- fp->sect = dsc;
- }
- }
- }
- } else
- #endif
-
- {
- #if _FS_EXFAT
- if (fs->fs_type != FS_EXFAT && ofs >= 0x100000000) ofs = 0xFFFFFFFF;
- #endif
- if (ofs > fp->obj.objsize && (_FS_READONLY || !(fp->flag & FA_WRITE))) {
- ofs = fp->obj.objsize;
- }
- ifptr = fp->fptr;
- fp->fptr = nsect = 0;
- if (ofs) {
- bcs = (DWORD)fs->csize * SS(fs);
- if (ifptr > 0 &&
- (ofs - 1) / bcs >= (ifptr - 1) / bcs) {
- fp->fptr = (ifptr - 1) & ~(FSIZE_t)(bcs - 1);
- ofs -= fp->fptr;
- clst = fp->clust;
- } else {
- clst = fp->obj.sclust;
- #if !_FS_READONLY
- if (clst == 0) {
- clst = create_chain(&fp->obj, 0);
- if (clst == 1) ABORT(fs, FR_INT_ERR);
- if (clst == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR);
- fp->obj.sclust = clst;
- }
- #endif
- fp->clust = clst;
- }
- if (clst != 0) {
- while (ofs > bcs) {
- ofs -= bcs; fp->fptr += bcs;
- #if !_FS_READONLY
- if (fp->flag & FA_WRITE) {
- if (fp->fptr > fp->obj.objsize) {
- fp->obj.objsize = fp->fptr;
- fp->flag |= FA_MODIFIED;
- clst = create_chain(&fp->obj, clst);
- } else {
- clst = get_fat(&fp->obj, clst);
- }
- if (clst == 0) {
- ofs = 0; break;
- }
- } else
- #endif
- {
- clst = get_fat(&fp->obj, clst);
- }
- if (clst == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR);
- if (clst <= 1 || clst >= fs->n_fatent) ABORT(fs, FR_INT_ERR);
- fp->clust = clst;
- }
- fp->fptr += ofs;
- if (ofs % SS(fs)) {
- nsect = clust2sect(fs, clst);
- if (!nsect) ABORT(fs, FR_INT_ERR);
- nsect += (DWORD)(ofs / SS(fs));
- }
- }
- }
- if (!_FS_READONLY && fp->fptr > fp->obj.objsize) {
- fp->obj.objsize = fp->fptr;
- fp->flag |= FA_MODIFIED;
- }
- if (fp->fptr % SS(fs) && nsect != fp->sect) {
- #if !_FS_TINY
- #if !_FS_READONLY
- if (fp->flag & FA_DIRTY) {
- if (disk_write(fs->drv, fp->buf, fp->sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR);
- fp->flag &= (BYTE)~FA_DIRTY;
- }
- #endif
- if (disk_read(fs->drv, fp->buf, nsect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR);
- #endif
- fp->sect = nsect;
- }
- }
- LEAVE_FF(fs, res);
- }
- FRESULT f_opendir_cluster (
- DIR* dp,
- const TCHAR* path,
- DWORD cluster,
- DWORD blk_ofs
- )
- {
- FRESULT res;
- FATFS *fs;
- _FDID *obj;
- DEF_NAMBUF
- if (!dp) return FR_INVALID_OBJECT;
-
- obj = &dp->obj;
- res = find_volume(&path, &fs, 0);
- if (res == FR_OK) {
- obj->fs = fs;
- INIT_NAMBUF(fs);
- obj->id = fs->id;
- dp->obj.sclust = cluster;
- dp->blk_ofs = blk_ofs;
- res = dir_sdi(dp, dp->blk_ofs);
- #if _FS_LOCK != 0
- if (obj->sclust) {
- obj->lockid = inc_lock(dp, 0);
- if (!obj->lockid) res = FR_TOO_MANY_OPEN_FILES;
- } else {
- obj->lockid = 0;
- }
- #endif
- FREE_NAMBUF();
- } else {
- obj->fs = 0;
- }
- LEAVE_FF(fs, res);
- }
- #if _FS_MINIMIZE <= 1
- FRESULT f_opendir (
- DIR* dp,
- const TCHAR* path
- )
- {
- FRESULT res;
- FATFS *fs;
- _FDID *obj;
- DEF_NAMBUF
- if (!dp) return FR_INVALID_OBJECT;
-
- obj = &dp->obj;
- res = find_volume(&path, &fs, 0);
- if (res == FR_OK) {
- obj->fs = fs;
- INIT_NAMBUF(fs);
- res = follow_path(dp, path);
- if (res == FR_OK) {
- if (!(dp->fn[NSFLAG] & NS_NONAME)) {
- if (obj->attr & AM_DIR) {
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- obj->c_scl = obj->sclust;
- obj->c_size = ((DWORD)obj->objsize & 0xFFFFFF00) | obj->stat;
- obj->c_ofs = dp->blk_ofs;
- obj->sclust = ld_dword(fs->dirbuf + XDIR_FstClus);
- obj->objsize = ld_qword(fs->dirbuf + XDIR_FileSize);
- obj->stat = fs->dirbuf[XDIR_GenFlags] & 2;
- } else
- #endif
- {
- obj->sclust = ld_clust(fs, dp->dir);
- }
- } else {
- res = FR_NO_PATH;
- }
- }
- if (res == FR_OK) {
- obj->id = fs->id;
- res = dir_sdi(dp, 0);
- #if _FS_LOCK != 0
- if (res == FR_OK) {
- if (obj->sclust) {
- obj->lockid = inc_lock(dp, 0);
- if (!obj->lockid) res = FR_TOO_MANY_OPEN_FILES;
- } else {
- obj->lockid = 0;
- }
- }
- #endif
- }
- }
- FREE_NAMBUF();
- if (res == FR_NO_FILE) res = FR_NO_PATH;
- }
- if (res != FR_OK) obj->fs = 0;
- LEAVE_FF(fs, res);
- }
- FRESULT f_opendir_ofs (
- DIR* dp,
- const TCHAR* path
- ){
- FRESULT res;
- FATFS *fs;
- _FDID *obj;
- DEF_NAMBUF
- if (!dp) return FR_INVALID_OBJECT;
-
- obj = &dp->obj;
- res = find_volume(&path, &fs, 0);
- if (res == FR_OK) {
- obj->fs = fs;
- INIT_NAMBUF(fs);
- res = follow_path(dp, path);
- if (res == FR_OK) {
- obj->id = fs->id;
-
- if( fs->fs_type != FS_EXFAT)
- {
- res = dir_read(dp, 0);
- if (res == FR_NO_FILE) res = FR_OK;
- if (res == FR_OK) {
-
- res = dir_next(dp, 0);
- if (res == FR_NO_FILE) res = FR_OK;
- }
- }
- #if _FS_LOCK != 0
- if (res == FR_OK) {
- if (obj->sclust) {
- obj->lockid = inc_lock(dp, 0);
- if (!obj->lockid) res = FR_TOO_MANY_OPEN_FILES;
- } else {
- obj->lockid = 0;
- }
- }
- #endif
- }
- FREE_NAMBUF();
- if (res == FR_NO_FILE) res = FR_NO_PATH;
- }
- if (res != FR_OK) obj->fs = 0;
- LEAVE_FF(fs, res);
- }
- FRESULT f_closedir (
- DIR *dp
- )
- {
- FRESULT res;
- FATFS *fs;
- res = validate(&dp->obj, &fs);
- if (res == FR_OK) {
- #if _FS_LOCK != 0
- if (dp->obj.lockid) {
- res = dec_lock(dp->obj.lockid);
- }
- if (res == FR_OK)
- #endif
- {
- dp->obj.fs = 0;
- }
- #if _FS_REENTRANT
- unlock_fs(fs, FR_OK);
- #endif
- }
- return res;
- }
- FRESULT f_readdir (
- DIR* dp,
- FILINFO* fno
- )
- {
- FRESULT res;
- FATFS *fs;
- DEF_NAMBUF
- res = validate(&dp->obj, &fs);
- if (res == FR_OK) {
- if (!fno) {
- res = dir_sdi(dp, 0);
- } else {
- INIT_NAMBUF(fs);
- res = dir_read(dp, 0);
- if (res == FR_NO_FILE) res = FR_OK;
- if (res == FR_OK) {
- get_fileinfo(dp, fno);
- res = dir_next(dp, 0);
- if (res == FR_NO_FILE) res = FR_OK;
- }
- FREE_NAMBUF();
- }
- }
- LEAVE_FF(fs, res);
- }
- #if _USE_FIND
- FRESULT f_findnext (
- DIR* dp,
- FILINFO* fno
- )
- {
- FRESULT res;
- for (;;) {
- res = f_readdir(dp, fno);
- if (res != FR_OK || !fno || !fno->fname[0]) break;
- if (pattern_matching(dp->pat, fno->fname, 0, 0)) break;
- #if _USE_LFN != 0 && _USE_FIND == 2
- if (pattern_matching(dp->pat, fno->altname, 0, 0)) break;
- #endif
- }
- return res;
- }
- FRESULT f_findfirst (
- DIR* dp,
- FILINFO* fno,
- const TCHAR* path,
- const TCHAR* pattern
- )
- {
- FRESULT res;
- dp->pat = pattern;
- res = f_opendir(dp, path);
- if (res == FR_OK) {
- res = f_findnext(dp, fno);
- }
- return res;
- }
- #endif
- #if _FS_MINIMIZE == 0
- FRESULT f_stat (
- const TCHAR* path,
- FILINFO* fno
- )
- {
- FRESULT res;
- DIR dj;
- DEF_NAMBUF
-
- res = find_volume(&path, &dj.obj.fs, 0);
- if (res == FR_OK) {
- INIT_NAMBUF(dj.obj.fs);
- res = follow_path(&dj, path);
- if (res == FR_OK) {
- if (dj.fn[NSFLAG] & NS_NONAME) {
- res = FR_INVALID_NAME;
- } else {
- if (fno) get_fileinfo(&dj, fno);
- }
- }
- FREE_NAMBUF();
- }
- LEAVE_FF(dj.obj.fs, res);
- }
- #if !_FS_READONLY
- FRESULT f_getfree (
- const TCHAR* path,
- DWORD* nclst,
- FATFS** fatfs
- )
- {
- FRESULT res;
- FATFS *fs;
- DWORD nfree, clst, sect, stat;
- UINT i;
- BYTE *p;
- _FDID obj;
-
- res = find_volume(&path, &fs, 0);
- if (res == FR_OK) {
- *fatfs = fs;
-
- if (fs->free_clst <= fs->n_fatent - 2) {
- *nclst = fs->free_clst;
- } else {
-
- nfree = 0;
- if (fs->fs_type == FS_FAT12) {
- clst = 2; obj.fs = fs;
- do {
- stat = get_fat(&obj, clst);
- if (stat == 0xFFFFFFFF) { res = FR_DISK_ERR; break; }
- if (stat == 1) { res = FR_INT_ERR; break; }
- if (stat == 0) nfree++;
- } while (++clst < fs->n_fatent);
- } else {
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- BYTE bm;
- UINT b;
- clst = fs->n_fatent - 2;
- sect = fs->database;
- i = 0;
- do {
- if (i == 0 && (res = move_window(fs, sect++)) != FR_OK) break;
- for (b = 8, bm = fs->win[i]; b && clst; b--, clst--) {
- if (!(bm & 1)) nfree++;
- bm >>= 1;
- }
- i = (i + 1) % SS(fs);
- } while (clst);
- } else
- #endif
- {
- clst = fs->n_fatent; sect = fs->fatbase;
- i = 0; p = 0;
- do {
- if (i == 0) {
- res = move_window(fs, sect++);
- if (res != FR_OK) break;
- p = fs->win;
- i = SS(fs);
- }
- if (fs->fs_type == FS_FAT16) {
- if (ld_word(p) == 0) nfree++;
- p += 2; i -= 2;
- } else {
- if ((ld_dword(p) & 0x0FFFFFFF) == 0) nfree++;
- p += 4; i -= 4;
- }
- } while (--clst);
- }
- }
- *nclst = nfree;
- fs->free_clst = nfree;
- fs->fsi_flag |= 1;
- }
- }
- LEAVE_FF(fs, res);
- }
- FRESULT f_truncate (
- FIL* fp
- )
- {
- FRESULT res;
- FATFS *fs;
- DWORD ncl;
- res = validate(&fp->obj, &fs);
- if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res);
- if (!(fp->flag & FA_WRITE)) LEAVE_FF(fs, FR_DENIED);
- if (fp->obj.objsize > fp->fptr) {
- if (fp->fptr == 0) {
- res = remove_chain(&fp->obj, fp->obj.sclust, 0);
- fp->obj.sclust = 0;
- } else {
- ncl = get_fat(&fp->obj, fp->clust);
- res = FR_OK;
- if (ncl == 0xFFFFFFFF) res = FR_DISK_ERR;
- if (ncl == 1) res = FR_INT_ERR;
- if (res == FR_OK && ncl < fs->n_fatent) {
- res = remove_chain(&fp->obj, ncl, fp->clust);
- }
- }
- fp->obj.objsize = fp->fptr;
- fp->flag |= FA_MODIFIED;
- #if !_FS_TINY
- if (res == FR_OK && (fp->flag & FA_DIRTY)) {
- if (disk_write(fs->drv, fp->buf, fp->sect, 1) != RES_OK) {
- res = FR_DISK_ERR;
- } else {
- fp->flag &= (BYTE)~FA_DIRTY;
- }
- }
- #endif
- if (res != FR_OK) ABORT(fs, res);
- }
- LEAVE_FF(fs, res);
- }
- FRESULT f_unlink (
- const TCHAR* path
- )
- {
- FRESULT res;
- DIR dj, sdj;
- DWORD dclst = 0;
- FATFS *fs;
- #if _FS_EXFAT
- _FDID obj;
- #endif
- DEF_NAMBUF
-
- res = find_volume(&path, &fs, FA_WRITE);
- dj.obj.fs = fs;
- if (res == FR_OK) {
- INIT_NAMBUF(fs);
- res = follow_path(&dj, path);
- if (_FS_RPATH && res == FR_OK && (dj.fn[NSFLAG] & NS_DOT)) {
- res = FR_INVALID_NAME;
- }
- #if _FS_LOCK != 0
- if (res == FR_OK) res = chk_lock(&dj, 2);
- #endif
- if (res == FR_OK) {
- if (dj.fn[NSFLAG] & NS_NONAME) {
- res = FR_INVALID_NAME;
- } else {
- if (dj.obj.attr & AM_RDO) {
- res = FR_DENIED;
- }
- }
- if (res == FR_OK) {
- #if _FS_EXFAT
- obj.fs = fs;
- if (fs->fs_type == FS_EXFAT) {
- obj.sclust = dclst = ld_dword(fs->dirbuf + XDIR_FstClus);
- obj.objsize = ld_qword(fs->dirbuf + XDIR_FileSize);
- obj.stat = fs->dirbuf[XDIR_GenFlags] & 2;
- } else
- #endif
- {
- dclst = ld_clust(fs, dj.dir);
- }
- if (dj.obj.attr & AM_DIR) {
- #if _FS_RPATH != 0
- if (dclst == fs->cdir) {
- res = FR_DENIED;
- } else
- #endif
- {
- sdj.obj.fs = fs;
- sdj.obj.sclust = dclst;
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- sdj.obj.objsize = obj.objsize;
- sdj.obj.stat = obj.stat;
- }
- #endif
- res = dir_sdi(&sdj, 0);
- if (res == FR_OK) {
- res = dir_read(&sdj, 0);
- if (res == FR_OK) res = FR_DENIED;
- if (res == FR_NO_FILE) res = FR_OK;
- }
- }
- }
- }
- if (res == FR_OK) {
- res = dir_remove(&dj);
- if (res == FR_OK && dclst) {
- #if _FS_EXFAT
- res = remove_chain(&obj, dclst, 0);
- #else
- res = remove_chain(&dj.obj, dclst, 0);
- #endif
- }
- if (res == FR_OK) res = sync_fs(fs);
- }
- }
- FREE_NAMBUF();
- }
- LEAVE_FF(fs, res);
- }
- FRESULT f_mkdir (
- const TCHAR* path
- )
- {
- FRESULT res;
- DIR dj;
- FATFS *fs;
- BYTE *dir;
- UINT n;
- DWORD dsc, dcl, pcl, tm;
- DEF_NAMBUF
-
- res = find_volume(&path, &fs, FA_WRITE);
- dj.obj.fs = fs;
- if (res == FR_OK) {
- INIT_NAMBUF(fs);
- res = follow_path(&dj, path);
- if (res == FR_OK) res = FR_EXIST;
- if (_FS_RPATH && res == FR_NO_FILE && (dj.fn[NSFLAG] & NS_DOT)) {
- res = FR_INVALID_NAME;
- }
- if (res == FR_NO_FILE) {
- dcl = create_chain(&dj.obj, 0);
- dj.obj.objsize = (DWORD)fs->csize * SS(fs);
- res = FR_OK;
- if (dcl == 0) res = FR_DENIED;
- if (dcl == 1) res = FR_INT_ERR;
- if (dcl == 0xFFFFFFFF) res = FR_DISK_ERR;
- if (res == FR_OK) res = sync_window(fs);
- tm = GET_FATTIME();
- if (res == FR_OK) {
- dsc = clust2sect(fs, dcl);
- dir = fs->win;
- mem_set(dir, 0, SS(fs));
- if (!_FS_EXFAT || fs->fs_type != FS_EXFAT) {
- mem_set(dir + DIR_Name, ' ', 11);
- dir[DIR_Name] = '.';
- dir[DIR_Attr] = AM_DIR;
- st_dword(dir + DIR_ModTime, tm);
- st_clust(fs, dir, dcl);
- mem_cpy(dir + SZDIRE, dir, SZDIRE);
- dir[SZDIRE + 1] = '.'; pcl = dj.obj.sclust;
- if (fs->fs_type == FS_FAT32 && pcl == fs->dirbase) pcl = 0;
- st_clust(fs, dir + SZDIRE, pcl);
- }
- for (n = fs->csize; n; n--) {
- fs->winsect = dsc++;
- fs->wflag = 1;
- res = sync_window(fs);
- if (res != FR_OK) break;
- mem_set(dir, 0, SS(fs));
- }
- }
- if (res == FR_OK) res = dir_register(&dj);
- if (res == FR_OK) {
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- st_dword(fs->dirbuf + XDIR_ModTime, tm);
- st_dword(fs->dirbuf + XDIR_FstClus, dcl);
- st_dword(fs->dirbuf + XDIR_FileSize, (DWORD)dj.obj.objsize);
- st_dword(fs->dirbuf + XDIR_ValidFileSize, (DWORD)dj.obj.objsize);
- fs->dirbuf[XDIR_GenFlags] = 3;
- fs->dirbuf[XDIR_Attr] = AM_DIR;
- res = store_xdir(&dj);
- } else
- #endif
- {
- dir = dj.dir;
- st_dword(dir + DIR_ModTime, tm);
- st_clust(fs, dir, dcl);
- dir[DIR_Attr] = AM_DIR;
- fs->wflag = 1;
- }
- if (res == FR_OK) res = sync_fs(fs);
- } else {
- remove_chain(&dj.obj, dcl, 0);
- }
- }
- FREE_NAMBUF();
- }
- LEAVE_FF(fs, res);
- }
- FRESULT f_rename (
- const TCHAR* path_old,
- const TCHAR* path_new
- )
- {
- FRESULT res;
- DIR djo, djn;
- FATFS *fs;
- BYTE buf[_FS_EXFAT ? SZDIRE * 2 : 24], *dir;
- DWORD dw;
- DEF_NAMBUF
- get_ldnumber(&path_new);
- res = find_volume(&path_old, &fs, FA_WRITE);
- if (res == FR_OK) {
- djo.obj.fs = fs;
- INIT_NAMBUF(fs);
- res = follow_path(&djo, path_old);
- if (res == FR_OK && (djo.fn[NSFLAG] & (NS_DOT | NS_NONAME))) res = FR_INVALID_NAME;
- #if _FS_LOCK != 0
- if (res == FR_OK) res = chk_lock(&djo, 2);
- #endif
- if (res == FR_OK) {
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- BYTE nf, nn;
- WORD nh;
- mem_cpy(buf, fs->dirbuf, SZDIRE * 2);
- mem_cpy(&djn, &djo, sizeof djo);
- res = follow_path(&djn, path_new);
- if (res == FR_OK) {
- res = (djn.obj.sclust == djo.obj.sclust && djn.dptr == djo.dptr) ? FR_NO_FILE : FR_EXIST;
- }
- if (res == FR_NO_FILE) {
- res = dir_register(&djn);
- if (res == FR_OK) {
- nf = fs->dirbuf[XDIR_NumSec]; nn = fs->dirbuf[XDIR_NumName];
- nh = ld_word(fs->dirbuf + XDIR_NameHash);
- mem_cpy(fs->dirbuf, buf, SZDIRE * 2);
- fs->dirbuf[XDIR_NumSec] = nf; fs->dirbuf[XDIR_NumName] = nn;
- st_word(fs->dirbuf + XDIR_NameHash, nh);
- res = store_xdir(&djn);
- }
- }
- } else
- #endif
- {
- mem_cpy(buf, djo.dir + DIR_Attr, 21);
- mem_cpy(&djn, &djo, sizeof (DIR));
- res = follow_path(&djn, path_new);
- if (res == FR_OK) {
- res = (djn.obj.sclust == djo.obj.sclust && djn.dptr == djo.dptr) ? FR_NO_FILE : FR_EXIST;
- }
- if (res == FR_NO_FILE) {
- res = dir_register(&djn);
- if (res == FR_OK) {
- dir = djn.dir;
- mem_cpy(dir + 13, buf + 2, 19);
- dir[DIR_Attr] = buf[0] | AM_ARC;
- fs->wflag = 1;
- if ((dir[DIR_Attr] & AM_DIR) && djo.obj.sclust != djn.obj.sclust) {
- dw = clust2sect(fs, ld_clust(fs, dir));
- if (!dw) {
- res = FR_INT_ERR;
- } else {
- res = move_window(fs, dw);
- dir = fs->win + SZDIRE * 1;
- if (res == FR_OK && dir[1] == '.') {
- st_clust(fs, dir, djn.obj.sclust);
- fs->wflag = 1;
- }
- }
- }
- }
- }
- }
- if (res == FR_OK) {
- res = dir_remove(&djo);
- if (res == FR_OK) {
- res = sync_fs(fs);
- }
- }
- }
- FREE_NAMBUF();
- }
- LEAVE_FF(fs, res);
- }
- #endif
- #endif
- #endif
- #endif
- #if _USE_CHMOD && !_FS_READONLY
- FRESULT f_chmod (
- const TCHAR* path,
- BYTE attr,
- BYTE mask
- )
- {
- FRESULT res;
- DIR dj;
- FATFS *fs;
- DEF_NAMBUF
- res = find_volume(&path, &fs, FA_WRITE);
- dj.obj.fs = fs;
- if (res == FR_OK) {
- INIT_NAMBUF(fs);
- res = follow_path(&dj, path);
- if (res == FR_OK && (dj.fn[NSFLAG] & (NS_DOT | NS_NONAME))) res = FR_INVALID_NAME;
- if (res == FR_OK) {
- mask &= AM_RDO|AM_HID|AM_SYS|AM_ARC;
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- fs->dirbuf[XDIR_Attr] = (attr & mask) | (fs->dirbuf[XDIR_Attr] & (BYTE)~mask);
- res = store_xdir(&dj);
- } else
- #endif
- {
- dj.dir[DIR_Attr] = (attr & mask) | (dj.dir[DIR_Attr] & (BYTE)~mask);
- fs->wflag = 1;
- }
- if (res == FR_OK) res = sync_fs(fs);
- }
- FREE_NAMBUF();
- }
- LEAVE_FF(fs, res);
- }
- FRESULT f_utime (
- const TCHAR* path,
- const FILINFO* fno
- )
- {
- FRESULT res;
- DIR dj;
- FATFS *fs;
- DEF_NAMBUF
- res = find_volume(&path, &fs, FA_WRITE);
- dj.obj.fs = fs;
- if (res == FR_OK) {
- INIT_NAMBUF(fs);
- res = follow_path(&dj, path);
- if (res == FR_OK && (dj.fn[NSFLAG] & (NS_DOT | NS_NONAME))) res = FR_INVALID_NAME;
- if (res == FR_OK) {
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- st_dword(fs->dirbuf + XDIR_ModTime, (DWORD)fno->fdate << 16 | fno->ftime);
- res = store_xdir(&dj);
- } else
- #endif
- {
- st_dword(dj.dir + DIR_ModTime, (DWORD)fno->fdate << 16 | fno->ftime);
- fs->wflag = 1;
- }
- if (res == FR_OK) res = sync_fs(fs);
- }
- FREE_NAMBUF();
- }
- LEAVE_FF(fs, res);
- }
- #endif
- #if _USE_LABEL
- FRESULT f_getlabel (
- const TCHAR* path,
- TCHAR* label,
- DWORD* vsn
- )
- {
- FRESULT res;
- DIR dj;
- FATFS *fs;
- UINT si, di;
- #if _LFN_UNICODE || _FS_EXFAT
- WCHAR w;
- #endif
-
- res = find_volume(&path, &fs, 0);
-
- if (res == FR_OK && label) {
- dj.obj.fs = fs; dj.obj.sclust = 0;
- res = dir_sdi(&dj, 0);
- if (res == FR_OK) {
- res = dir_read(&dj, 1);
- if (res == FR_OK) {
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- for (si = di = 0; si < dj.dir[XDIR_NumLabel]; si++) {
- w = ld_word(dj.dir + XDIR_Label + si * 2);
- #if _LFN_UNICODE
- label[di++] = w;
- #else
- #if _USE_UTF8
-
- int count;
- u32_t utf8;
- count = nls_utf8_uni2char(w, (u8_t *)&utf8, 3);
- if (count <= 0) {
- di = 0;
- break;
- } else if (count == 1) {
- w = *((u8_t *)&utf8);
- } else if (count == 2) {
- label[di++] = *(u8_t *)&utf8;
- w = *((u8_t *)&utf8 + 1);
- } else if (count == 3) {
- label[di++] = *((u8_t *)&utf8);
- label[di++] = *((u8_t *)&utf8 + 1);
- w = *((u8_t *)&utf8 + 2);
- }
- #else
- w = ff_convert(w, 0);
- if (w == 0) w = '?';
- if (_DF1S && w >= 0x100) label[di++] = (char)(w >> 8);
- #endif
- label[di++] = (char)w;
- #endif
- }
- label[di] = 0;
- } else
- #endif
- {
- si = di = 0;
- do {
- #if _LFN_UNICODE
- w = (si < 11) ? dj.dir[si++] : ' ';
- if (IsDBCS1(w) && si < 11 && IsDBCS2(dj.dir[si])) {
- w = w << 8 | dj.dir[si++];
- }
- label[di++] = ff_convert(w, 1);
- #else
- label[di++] = dj.dir[si++];
- #endif
- } while (di < 11);
- do {
- label[di] = 0;
- if (di == 0) break;
- } while (label[--di] == ' ');
- }
- }
- }
- if (res == FR_NO_FILE) {
- label[0] = 0;
- res = FR_OK;
- }
- }
-
- if (res == FR_OK && vsn) {
- res = move_window(fs, fs->volbase);
- if (res == FR_OK) {
- switch (fs->fs_type) {
- case FS_EXFAT: di = BPB_VolIDEx; break;
- case FS_FAT32: di = BS_VolID32; break;
- default: di = BS_VolID;
- }
- *vsn = ld_dword(fs->win + di);
- }
- }
- LEAVE_FF(fs, res);
- }
- #if !_FS_READONLY
- FRESULT f_setlabel (
- const TCHAR* label
- )
- {
- FRESULT res;
- DIR dj;
- FATFS *fs;
- BYTE dirvn[22];
- UINT i, j, slen;
- WCHAR w;
- static const char badchr[] = "\"*+,.:;<=>\?[]|\x7F";
-
- res = find_volume(&label, &fs, FA_WRITE);
- if (res != FR_OK) LEAVE_FF(fs, res);
- dj.obj.fs = fs;
-
- for (slen = 0; (UINT)label[slen] >= ' '; slen++) ;
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- for (i = j = 0; i < slen; ) {
- w = label[i++];
- #if !_LFN_UNICODE
- #if _USE_UTF8
-
- int count;
- count = nls_utf8_char2uni((const u8_t *)&label[--i], 3, &w);
- if (count < 0) {
- return FR_INVALID_NAME;
- }
- i += count;
- #else
- if (IsDBCS1(w)) {
- w = (i < slen && IsDBCS2(label[i])) ? w << 8 | (BYTE)label[i++] : 0;
- }
- w = ff_convert(w, 1);
- #endif
- #endif
- if (w == 0 || chk_chr(badchr, w) || j == 22) {
- LEAVE_FF(fs, FR_INVALID_NAME);
- }
- st_word(dirvn + j, w); j += 2;
- }
- slen = j;
- } else
- #endif
- {
- for ( ; slen && label[slen - 1] == ' '; slen--) ;
- if (slen) {
- dirvn[0] = 0; i = j = 0;
- do {
- #if _LFN_UNICODE
- w = ff_convert(ff_wtoupper(label[i++]), 0);
- #else
- w = (BYTE)label[i++];
- if (IsDBCS1(w)) {
- w = (j < 10 && i < slen && IsDBCS2(label[i])) ? w << 8 | (BYTE)label[i++] : 0;
- }
- #if _USE_LFN != 0
- w = ff_convert(ff_wtoupper(ff_convert(w, 1)), 0);
- #else
- if (IsLower(w)) w -= 0x20;
- #ifdef _EXCVT
- if (w >= 0x80) w = ExCvt[w - 0x80];
- #else
- if (!_DF1S && w >= 0x80) w = 0;
- #endif
- #endif
- #endif
- if (w == 0 || chk_chr(badchr, w) || j >= (UINT)((w >= 0x100) ? 10 : 11)) {
- LEAVE_FF(fs, FR_INVALID_NAME);
- }
- if (w >= 0x100) dirvn[j++] = (BYTE)(w >> 8);
- dirvn[j++] = (BYTE)w;
- } while (i < slen);
- while (j < 11) dirvn[j++] = ' ';
- if (dirvn[0] == DDEM) LEAVE_FF(fs, FR_INVALID_NAME);
- }
- }
-
- dj.obj.sclust = 0;
- res = dir_sdi(&dj, 0);
- if (res == FR_OK) {
- res = dir_read(&dj, 1);
- if (res == FR_OK) {
- if (_FS_EXFAT && fs->fs_type == FS_EXFAT) {
- dj.dir[XDIR_NumLabel] = (BYTE)(slen / 2);
- mem_cpy(dj.dir + XDIR_Label, dirvn, slen);
- } else {
- if (slen) {
- mem_cpy(dj.dir, dirvn, 11);
- } else {
- dj.dir[DIR_Name] = DDEM;
- }
- }
- fs->wflag = 1;
- res = sync_fs(fs);
- } else {
- if (res == FR_NO_FILE) {
- res = FR_OK;
- if (slen) {
- res = dir_alloc(&dj, 1);
- if (res == FR_OK) {
- mem_set(dj.dir, 0, SZDIRE);
- if (_FS_EXFAT && fs->fs_type == FS_EXFAT) {
- dj.dir[XDIR_Type] = 0x83;
- dj.dir[XDIR_NumLabel] = (BYTE)(slen / 2);
- mem_cpy(dj.dir + XDIR_Label, dirvn, slen);
- } else {
- dj.dir[DIR_Attr] = AM_VOL;
- mem_cpy(dj.dir, dirvn, 11);
- }
- fs->wflag = 1;
- res = sync_fs(fs);
- }
- }
- }
- }
- }
- LEAVE_FF(fs, res);
- }
- #endif
- #endif
- #if _USE_EXPAND && !_FS_READONLY
- FRESULT f_expand (
- FIL* fp,
- FSIZE_t fsz,
- BYTE opt
- )
- {
- FRESULT res;
- FATFS *fs;
- DWORD n, clst, stcl, scl, ncl, tcl, lclst;
- res = validate(&fp->obj, &fs);
- if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res);
- if (fsz == 0 || fp->obj.objsize != 0 || !(fp->flag & FA_WRITE)) LEAVE_FF(fs, FR_DENIED);
- #if _FS_EXFAT
- if (fs->fs_type != FS_EXFAT && fsz >= 0x100000000) LEAVE_FF(fs, FR_DENIED);
- #endif
- n = (DWORD)fs->csize * SS(fs);
- tcl = (DWORD)(fsz / n) + ((fsz & (n - 1)) ? 1 : 0);
- stcl = fs->last_clst; lclst = 0;
- if (stcl < 2 || stcl >= fs->n_fatent) stcl = 2;
- #if _FS_EXFAT
- if (fs->fs_type == FS_EXFAT) {
- scl = find_bitmap(fs, stcl, tcl);
- if (scl == 0) res = FR_DENIED;
- if (scl == 0xFFFFFFFF) res = FR_DISK_ERR;
- if (res == FR_OK) {
- if (opt) {
- res = change_bitmap(fs, scl, tcl, 1);
- lclst = scl + tcl - 1;
- } else {
- lclst = scl - 1;
- }
- }
- } else
- #endif
- {
- scl = clst = stcl; ncl = 0;
- for (;;) {
- n = get_fat(&fp->obj, clst);
- if (++clst >= fs->n_fatent) clst = 2;
- if (n == 1) { res = FR_INT_ERR; break; }
- if (n == 0xFFFFFFFF) { res = FR_DISK_ERR; break; }
- if (n == 0) {
- if (++ncl == tcl) break;
- } else {
- scl = clst; ncl = 0;
- }
- if (clst == stcl) { res = FR_DENIED; break; }
- }
- if (res == FR_OK) {
- if (opt) {
- for (clst = scl, n = tcl; n; clst++, n--) {
- res = put_fat(fs, clst, (n == 1) ? 0xFFFFFFFF : clst + 1);
- if (res != FR_OK) break;
- lclst = clst;
- }
- } else {
- lclst = scl - 1;
- }
- }
- }
- if (res == FR_OK) {
- fs->last_clst = lclst;
- if (opt) {
- fp->obj.sclust = scl;
- fp->obj.objsize = fsz;
- if (_FS_EXFAT) fp->obj.stat = 2;
- fp->flag |= FA_MODIFIED;
- if (fs->free_clst < fs->n_fatent - 2) {
- fs->free_clst -= tcl;
- fs->fsi_flag |= 1;
- }
- }
- }
- LEAVE_FF(fs, res);
- }
- #endif
- #if _USE_FORWARD
- FRESULT f_forward (
- FIL* fp,
- UINT (*func)(const BYTE*,UINT),
- UINT btf,
- UINT* bf
- )
- {
- FRESULT res;
- FATFS *fs;
- DWORD clst, sect;
- FSIZE_t remain;
- UINT rcnt, csect;
- BYTE *dbuf;
- *bf = 0;
- res = validate(&fp->obj, &fs);
- if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res);
- if (!(fp->flag & FA_READ)) LEAVE_FF(fs, FR_DENIED);
- remain = fp->obj.objsize - fp->fptr;
- if (btf > remain) btf = (UINT)remain;
- for ( ; btf && (*func)(0, 0);
- fp->fptr += rcnt, *bf += rcnt, btf -= rcnt) {
- csect = (UINT)(fp->fptr / SS(fs) & (fs->csize - 1));
- if (fp->fptr % SS(fs) == 0) {
- if (csect == 0) {
- clst = (fp->fptr == 0) ?
- fp->obj.sclust : get_fat(&fp->obj, fp->clust);
- if (clst <= 1) ABORT(fs, FR_INT_ERR);
- if (clst == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR);
- fp->clust = clst;
- }
- }
- sect = clust2sect(fs, fp->clust);
- if (!sect) ABORT(fs, FR_INT_ERR);
- sect += csect;
- #if _FS_TINY
- if (move_window(fs, sect) != FR_OK) ABORT(fs, FR_DISK_ERR);
- dbuf = fs->win;
- #else
- if (fp->sect != sect) {
- #if !_FS_READONLY
- if (fp->flag & FA_DIRTY) {
- if (disk_write(fs->drv, fp->buf, fp->sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR);
- fp->flag &= (BYTE)~FA_DIRTY;
- }
- #endif
- if (disk_read(fs->drv, fp->buf, sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR);
- }
- dbuf = fp->buf;
- #endif
- fp->sect = sect;
- rcnt = SS(fs) - (UINT)fp->fptr % SS(fs);
- if (rcnt > btf) rcnt = btf;
- rcnt = (*func)(dbuf + ((UINT)fp->fptr % SS(fs)), rcnt);
- if (!rcnt) ABORT(fs, FR_INT_ERR);
- }
- LEAVE_FF(fs, FR_OK);
- }
- #endif
- #if _USE_MKFS && !_FS_READONLY
- FRESULT f_mkfs (
- const TCHAR* path,
- BYTE opt,
- DWORD au,
- void* work,
- UINT len
- )
- {
- const UINT n_fats = 1;
- const UINT n_rootdir = 512;
- static const WORD cst[] = {1, 4, 16, 64, 256, 512, 0};
- static const WORD cst32[] = {1, 2, 4, 8, 16, 32, 0};
- BYTE fmt, sys, *buf, *pte, pdrv, part;
- WORD ss;
- DWORD szb_buf, sz_buf, sz_blk, n_clst, pau, sect, nsect, n;
- DWORD b_vol, b_fat, b_data;
- DWORD sz_vol, sz_rsv, sz_fat, sz_dir;
- UINT i;
- int vol;
- DSTATUS stat;
- #if _USE_TRIM || _FS_EXFAT
- DWORD tbl[3];
- #endif
-
- vol = get_ldnumber(&path);
- if (vol < 0) return FR_INVALID_DRIVE;
- if (FatFs[vol]) FatFs[vol]->fs_type = 0;
- pdrv = LD2PD(vol);
- part = LD2PT(vol);
-
- stat = disk_initialize(pdrv);
- if (stat & STA_NOINIT) return FR_NOT_READY;
- if (stat & STA_PROTECT) return FR_WRITE_PROTECTED;
- if (disk_ioctl(pdrv, GET_BLOCK_SIZE, &sz_blk) != RES_OK || !sz_blk || sz_blk > 32768 || (sz_blk & (sz_blk - 1))) sz_blk = 1;
- #if _MAX_SS != _MIN_SS
- if (disk_ioctl(pdrv, GET_SECTOR_SIZE, &ss) != RES_OK) return FR_DISK_ERR;
- if (ss > _MAX_SS || ss < _MIN_SS || (ss & (ss - 1))) return FR_DISK_ERR;
- #else
- ss = _MAX_SS;
- #endif
- if ((au != 0 && au < ss) || au > 0x1000000 || (au & (au - 1))) return FR_INVALID_PARAMETER;
- au /= ss;
-
- buf = (BYTE*)work;
- sz_buf = len / ss;
- szb_buf = sz_buf * ss;
- if (!szb_buf) return FR_MKFS_ABORTED;
-
- if (_MULTI_PARTITION && part != 0) {
-
- if (disk_read(pdrv, buf, 0, 1) != RES_OK) return FR_DISK_ERR;
- if (ld_word(buf + BS_55AA) != 0xAA55) return FR_MKFS_ABORTED;
- pte = buf + (MBR_Table + (part - 1) * SZ_PTE);
- if (!pte[PTE_System]) return FR_MKFS_ABORTED;
- b_vol = ld_dword(pte + PTE_StLba);
- sz_vol = ld_dword(pte + PTE_SizLba);
- } else {
-
- if (disk_ioctl(pdrv, GET_SECTOR_COUNT, &sz_vol) != RES_OK) return FR_DISK_ERR;
- b_vol = (opt & FM_SFD) ? 0 : 63;
- if (sz_vol < b_vol) return FR_MKFS_ABORTED;
- sz_vol -= b_vol;
- }
- if (sz_vol < 128) return FR_MKFS_ABORTED;
-
- do {
- if (_FS_EXFAT && (opt & FM_EXFAT)) {
- if ((opt & FM_ANY) == FM_EXFAT || sz_vol >= 0x4000000 || au > 128) {
- fmt = FS_EXFAT; break;
- }
- }
- if (au > 128) return FR_INVALID_PARAMETER;
- if (opt & FM_FAT32) {
- if ((opt & FM_ANY) == FM_FAT32 || !(opt & FM_FAT)) {
- fmt = FS_FAT32; break;
- }
- }
- if (!(opt & FM_FAT)) return FR_INVALID_PARAMETER;
- fmt = FS_FAT16;
- } while (0);
- #if _FS_EXFAT
- if (fmt == FS_EXFAT) {
- DWORD szb_bit, szb_case, sum, nb, cl;
- WCHAR ch, si;
- UINT j, st;
- BYTE b;
- if (sz_vol < 0x1000) return FR_MKFS_ABORTED;
- #if _USE_TRIM
- tbl[0] = b_vol; tbl[1] = b_vol + sz_vol - 1;
- disk_ioctl(pdrv, CTRL_TRIM, tbl);
- #endif
-
- if (!au) {
- au = 8;
- if (sz_vol >= 0x80000) au = 64;
- if (sz_vol >= 0x4000000) au = 256;
- }
- b_fat = b_vol + 32;
- sz_fat = ((sz_vol / au + 2) * 4 + ss - 1) / ss;
- b_data = (b_fat + sz_fat + sz_blk - 1) & ~(sz_blk - 1);
- if (b_data >= sz_vol / 2) return FR_MKFS_ABORTED;
- n_clst = (sz_vol - (b_data - b_vol)) / au;
- if (n_clst <16) return FR_MKFS_ABORTED;
- if (n_clst > MAX_EXFAT) return FR_MKFS_ABORTED;
- szb_bit = (n_clst + 7) / 8;
- tbl[0] = (szb_bit + au * ss - 1) / (au * ss);
-
- sect = b_data + au * tbl[0];
- sum = 0;
- st = si = i = j = szb_case = 0;
- do {
- switch (st) {
- case 0:
- ch = ff_wtoupper(si);
- if (ch != si) {
- si++; break;
- }
- for (j = 1; (WCHAR)(si + j) && (WCHAR)(si + j) == ff_wtoupper((WCHAR)(si + j)); j++) ;
- if (j >= 128) {
- ch = 0xFFFF; st = 2; break;
- }
- st = 1;
-
- case 1:
- ch = si++;
- if (--j == 0) st = 0;
- break;
- default:
- ch = (WCHAR)j; si += j;
- st = 0;
- }
- sum = xsum32(buf[i + 0] = (BYTE)ch, sum);
- sum = xsum32(buf[i + 1] = (BYTE)(ch >> 8), sum);
- i += 2; szb_case += 2;
- if (!si || i == szb_buf) {
- n = (i + ss - 1) / ss;
- if (disk_write(pdrv, buf, sect, n) != RES_OK) return FR_DISK_ERR;
- sect += n; i = 0;
- }
- } while (si);
- tbl[1] = (szb_case + au * ss - 1) / (au * ss);
- tbl[2] = 1;
-
- sect = b_data; nsect = (szb_bit + ss - 1) / ss;
- nb = tbl[0] + tbl[1] + tbl[2];
- do {
- mem_set(buf, 0, szb_buf);
- for (i = 0; nb >= 8 && i < szb_buf; buf[i++] = 0xFF, nb -= 8) ;
- for (b = 1; nb && i < szb_buf; buf[i] |= b, b <<= 1, nb--) ;
- n = (nsect > sz_buf) ? sz_buf : nsect;
- if (disk_write(pdrv, buf, sect, n) != RES_OK) return FR_DISK_ERR;
- sect += n; nsect -= n;
- } while (nsect);
-
- sect = b_fat; nsect = sz_fat;
- j = nb = cl = 0;
- do {
- mem_set(buf, 0, szb_buf); i = 0;
- if (cl == 0) {
- st_dword(buf + i, 0xFFFFFFF8); i += 4; cl++;
- st_dword(buf + i, 0xFFFFFFFF); i += 4; cl++;
- }
- do {
- while (nb && i < szb_buf) {
- st_dword(buf + i, (nb > 1) ? cl + 1 : 0xFFFFFFFF);
- i += 4; cl++; nb--;
- }
- if (!nb && j < 3) nb = tbl[j++];
- } while (nb && i < szb_buf);
- n = (nsect > sz_buf) ? sz_buf : nsect;
- if (disk_write(pdrv, buf, sect, n) != RES_OK) return FR_DISK_ERR;
- sect += n; nsect -= n;
- } while (nsect);
-
- mem_set(buf, 0, szb_buf);
- buf[SZDIRE * 0 + 0] = 0x83;
- buf[SZDIRE * 1 + 0] = 0x81;
- st_dword(buf + SZDIRE * 1 + 20, 2);
- st_dword(buf + SZDIRE * 1 + 24, szb_bit);
- buf[SZDIRE * 2 + 0] = 0x82;
- st_dword(buf + SZDIRE * 2 + 4, sum);
- st_dword(buf + SZDIRE * 2 + 20, 2 + tbl[0]);
- st_dword(buf + SZDIRE * 2 + 24, szb_case);
- sect = b_data + au * (tbl[0] + tbl[1]); nsect = au;
- do {
- n = (nsect > sz_buf) ? sz_buf : nsect;
- if (disk_write(pdrv, buf, sect, n) != RES_OK) return FR_DISK_ERR;
- mem_set(buf, 0, ss);
- sect += n; nsect -= n;
- } while (nsect);
-
- sect = b_vol;
- for (n = 0; n < 2; n++) {
-
- mem_set(buf, 0, ss);
- mem_cpy(buf + BS_JmpBoot, "\xEB\x76\x90" "EXFAT ", 11);
- st_dword(buf + BPB_VolOfsEx, b_vol);
- st_dword(buf + BPB_TotSecEx, sz_vol);
- st_dword(buf + BPB_FatOfsEx, b_fat - b_vol);
- st_dword(buf + BPB_FatSzEx, sz_fat);
- st_dword(buf + BPB_DataOfsEx, b_data - b_vol);
- st_dword(buf + BPB_NumClusEx, n_clst);
- st_dword(buf + BPB_RootClusEx, 2 + tbl[0] + tbl[1]);
- st_dword(buf + BPB_VolIDEx, GET_FATTIME());
- st_word(buf + BPB_FSVerEx, 0x100);
- for (buf[BPB_BytsPerSecEx] = 0, i = ss; i >>= 1; buf[BPB_BytsPerSecEx]++) ;
- for (buf[BPB_SecPerClusEx] = 0, i = au; i >>= 1; buf[BPB_SecPerClusEx]++) ;
- buf[BPB_NumFATsEx] = 1;
- buf[BPB_DrvNumEx] = 0x80;
- st_word(buf + BS_BootCodeEx, 0xFEEB);
- st_word(buf + BS_55AA, 0xAA55);
- for (i = sum = 0; i < ss; i++) {
- if (i != BPB_VolFlagEx && i != BPB_VolFlagEx + 1 && i != BPB_PercInUseEx) sum = xsum32(buf[i], sum);
- }
- if (disk_write(pdrv, buf, sect++, 1) != RES_OK) return FR_DISK_ERR;
-
- mem_set(buf, 0, ss);
- st_word(buf + ss - 2, 0xAA55);
- for (j = 1; j < 9; j++) {
- for (i = 0; i < ss; sum = xsum32(buf[i++], sum)) ;
- if (disk_write(pdrv, buf, sect++, 1) != RES_OK) return FR_DISK_ERR;
- }
-
- mem_set(buf, 0, ss);
- for ( ; j < 11; j++) {
- for (i = 0; i < ss; sum = xsum32(buf[i++], sum)) ;
- if (disk_write(pdrv, buf, sect++, 1) != RES_OK) return FR_DISK_ERR;
- }
-
- for (i = 0; i < ss; i += 4) st_dword(buf + i, sum);
- if (disk_write(pdrv, buf, sect++, 1) != RES_OK) return FR_DISK_ERR;
- }
- } else
- #endif
- {
- do {
- pau = au;
-
- if (fmt == FS_FAT32) {
- if (!pau) {
- n = sz_vol / 0x20000;
- for (i = 0, pau = 1; cst32[i] && cst32[i] <= n; i++, pau <<= 1) ;
- }
- n_clst = sz_vol / pau;
- sz_fat = (n_clst * 4 + 8 + ss - 1) / ss;
- sz_rsv = 32;
- sz_dir = 0;
- if (n_clst <= MAX_FAT16 || n_clst > MAX_FAT32) return FR_MKFS_ABORTED;
- } else {
- if (!pau) {
- n = sz_vol / 0x1000;
- for (i = 0, pau = 1; cst[i] && cst[i] <= n; i++, pau <<= 1) ;
- }
- n_clst = sz_vol / pau;
- if (n_clst > MAX_FAT12) {
- n = n_clst * 2 + 4;
- } else {
- fmt = FS_FAT12;
- n = (n_clst * 3 + 1) / 2 + 3;
- }
- sz_fat = (n + ss - 1) / ss;
- sz_rsv = 1;
- sz_dir = (DWORD)n_rootdir * SZDIRE / ss;
- }
- b_fat = b_vol + sz_rsv;
- b_data = b_fat + sz_fat * n_fats + sz_dir;
-
- n = ((b_data + sz_blk - 1) & ~(sz_blk - 1)) - b_data;
- if (fmt == FS_FAT32) {
- sz_rsv += n; b_fat += n;
- } else {
- sz_fat += n / n_fats;
- }
-
- if (sz_vol < b_data + pau * 16 - b_vol) return FR_MKFS_ABORTED;
- n_clst = (sz_vol - sz_rsv - sz_fat * n_fats - sz_dir) / pau;
- if (fmt == FS_FAT32) {
- if (n_clst <= MAX_FAT16) {
- if (!au && (au = pau / 2) != 0) continue;
- return FR_MKFS_ABORTED;
- }
- }
- if (fmt == FS_FAT16) {
- if (n_clst > MAX_FAT16) {
- if (!au && (pau * 2) <= 64) {
- au = pau * 2; continue;
- }
- if ((opt & FM_FAT32)) {
- fmt = FS_FAT32; continue;
- }
- if (!au && (au = pau * 2) <= 128) continue;
- return FR_MKFS_ABORTED;
- }
- if (n_clst <= MAX_FAT12) {
- if (!au && (au = pau * 2) <= 128) continue;
- return FR_MKFS_ABORTED;
- }
- }
- if (fmt == FS_FAT12 && n_clst > MAX_FAT12) return FR_MKFS_ABORTED;
-
- break;
- } while (1);
- #if _USE_TRIM
- tbl[0] = b_vol; tbl[1] = b_vol + sz_vol - 1;
- disk_ioctl(pdrv, CTRL_TRIM, tbl);
- #endif
-
- mem_set(buf, 0, ss);
- mem_cpy(buf + BS_JmpBoot, "\xEB\xFE\x90" "MSDOS5.0", 11);
- st_word(buf + BPB_BytsPerSec, ss);
- buf[BPB_SecPerClus] = (BYTE)pau;
- st_word(buf + BPB_RsvdSecCnt, (WORD)sz_rsv);
- buf[BPB_NumFATs] = (BYTE)n_fats;
- st_word(buf + BPB_RootEntCnt, (WORD)((fmt == FS_FAT32) ? 0 : n_rootdir));
- if (sz_vol < 0x10000) {
- st_word(buf + BPB_TotSec16, (WORD)sz_vol);
- } else {
- st_dword(buf + BPB_TotSec32, sz_vol);
- }
- buf[BPB_Media] = 0xF8;
- st_word(buf + BPB_SecPerTrk, 63);
- st_word(buf + BPB_NumHeads, 255);
- st_dword(buf + BPB_HiddSec, b_vol);
- if (fmt == FS_FAT32) {
- st_dword(buf + BS_VolID32, GET_FATTIME());
- st_dword(buf + BPB_FATSz32, sz_fat);
- st_dword(buf + BPB_RootClus32, 2);
- st_word(buf + BPB_FSInfo32, 1);
- st_word(buf + BPB_BkBootSec32, 6);
- buf[BS_DrvNum32] = 0x80;
- buf[BS_BootSig32] = 0x29;
- mem_cpy(buf + BS_VolLab32, "NO NAME " "FAT32 ", 19);
- } else {
- st_dword(buf + BS_VolID, GET_FATTIME());
- st_word(buf + BPB_FATSz16, (WORD)sz_fat);
- buf[BS_DrvNum] = 0x80;
- buf[BS_BootSig] = 0x29;
- mem_cpy(buf + BS_VolLab, "NO NAME " "FAT ", 19);
- }
- st_word(buf + BS_55AA, 0xAA55);
- if (disk_write(pdrv, buf, b_vol, 1) != RES_OK) return FR_DISK_ERR;
-
- if (fmt == FS_FAT32) {
- disk_write(pdrv, buf, b_vol + 6, 1);
- mem_set(buf, 0, ss);
- st_dword(buf + FSI_LeadSig, 0x41615252);
- st_dword(buf + FSI_StrucSig, 0x61417272);
- st_dword(buf + FSI_Free_Count, n_clst - 1);
- st_dword(buf + FSI_Nxt_Free, 2);
- st_word(buf + BS_55AA, 0xAA55);
- disk_write(pdrv, buf, b_vol + 7, 1);
- disk_write(pdrv, buf, b_vol + 1, 1);
- }
-
- mem_set(buf, 0, (UINT)szb_buf);
- sect = b_fat;
- for (i = 0; i < n_fats; i++) {
- if (fmt == FS_FAT32) {
- st_dword(buf + 0, 0xFFFFFFF8);
- st_dword(buf + 4, 0xFFFFFFFF);
- st_dword(buf + 8, 0x0FFFFFFF);
- } else {
- st_dword(buf + 0, (fmt == FS_FAT12) ? 0xFFFFF8 : 0xFFFFFFF8);
- }
- nsect = sz_fat;
- do {
- n = (nsect > sz_buf) ? sz_buf : nsect;
- if (disk_write(pdrv, buf, sect, (UINT)n) != RES_OK) return FR_DISK_ERR;
- mem_set(buf, 0, ss);
- sect += n; nsect -= n;
- } while (nsect);
- }
-
- nsect = (fmt == FS_FAT32) ? pau : sz_dir;
- do {
- n = (nsect > sz_buf) ? sz_buf : nsect;
- if (disk_write(pdrv, buf, sect, (UINT)n) != RES_OK) return FR_DISK_ERR;
- sect += n; nsect -= n;
- } while (nsect);
- }
-
- if (_FS_EXFAT && fmt == FS_EXFAT) {
- sys = 0x07;
- } else {
- if (fmt == FS_FAT32) {
- sys = 0x0C;
- } else {
- if (sz_vol >= 0x10000) {
- sys = 0x06;
- } else {
- sys = (fmt == FS_FAT16) ? 0x04 : 0x01;
- }
- }
- }
- if (_MULTI_PARTITION && part != 0) {
-
- if (disk_read(pdrv, buf, 0, 1) != RES_OK) return FR_DISK_ERR;
- buf[MBR_Table + (part - 1) * SZ_PTE + PTE_System] = sys;
- if (disk_write(pdrv, buf, 0, 1) != RES_OK) return FR_DISK_ERR;
- } else {
- if (!(opt & FM_SFD)) {
-
- mem_set(buf, 0, ss);
- st_word(buf + BS_55AA, 0xAA55);
- pte = buf + MBR_Table;
- pte[PTE_Boot] = 0;
- pte[PTE_StHead] = 1;
- pte[PTE_StSec] = 1;
- pte[PTE_StCyl] = 0;
- pte[PTE_System] = sys;
- n = (b_vol + sz_vol) / (63 * 255);
- pte[PTE_EdHead] = 254;
- pte[PTE_EdSec] = (BYTE)(n >> 2 | 63);
- pte[PTE_EdCyl] = (BYTE)n;
- st_dword(pte + PTE_StLba, b_vol);
- st_dword(pte + PTE_SizLba, sz_vol);
- if (disk_write(pdrv, buf, 0, 1) != RES_OK) return FR_DISK_ERR;
- }
- }
- if (disk_ioctl(pdrv, CTRL_SYNC, 0) != RES_OK) return FR_DISK_ERR;
- return FR_OK;
- }
- #if _MULTI_PARTITION
- FRESULT f_fdisk (
- BYTE pdrv,
- const DWORD* szt,
- void* work
- )
- {
- UINT i, n, sz_cyl, tot_cyl, b_cyl, e_cyl, p_cyl;
- BYTE s_hd, e_hd, *p, *buf = (BYTE*)work;
- DSTATUS stat;
- DWORD sz_disk, sz_part, s_part;
- stat = disk_initialize(pdrv);
- if (stat & STA_NOINIT) return FR_NOT_READY;
- if (stat & STA_PROTECT) return FR_WRITE_PROTECTED;
- if (disk_ioctl(pdrv, GET_SECTOR_COUNT, &sz_disk)) return FR_DISK_ERR;
-
- for (n = 16; n < 256 && sz_disk / n / 63 > 1024; n *= 2) ;
- if (n == 256) n--;
- e_hd = n - 1;
- sz_cyl = 63 * n;
- tot_cyl = sz_disk / sz_cyl;
-
- mem_set(buf, 0, _MAX_SS);
- p = buf + MBR_Table; b_cyl = 0;
- for (i = 0; i < 4; i++, p += SZ_PTE) {
- p_cyl = (szt[i] <= 100U) ? (DWORD)tot_cyl * szt[i] / 100 : szt[i] / sz_cyl;
- if (!p_cyl) continue;
- s_part = (DWORD)sz_cyl * b_cyl;
- sz_part = (DWORD)sz_cyl * p_cyl;
- if (i == 0) {
- s_hd = 1;
- s_part += 63; sz_part -= 63;
- } else {
- s_hd = 0;
- }
- e_cyl = b_cyl + p_cyl - 1;
- if (e_cyl >= tot_cyl) return FR_INVALID_PARAMETER;
-
- p[1] = s_hd;
- p[2] = (BYTE)((b_cyl >> 2) + 1);
- p[3] = (BYTE)b_cyl;
- p[4] = 0x06;
- p[5] = e_hd;
- p[6] = (BYTE)((e_cyl >> 2) + 63);
- p[7] = (BYTE)e_cyl;
- st_dword(p + 8, s_part);
- st_dword(p + 12, sz_part);
-
- b_cyl += p_cyl;
- }
- st_word(p, 0xAA55);
-
- return (disk_write(pdrv, buf, 0, 1) != RES_OK || disk_ioctl(pdrv, CTRL_SYNC, 0) != RES_OK) ? FR_DISK_ERR : FR_OK;
- }
- #endif
- #endif
- #if _USE_STRFUNC
- TCHAR* f_gets (
- TCHAR* buff,
- int len,
- FIL* fp
- )
- {
- int n = 0;
- TCHAR c, *p = buff;
- BYTE s[2];
- UINT rc;
- while (n < len - 1) {
- #if _LFN_UNICODE
- #if _STRF_ENCODE == 3
- f_read(fp, s, 1, &rc);
- if (rc != 1) break;
- c = s[0];
- if (c >= 0x80) {
- if (c < 0xC0) continue;
- if (c < 0xE0) {
- f_read(fp, s, 1, &rc);
- if (rc != 1) break;
- c = (c & 0x1F) << 6 | (s[0] & 0x3F);
- if (c < 0x80) c = '?';
- } else {
- if (c < 0xF0) {
- f_read(fp, s, 2, &rc);
- if (rc != 2) break;
- c = c << 12 | (s[0] & 0x3F) << 6 | (s[1] & 0x3F);
- if (c < 0x800) c = '?';
- } else {
- c = '?';
- }
- }
- }
- #elif _STRF_ENCODE == 2
- f_read(fp, s, 2, &rc);
- if (rc != 2) break;
- c = s[1] + (s[0] << 8);
- #elif _STRF_ENCODE == 1
- f_read(fp, s, 2, &rc);
- if (rc != 2) break;
- c = s[0] + (s[1] << 8);
- #else
- f_read(fp, s, 1, &rc);
- if (rc != 1) break;
- c = s[0];
- if (IsDBCS1(c)) {
- f_read(fp, s, 1, &rc);
- if (rc != 1) break;
- c = (c << 8) + s[0];
- }
- c = ff_convert(c, 1);
- if (!c) c = '?';
- #endif
- #else
- f_read(fp, s, 1, &rc);
- if (rc != 1) break;
- c = s[0];
- #endif
- if (_USE_STRFUNC == 2 && c == '\r') continue;
- *p++ = c;
- n++;
- if (c == '\n') break;
- }
- *p = 0;
- return n ? buff : 0;
- }
- #if !_FS_READONLY
- #include <stdarg.h>
- typedef struct {
- FIL *fp;
- int idx, nchr;
- BYTE buf[64];
- } putbuff;
- static
- void putc_bfd (
- putbuff* pb,
- TCHAR c
- )
- {
- UINT bw;
- int i;
- if (_USE_STRFUNC == 2 && c == '\n') {
- putc_bfd(pb, '\r');
- }
- i = pb->idx;
- if (i < 0) return;
- #if _LFN_UNICODE
- #if _STRF_ENCODE == 3
- if (c < 0x80) {
- pb->buf[i++] = (BYTE)c;
- } else {
- if (c < 0x800) {
- pb->buf[i++] = (BYTE)(0xC0 | c >> 6);
- } else {
- pb->buf[i++] = (BYTE)(0xE0 | c >> 12);
- pb->buf[i++] = (BYTE)(0x80 | (c >> 6 & 0x3F));
- }
- pb->buf[i++] = (BYTE)(0x80 | (c & 0x3F));
- }
- #elif _STRF_ENCODE == 2
- pb->buf[i++] = (BYTE)(c >> 8);
- pb->buf[i++] = (BYTE)c;
- #elif _STRF_ENCODE == 1
- pb->buf[i++] = (BYTE)c;
- pb->buf[i++] = (BYTE)(c >> 8);
- #else
- c = ff_convert(c, 0);
- if (!c) c = '?';
- if (c >= 0x100)
- pb->buf[i++] = (BYTE)(c >> 8);
- pb->buf[i++] = (BYTE)c;
- #endif
- #else
- pb->buf[i++] = (BYTE)c;
- #endif
- if (i >= (int)(sizeof pb->buf) - 3) {
- f_write(pb->fp, pb->buf, (UINT)i, &bw);
- i = (bw == (UINT)i) ? 0 : -1;
- }
- pb->idx = i;
- pb->nchr++;
- }
- static
- int putc_flush (
- putbuff* pb
- )
- {
- UINT nw;
- if ( pb->idx >= 0
- && f_write(pb->fp, pb->buf, (UINT)pb->idx, &nw) == FR_OK
- && (UINT)pb->idx == nw) return pb->nchr;
- return EOF;
- }
- static
- void putc_init (
- putbuff* pb,
- FIL* fp
- )
- {
- pb->fp = fp;
- pb->nchr = pb->idx = 0;
- }
- int f_putc (
- TCHAR c,
- FIL* fp
- )
- {
- putbuff pb;
- putc_init(&pb, fp);
- putc_bfd(&pb, c);
- return putc_flush(&pb);
- }
- int f_puts (
- const TCHAR* str,
- FIL* fp
- )
- {
- putbuff pb;
- putc_init(&pb, fp);
- while (*str) putc_bfd(&pb, *str++);
- return putc_flush(&pb);
- }
- int f_printf (
- FIL* fp,
- const TCHAR* fmt,
- ...
- )
- {
- va_list arp;
- putbuff pb;
- BYTE f, r;
- UINT i, j, w;
- DWORD v;
- TCHAR c, d, str[32], *p;
- putc_init(&pb, fp);
- va_start(arp, fmt);
- for (;;) {
- c = *fmt++;
- if (c == 0) break;
- if (c != '%') {
- putc_bfd(&pb, c);
- continue;
- }
- w = f = 0;
- c = *fmt++;
- if (c == '0') {
- f = 1; c = *fmt++;
- } else {
- if (c == '-') {
- f = 2; c = *fmt++;
- }
- }
- while (IsDigit(c)) {
- w = w * 10 + c - '0';
- c = *fmt++;
- }
- if (c == 'l' || c == 'L') {
- f |= 4; c = *fmt++;
- }
- if (!c) break;
- d = c;
- if (IsLower(d)) d -= 0x20;
- switch (d) {
- case 'S' :
- p = va_arg(arp, TCHAR*);
- for (j = 0; p[j]; j++) ;
- if (!(f & 2)) {
- while (j++ < w) putc_bfd(&pb, ' ');
- }
- while (*p) putc_bfd(&pb, *p++);
- while (j++ < w) putc_bfd(&pb, ' ');
- continue;
- case 'C' :
- putc_bfd(&pb, (TCHAR)va_arg(arp, int)); continue;
- case 'B' :
- r = 2; break;
- case 'O' :
- r = 8; break;
- case 'D' :
- case 'U' :
- r = 10; break;
- case 'X' :
- r = 16; break;
- default:
- putc_bfd(&pb, c); continue;
- }
-
- v = (f & 4) ? (DWORD)va_arg(arp, long) : ((d == 'D') ? (DWORD)(long)va_arg(arp, int) : (DWORD)va_arg(arp, unsigned int));
- if (d == 'D' && (v & 0x80000000)) {
- v = 0 - v;
- f |= 8;
- }
- i = 0;
- do {
- d = (TCHAR)(v % r); v /= r;
- if (d > 9) d += (c == 'x') ? 0x27 : 0x07;
- str[i++] = d + '0';
- } while (v && i < sizeof str / sizeof str[0]);
- if (f & 8) str[i++] = '-';
- j = i; d = (f & 1) ? '0' : ' ';
- while (!(f & 2) && j++ < w) putc_bfd(&pb, d);
- do putc_bfd(&pb, str[--i]); while (i);
- while (j++ < w) putc_bfd(&pb, d);
- }
- va_end(arp);
- return putc_flush(&pb);
- }
- #endif
- #endif
|