| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272327332743275327632773278327932803281328232833284328532863287328832893290329132923293329432953296329732983299330033013302330333043305330633073308330933103311331233133314331533163317331833193320332133223323332433253326332733283329333033313332333333343335333633373338333933403341334233433344334533463347334833493350335133523353335433553356335733583359336033613362336333643365336633673368336933703371337233733374337533763377337833793380338133823383338433853386338733883389339033913392339333943395339633973398339934003401340234033404340534063407340834093410341134123413341434153416341734183419342034213422342334243425342634273428342934303431343234333434343534363437343834393440344134423443344434453446344734483449345034513452345334543455345634573458345934603461346234633464346534663467346834693470347134723473347434753476347734783479348034813482348334843485348634873488348934903491349234933494349534963497349834993500350135023503350435053506350735083509351035113512351335143515351635173518351935203521352235233524352535263527352835293530353135323533353435353536353735383539354035413542354335443545354635473548354935503551355235533554355535563557355835593560356135623563356435653566356735683569357035713572357335743575357635773578357935803581358235833584358535863587358835893590359135923593359435953596359735983599360036013602360336043605360636073608360936103611361236133614361536163617361836193620362136223623362436253626362736283629363036313632363336343635363636373638363936403641364236433644364536463647364836493650365136523653365436553656365736583659366036613662366336643665366636673668366936703671367236733674367536763677367836793680368136823683368436853686368736883689369036913692369336943695369636973698369937003701370237033704370537063707370837093710371137123713371437153716371737183719372037213722372337243725372637273728372937303731373237333734373537363737373837393740374137423743374437453746374737483749375037513752375337543755375637573758375937603761376237633764376537663767376837693770377137723773377437753776377737783779378037813782378337843785378637873788378937903791379237933794379537963797379837993800380138023803380438053806380738083809381038113812381338143815381638173818381938203821382238233824382538263827382838293830383138323833383438353836383738383839384038413842384338443845384638473848384938503851385238533854385538563857385838593860386138623863386438653866386738683869387038713872387338743875387638773878387938803881388238833884388538863887388838893890389138923893389438953896389738983899390039013902390339043905390639073908390939103911391239133914391539163917391839193920392139223923392439253926392739283929393039313932393339343935393639373938393939403941394239433944394539463947394839493950395139523953395439553956395739583959396039613962396339643965396639673968396939703971397239733974397539763977397839793980398139823983398439853986398739883989399039913992399339943995399639973998399940004001400240034004400540064007400840094010401140124013401440154016401740184019402040214022402340244025402640274028402940304031403240334034403540364037403840394040404140424043404440454046404740484049405040514052405340544055405640574058405940604061406240634064406540664067406840694070407140724073407440754076407740784079408040814082408340844085408640874088408940904091409240934094409540964097409840994100410141024103410441054106410741084109411041114112411341144115411641174118411941204121412241234124412541264127412841294130413141324133413441354136413741384139414041414142414341444145414641474148414941504151415241534154415541564157415841594160416141624163416441654166416741684169417041714172417341744175417641774178417941804181418241834184418541864187418841894190419141924193419441954196419741984199420042014202420342044205420642074208420942104211421242134214421542164217421842194220422142224223422442254226422742284229423042314232423342344235423642374238423942404241424242434244424542464247424842494250425142524253425442554256425742584259426042614262426342644265426642674268426942704271427242734274427542764277427842794280428142824283428442854286428742884289429042914292429342944295429642974298429943004301430243034304430543064307430843094310431143124313431443154316431743184319432043214322432343244325432643274328432943304331433243334334433543364337433843394340434143424343434443454346434743484349435043514352435343544355435643574358435943604361436243634364436543664367436843694370437143724373437443754376437743784379438043814382438343844385438643874388438943904391439243934394439543964397439843994400440144024403440444054406440744084409441044114412441344144415441644174418441944204421442244234424442544264427442844294430443144324433443444354436443744384439444044414442444344444445444644474448444944504451445244534454445544564457445844594460446144624463446444654466446744684469447044714472447344744475447644774478447944804481448244834484448544864487448844894490449144924493449444954496449744984499450045014502450345044505450645074508450945104511451245134514451545164517451845194520452145224523452445254526452745284529453045314532453345344535453645374538453945404541454245434544454545464547454845494550455145524553455445554556455745584559456045614562456345644565456645674568456945704571457245734574457545764577457845794580458145824583458445854586458745884589459045914592459345944595459645974598459946004601460246034604460546064607460846094610461146124613461446154616461746184619462046214622462346244625462646274628462946304631463246334634463546364637463846394640464146424643464446454646464746484649465046514652465346544655465646574658465946604661466246634664466546664667466846694670467146724673467446754676467746784679468046814682468346844685468646874688468946904691469246934694469546964697469846994700470147024703470447054706470747084709471047114712471347144715471647174718471947204721472247234724472547264727472847294730473147324733473447354736473747384739474047414742474347444745474647474748474947504751475247534754475547564757475847594760476147624763476447654766476747684769477047714772477347744775477647774778477947804781478247834784478547864787478847894790479147924793479447954796479747984799480048014802480348044805480648074808480948104811481248134814481548164817481848194820482148224823482448254826482748284829483048314832483348344835483648374838483948404841484248434844484548464847484848494850485148524853485448554856485748584859486048614862486348644865486648674868486948704871487248734874487548764877487848794880488148824883488448854886488748884889489048914892489348944895489648974898489949004901490249034904490549064907490849094910491149124913491449154916491749184919492049214922492349244925492649274928492949304931493249334934493549364937493849394940494149424943494449454946494749484949495049514952495349544955495649574958495949604961496249634964496549664967496849694970497149724973497449754976497749784979498049814982498349844985498649874988498949904991499249934994499549964997499849995000500150025003500450055006500750085009501050115012501350145015501650175018501950205021502250235024502550265027502850295030503150325033503450355036503750385039504050415042504350445045504650475048504950505051505250535054505550565057505850595060506150625063506450655066506750685069507050715072507350745075507650775078507950805081508250835084508550865087508850895090509150925093509450955096509750985099510051015102510351045105510651075108510951105111511251135114511551165117511851195120512151225123512451255126512751285129513051315132513351345135513651375138513951405141514251435144514551465147514851495150515151525153515451555156515751585159516051615162516351645165516651675168516951705171517251735174517551765177517851795180518151825183518451855186518751885189519051915192519351945195519651975198519952005201520252035204520552065207520852095210521152125213521452155216521752185219522052215222522352245225522652275228522952305231523252335234523552365237523852395240524152425243524452455246524752485249525052515252525352545255525652575258525952605261526252635264526552665267526852695270527152725273527452755276527752785279528052815282528352845285528652875288528952905291529252935294529552965297529852995300530153025303530453055306530753085309531053115312531353145315531653175318531953205321532253235324532553265327532853295330533153325333533453355336533753385339534053415342534353445345534653475348534953505351535253535354535553565357535853595360536153625363536453655366536753685369537053715372537353745375537653775378537953805381538253835384538553865387538853895390539153925393539453955396539753985399540054015402540354045405540654075408540954105411541254135414541554165417541854195420542154225423542454255426542754285429543054315432543354345435543654375438543954405441544254435444544554465447544854495450545154525453545454555456545754585459546054615462546354645465546654675468546954705471547254735474547554765477547854795480548154825483548454855486548754885489549054915492549354945495549654975498549955005501550255035504550555065507550855095510551155125513551455155516551755185519552055215522552355245525552655275528552955305531553255335534553555365537553855395540554155425543554455455546554755485549555055515552555355545555555655575558555955605561556255635564556555665567556855695570557155725573557455755576557755785579558055815582558355845585558655875588558955905591559255935594559555965597559855995600560156025603560456055606560756085609561056115612561356145615561656175618561956205621562256235624562556265627562856295630563156325633563456355636563756385639564056415642564356445645564656475648564956505651565256535654565556565657565856595660566156625663566456655666566756685669567056715672567356745675567656775678567956805681568256835684568556865687568856895690569156925693569456955696569756985699570057015702570357045705570657075708570957105711571257135714571557165717571857195720572157225723572457255726572757285729573057315732573357345735573657375738573957405741574257435744574557465747574857495750575157525753575457555756575757585759576057615762576357645765576657675768576957705771577257735774577557765777577857795780578157825783578457855786578757885789579057915792579357945795579657975798579958005801580258035804580558065807580858095810581158125813581458155816581758185819582058215822582358245825582658275828582958305831583258335834583558365837583858395840584158425843584458455846584758485849585058515852585358545855585658575858585958605861586258635864586558665867586858695870587158725873587458755876587758785879588058815882588358845885588658875888588958905891589258935894589558965897589858995900590159025903590459055906590759085909591059115912591359145915591659175918591959205921592259235924592559265927592859295930593159325933593459355936593759385939594059415942594359445945594659475948594959505951595259535954595559565957595859595960596159625963596459655966596759685969597059715972597359745975597659775978597959805981598259835984598559865987598859895990599159925993599459955996599759985999600060016002600360046005600660076008600960106011601260136014601560166017601860196020602160226023602460256026602760286029603060316032603360346035603660376038603960406041604260436044604560466047604860496050605160526053605460556056605760586059606060616062606360646065606660676068606960706071607260736074607560766077607860796080608160826083608460856086608760886089609060916092609360946095609660976098609961006101610261036104610561066107610861096110611161126113611461156116611761186119612061216122612361246125612661276128612961306131613261336134613561366137613861396140614161426143614461456146614761486149615061516152615361546155615661576158615961606161616261636164616561666167616861696170617161726173617461756176617761786179618061816182618361846185618661876188618961906191619261936194619561966197619861996200620162026203620462056206620762086209621062116212621362146215621662176218621962206221622262236224622562266227622862296230623162326233623462356236623762386239624062416242624362446245624662476248624962506251625262536254625562566257625862596260626162626263626462656266626762686269627062716272627362746275627662776278627962806281628262836284628562866287628862896290629162926293629462956296629762986299630063016302630363046305630663076308630963106311631263136314631563166317631863196320632163226323632463256326632763286329633063316332633363346335633663376338633963406341634263436344634563466347634863496350635163526353635463556356635763586359636063616362636363646365636663676368636963706371637263736374637563766377637863796380638163826383638463856386638763886389639063916392639363946395639663976398639964006401640264036404640564066407640864096410641164126413641464156416641764186419642064216422642364246425642664276428642964306431643264336434643564366437643864396440644164426443644464456446644764486449645064516452645364546455645664576458645964606461646264636464646564666467646864696470647164726473647464756476647764786479648064816482648364846485648664876488648964906491649264936494649564966497649864996500650165026503650465056506650765086509651065116512651365146515651665176518651965206521652265236524652565266527652865296530653165326533653465356536653765386539654065416542654365446545654665476548654965506551655265536554655565566557655865596560656165626563656465656566656765686569657065716572657365746575657665776578657965806581658265836584658565866587658865896590659165926593659465956596659765986599660066016602660366046605660666076608660966106611661266136614661566166617661866196620662166226623662466256626662766286629663066316632663366346635663666376638663966406641664266436644664566466647664866496650665166526653665466556656665766586659666066616662666366646665666666676668666966706671667266736674667566766677667866796680668166826683668466856686668766886689669066916692669366946695669666976698669967006701670267036704670567066707670867096710671167126713671467156716671767186719672067216722672367246725672667276728672967306731673267336734673567366737673867396740674167426743674467456746674767486749675067516752675367546755675667576758675967606761676267636764676567666767676867696770677167726773677467756776677767786779678067816782678367846785678667876788678967906791679267936794679567966797679867996800680168026803680468056806680768086809681068116812681368146815681668176818681968206821682268236824682568266827682868296830683168326833683468356836683768386839684068416842684368446845684668476848684968506851685268536854685568566857685868596860686168626863686468656866686768686869687068716872687368746875687668776878687968806881688268836884688568866887688868896890689168926893689468956896689768986899690069016902690369046905690669076908690969106911691269136914691569166917691869196920692169226923692469256926692769286929693069316932693369346935693669376938693969406941694269436944694569466947694869496950695169526953695469556956695769586959696069616962696369646965696669676968696969706971697269736974697569766977697869796980698169826983698469856986698769886989699069916992699369946995699669976998699970007001700270037004700570067007700870097010701170127013701470157016701770187019702070217022702370247025702670277028702970307031703270337034703570367037703870397040704170427043704470457046704770487049705070517052705370547055705670577058705970607061706270637064706570667067706870697070707170727073707470757076707770787079708070817082708370847085708670877088708970907091709270937094709570967097709870997100710171027103710471057106710771087109711071117112711371147115711671177118711971207121712271237124712571267127712871297130713171327133713471357136713771387139714071417142714371447145714671477148714971507151715271537154715571567157715871597160716171627163716471657166716771687169717071717172717371747175717671777178717971807181718271837184718571867187718871897190719171927193719471957196719771987199720072017202720372047205720672077208720972107211721272137214721572167217721872197220722172227223722472257226722772287229723072317232723372347235723672377238723972407241724272437244724572467247724872497250725172527253725472557256725772587259726072617262726372647265726672677268726972707271727272737274727572767277727872797280728172827283728472857286728772887289729072917292729372947295729672977298729973007301730273037304730573067307730873097310731173127313731473157316731773187319732073217322732373247325732673277328732973307331733273337334733573367337733873397340734173427343734473457346734773487349735073517352735373547355735673577358735973607361736273637364736573667367736873697370737173727373737473757376737773787379738073817382738373847385738673877388738973907391739273937394739573967397739873997400740174027403740474057406740774087409741074117412741374147415741674177418741974207421742274237424742574267427742874297430743174327433743474357436743774387439744074417442744374447445744674477448744974507451745274537454745574567457745874597460746174627463746474657466746774687469747074717472747374747475747674777478747974807481748274837484748574867487748874897490749174927493749474957496749774987499750075017502750375047505750675077508750975107511751275137514751575167517751875197520752175227523752475257526752775287529753075317532753375347535753675377538753975407541754275437544754575467547754875497550755175527553755475557556755775587559756075617562756375647565756675677568756975707571757275737574757575767577757875797580758175827583758475857586758775887589759075917592759375947595759675977598759976007601760276037604760576067607760876097610761176127613761476157616761776187619762076217622762376247625762676277628762976307631763276337634763576367637763876397640764176427643764476457646764776487649765076517652765376547655765676577658765976607661766276637664766576667667766876697670767176727673767476757676767776787679768076817682768376847685768676877688768976907691769276937694769576967697769876997700770177027703770477057706770777087709771077117712771377147715771677177718771977207721772277237724772577267727772877297730773177327733773477357736773777387739774077417742774377447745774677477748774977507751775277537754775577567757775877597760776177627763776477657766776777687769777077717772777377747775777677777778777977807781778277837784778577867787778877897790779177927793779477957796779777987799780078017802780378047805780678077808780978107811781278137814781578167817781878197820782178227823782478257826782778287829783078317832783378347835783678377838783978407841784278437844784578467847784878497850785178527853785478557856785778587859786078617862786378647865786678677868786978707871787278737874787578767877787878797880788178827883788478857886788778887889789078917892789378947895789678977898789979007901790279037904790579067907790879097910791179127913791479157916791779187919792079217922792379247925792679277928792979307931793279337934793579367937793879397940794179427943794479457946794779487949795079517952795379547955795679577958795979607961796279637964796579667967796879697970797179727973797479757976797779787979798079817982798379847985798679877988798979907991799279937994799579967997799879998000800180028003800480058006800780088009801080118012801380148015801680178018801980208021802280238024802580268027802880298030803180328033803480358036803780388039804080418042804380448045804680478048804980508051805280538054805580568057805880598060806180628063806480658066806780688069807080718072807380748075807680778078807980808081808280838084808580868087808880898090809180928093809480958096809780988099810081018102810381048105810681078108810981108111811281138114811581168117811881198120812181228123812481258126812781288129813081318132813381348135813681378138813981408141814281438144814581468147814881498150815181528153815481558156815781588159816081618162816381648165816681678168816981708171817281738174817581768177817881798180818181828183818481858186818781888189819081918192819381948195819681978198819982008201820282038204820582068207820882098210821182128213821482158216821782188219822082218222822382248225822682278228822982308231823282338234823582368237823882398240824182428243824482458246824782488249825082518252825382548255825682578258825982608261826282638264826582668267826882698270827182728273827482758276827782788279828082818282828382848285828682878288828982908291829282938294829582968297829882998300830183028303830483058306830783088309831083118312831383148315831683178318831983208321832283238324832583268327832883298330833183328333833483358336833783388339834083418342834383448345834683478348834983508351835283538354835583568357835883598360836183628363836483658366836783688369837083718372837383748375837683778378837983808381838283838384838583868387838883898390839183928393839483958396839783988399840084018402840384048405840684078408840984108411841284138414841584168417841884198420842184228423842484258426842784288429843084318432843384348435843684378438843984408441844284438444844584468447844884498450845184528453845484558456845784588459846084618462846384648465846684678468846984708471847284738474847584768477847884798480848184828483848484858486848784888489849084918492849384948495849684978498849985008501850285038504850585068507850885098510851185128513851485158516851785188519852085218522852385248525852685278528852985308531853285338534853585368537853885398540854185428543854485458546854785488549855085518552855385548555855685578558855985608561856285638564856585668567856885698570857185728573857485758576857785788579858085818582858385848585858685878588858985908591859285938594859585968597859885998600860186028603860486058606860786088609861086118612861386148615861686178618861986208621862286238624862586268627862886298630863186328633863486358636863786388639864086418642864386448645864686478648864986508651865286538654865586568657865886598660866186628663866486658666866786688669867086718672867386748675867686778678867986808681868286838684868586868687868886898690869186928693869486958696869786988699870087018702870387048705870687078708870987108711871287138714871587168717871887198720872187228723872487258726872787288729873087318732873387348735873687378738873987408741874287438744874587468747874887498750875187528753875487558756875787588759876087618762876387648765876687678768876987708771877287738774877587768777877887798780878187828783878487858786878787888789879087918792879387948795879687978798879988008801880288038804880588068807880888098810881188128813881488158816881788188819882088218822882388248825882688278828882988308831883288338834883588368837883888398840884188428843884488458846884788488849885088518852885388548855885688578858885988608861886288638864886588668867886888698870887188728873887488758876887788788879888088818882888388848885888688878888888988908891889288938894889588968897889888998900890189028903890489058906890789088909891089118912891389148915891689178918891989208921892289238924892589268927892889298930893189328933893489358936893789388939894089418942894389448945894689478948894989508951895289538954895589568957895889598960896189628963896489658966896789688969897089718972897389748975897689778978897989808981898289838984898589868987898889898990899189928993899489958996899789988999900090019002900390049005900690079008900990109011901290139014901590169017901890199020902190229023902490259026902790289029903090319032903390349035903690379038903990409041904290439044904590469047904890499050905190529053905490559056905790589059906090619062906390649065906690679068906990709071907290739074907590769077907890799080908190829083908490859086908790889089909090919092909390949095909690979098909991009101910291039104910591069107910891099110911191129113911491159116911791189119912091219122912391249125912691279128912991309131913291339134913591369137913891399140914191429143914491459146914791489149915091519152915391549155915691579158915991609161916291639164916591669167916891699170917191729173917491759176917791789179918091819182918391849185918691879188918991909191919291939194919591969197919891999200920192029203920492059206920792089209921092119212921392149215921692179218921992209221922292239224922592269227922892299230923192329233923492359236923792389239924092419242924392449245924692479248924992509251925292539254925592569257925892599260926192629263926492659266926792689269927092719272927392749275927692779278927992809281928292839284928592869287928892899290929192929293929492959296929792989299930093019302930393049305930693079308930993109311931293139314931593169317931893199320932193229323932493259326932793289329933093319332933393349335933693379338933993409341934293439344934593469347934893499350935193529353935493559356935793589359936093619362936393649365936693679368936993709371937293739374937593769377937893799380938193829383938493859386938793889389939093919392939393949395939693979398939994009401940294039404940594069407940894099410941194129413941494159416941794189419942094219422942394249425942694279428942994309431943294339434943594369437943894399440944194429443944494459446944794489449945094519452945394549455945694579458945994609461946294639464946594669467946894699470947194729473947494759476947794789479948094819482948394849485948694879488948994909491949294939494949594969497949894999500950195029503950495059506950795089509951095119512951395149515951695179518951995209521952295239524952595269527952895299530953195329533953495359536953795389539954095419542954395449545954695479548954995509551955295539554955595569557955895599560956195629563956495659566956795689569957095719572957395749575957695779578957995809581958295839584958595869587958895899590959195929593959495959596959795989599960096019602960396049605960696079608960996109611961296139614961596169617961896199620962196229623962496259626962796289629963096319632963396349635963696379638963996409641964296439644964596469647964896499650965196529653965496559656965796589659966096619662966396649665966696679668966996709671967296739674967596769677967896799680968196829683968496859686968796889689969096919692969396949695969696979698969997009701970297039704970597069707970897099710971197129713971497159716971797189719972097219722972397249725972697279728972997309731973297339734973597369737973897399740974197429743974497459746974797489749975097519752975397549755975697579758975997609761976297639764976597669767976897699770977197729773977497759776977797789779978097819782978397849785978697879788978997909791979297939794979597969797979897999800980198029803980498059806980798089809981098119812981398149815981698179818981998209821982298239824982598269827982898299830983198329833983498359836983798389839984098419842984398449845984698479848984998509851985298539854985598569857985898599860986198629863986498659866986798689869987098719872987398749875987698779878987998809881988298839884988598869887988898899890989198929893989498959896989798989899990099019902990399049905990699079908990999109911991299139914991599169917991899199920992199229923992499259926992799289929993099319932993399349935993699379938993999409941994299439944994599469947994899499950995199529953995499559956995799589959996099619962996399649965996699679968996999709971997299739974997599769977997899799980998199829983998499859986998799889989999099919992999399949995999699979998999910000100011000210003100041000510006100071000810009100101001110012100131001410015100161001710018100191002010021100221002310024100251002610027100281002910030100311003210033100341003510036100371003810039100401004110042100431004410045100461004710048100491005010051100521005310054100551005610057100581005910060100611006210063100641006510066100671006810069100701007110072100731007410075100761007710078100791008010081100821008310084100851008610087100881008910090100911009210093100941009510096100971009810099101001010110102101031010410105101061010710108101091011010111101121011310114101151011610117101181011910120101211012210123101241012510126101271012810129101301013110132101331013410135101361013710138101391014010141101421014310144101451014610147101481014910150101511015210153101541015510156101571015810159101601016110162101631016410165101661016710168101691017010171101721017310174101751017610177101781017910180101811018210183101841018510186101871018810189101901019110192101931019410195101961019710198101991020010201102021020310204102051020610207102081020910210102111021210213102141021510216102171021810219102201022110222102231022410225102261022710228102291023010231102321023310234102351023610237102381023910240102411024210243102441024510246102471024810249102501025110252102531025410255102561025710258102591026010261102621026310264102651026610267102681026910270102711027210273102741027510276102771027810279102801028110282102831028410285102861028710288102891029010291102921029310294102951029610297102981029910300103011030210303103041030510306103071030810309103101031110312103131031410315103161031710318103191032010321103221032310324103251032610327103281032910330103311033210333103341033510336103371033810339103401034110342103431034410345103461034710348103491035010351103521035310354103551035610357103581035910360103611036210363103641036510366103671036810369103701037110372103731037410375103761037710378103791038010381103821038310384103851038610387103881038910390103911039210393103941039510396103971039810399104001040110402104031040410405104061040710408104091041010411104121041310414104151041610417104181041910420104211042210423104241042510426104271042810429104301043110432104331043410435104361043710438104391044010441104421044310444104451044610447104481044910450104511045210453104541045510456104571045810459104601046110462104631046410465104661046710468104691047010471104721047310474104751047610477104781047910480104811048210483104841048510486104871048810489104901049110492104931049410495104961049710498104991050010501105021050310504105051050610507105081050910510105111051210513105141051510516105171051810519105201052110522105231052410525105261052710528105291053010531105321053310534105351053610537105381053910540105411054210543105441054510546105471054810549105501055110552105531055410555105561055710558105591056010561105621056310564105651056610567105681056910570105711057210573105741057510576105771057810579105801058110582105831058410585105861058710588105891059010591105921059310594105951059610597105981059910600106011060210603106041060510606106071060810609106101061110612106131061410615106161061710618106191062010621106221062310624106251062610627106281062910630106311063210633106341063510636106371063810639106401064110642106431064410645106461064710648106491065010651106521065310654106551065610657106581065910660106611066210663106641066510666106671066810669106701067110672106731067410675106761067710678106791068010681106821068310684106851068610687106881068910690106911069210693106941069510696106971069810699107001070110702107031070410705107061070710708107091071010711107121071310714107151071610717107181071910720107211072210723107241072510726107271072810729107301073110732107331073410735107361073710738107391074010741107421074310744107451074610747107481074910750107511075210753107541075510756107571075810759107601076110762107631076410765107661076710768107691077010771107721077310774107751077610777107781077910780107811078210783107841078510786107871078810789107901079110792107931079410795107961079710798107991080010801108021080310804108051080610807108081080910810108111081210813108141081510816108171081810819108201082110822108231082410825108261082710828108291083010831108321083310834108351083610837108381083910840108411084210843108441084510846108471084810849108501085110852108531085410855108561085710858108591086010861108621086310864108651086610867108681086910870108711087210873108741087510876108771087810879108801088110882108831088410885108861088710888108891089010891108921089310894108951089610897108981089910900109011090210903109041090510906109071090810909109101091110912109131091410915109161091710918109191092010921109221092310924109251092610927109281092910930109311093210933109341093510936109371093810939109401094110942109431094410945109461094710948109491095010951109521095310954109551095610957109581095910960109611096210963109641096510966109671096810969109701097110972109731097410975109761097710978109791098010981109821098310984109851098610987109881098910990109911099210993109941099510996109971099810999110001100111002110031100411005110061100711008110091101011011110121101311014110151101611017110181101911020110211102211023110241102511026110271102811029110301103111032110331103411035110361103711038110391104011041110421104311044110451104611047110481104911050110511105211053110541105511056110571105811059110601106111062110631106411065110661106711068110691107011071110721107311074110751107611077110781107911080110811108211083110841108511086110871108811089110901109111092110931109411095110961109711098110991110011101111021110311104111051110611107111081110911110111111111211113111141111511116111171111811119111201112111122111231112411125111261112711128111291113011131111321113311134111351113611137111381113911140111411114211143111441114511146111471114811149111501115111152111531115411155111561115711158111591116011161111621116311164111651116611167111681116911170111711117211173111741117511176111771117811179111801118111182111831118411185111861118711188111891119011191111921119311194111951119611197111981119911200112011120211203112041120511206112071120811209112101121111212112131121411215112161121711218112191122011221112221122311224112251122611227112281122911230112311123211233112341123511236112371123811239112401124111242112431124411245112461124711248112491125011251112521125311254112551125611257112581125911260112611126211263112641126511266112671126811269112701127111272112731127411275112761127711278112791128011281112821128311284112851128611287112881128911290112911129211293112941129511296112971129811299113001130111302113031130411305113061130711308113091131011311113121131311314113151131611317113181131911320113211132211323113241132511326113271132811329113301133111332113331133411335113361133711338113391134011341113421134311344113451134611347113481134911350113511135211353113541135511356113571135811359113601136111362113631136411365113661136711368113691137011371113721137311374113751137611377113781137911380113811138211383113841138511386113871138811389113901139111392113931139411395113961139711398113991140011401114021140311404114051140611407114081140911410114111141211413114141141511416114171141811419114201142111422114231142411425114261142711428114291143011431114321143311434114351143611437114381143911440114411144211443114441144511446114471144811449114501145111452114531145411455114561145711458114591146011461114621146311464114651146611467114681146911470114711147211473114741147511476114771147811479114801148111482114831148411485114861148711488114891149011491114921149311494114951149611497114981149911500115011150211503115041150511506115071150811509115101151111512115131151411515115161151711518115191152011521115221152311524115251152611527115281152911530115311153211533115341153511536115371153811539115401154111542115431154411545115461154711548115491155011551115521155311554115551155611557115581155911560115611156211563115641156511566115671156811569115701157111572115731157411575115761157711578115791158011581115821158311584115851158611587115881158911590115911159211593115941159511596115971159811599116001160111602116031160411605116061160711608116091161011611116121161311614116151161611617116181161911620116211162211623116241162511626116271162811629116301163111632116331163411635116361163711638116391164011641116421164311644116451164611647116481164911650116511165211653116541165511656116571165811659116601166111662116631166411665116661166711668116691167011671116721167311674116751167611677116781167911680116811168211683116841168511686116871168811689116901169111692116931169411695116961169711698116991170011701117021170311704117051170611707117081170911710117111171211713117141171511716117171171811719117201172111722117231172411725117261172711728117291173011731117321173311734117351173611737117381173911740117411174211743117441174511746117471174811749117501175111752117531175411755117561175711758117591176011761117621176311764117651176611767117681176911770117711177211773117741177511776117771177811779117801178111782117831178411785117861178711788117891179011791117921179311794117951179611797117981179911800118011180211803118041180511806118071180811809118101181111812118131181411815118161181711818118191182011821118221182311824118251182611827118281182911830118311183211833118341183511836118371183811839118401184111842118431184411845118461184711848118491185011851118521185311854118551185611857118581185911860118611186211863118641186511866118671186811869118701187111872118731187411875118761187711878118791188011881118821188311884118851188611887118881188911890118911189211893118941189511896118971189811899119001190111902119031190411905119061190711908119091191011911119121191311914119151191611917119181191911920119211192211923119241192511926119271192811929119301193111932119331193411935119361193711938119391194011941119421194311944119451194611947119481194911950119511195211953119541195511956119571195811959119601196111962119631196411965119661196711968119691197011971119721197311974119751197611977119781197911980119811198211983119841198511986119871198811989119901199111992119931199411995119961199711998119991200012001120021200312004120051200612007120081200912010120111201212013120141201512016120171201812019120201202112022120231202412025120261202712028120291203012031120321203312034120351203612037120381203912040120411204212043120441204512046120471204812049120501205112052120531205412055120561205712058120591206012061120621206312064120651206612067120681206912070120711207212073120741207512076120771207812079120801208112082120831208412085120861208712088120891209012091120921209312094120951209612097120981209912100121011210212103121041210512106121071210812109121101211112112121131211412115121161211712118121191212012121121221212312124121251212612127121281212912130121311213212133121341213512136121371213812139121401214112142121431214412145121461214712148121491215012151121521215312154121551215612157121581215912160121611216212163121641216512166121671216812169121701217112172121731217412175121761217712178121791218012181121821218312184121851218612187121881218912190121911219212193121941219512196121971219812199122001220112202122031220412205122061220712208122091221012211122121221312214122151221612217122181221912220122211222212223122241222512226122271222812229122301223112232122331223412235122361223712238122391224012241122421224312244122451224612247122481224912250122511225212253122541225512256122571225812259122601226112262122631226412265122661226712268122691227012271122721227312274122751227612277122781227912280122811228212283122841228512286122871228812289122901229112292122931229412295122961229712298122991230012301123021230312304123051230612307123081230912310123111231212313123141231512316123171231812319123201232112322123231232412325123261232712328123291233012331123321233312334123351233612337123381233912340123411234212343123441234512346123471234812349123501235112352123531235412355123561235712358123591236012361123621236312364123651236612367123681236912370123711237212373123741237512376123771237812379123801238112382123831238412385123861238712388123891239012391123921239312394123951239612397123981239912400124011240212403124041240512406124071240812409124101241112412124131241412415124161241712418124191242012421124221242312424124251242612427124281242912430124311243212433124341243512436124371243812439124401244112442124431244412445124461244712448124491245012451124521245312454124551245612457124581245912460124611246212463124641246512466124671246812469124701247112472124731247412475124761247712478124791248012481124821248312484124851248612487124881248912490124911249212493124941249512496124971249812499125001250112502125031250412505125061250712508125091251012511125121251312514125151251612517125181251912520125211252212523125241252512526125271252812529125301253112532125331253412535125361253712538125391254012541125421254312544125451254612547125481254912550125511255212553125541255512556125571255812559125601256112562125631256412565125661256712568125691257012571125721257312574125751257612577125781257912580125811258212583125841258512586125871258812589125901259112592125931259412595125961259712598125991260012601126021260312604126051260612607126081260912610126111261212613126141261512616126171261812619126201262112622126231262412625126261262712628126291263012631126321263312634126351263612637126381263912640126411264212643126441264512646126471264812649126501265112652126531265412655126561265712658126591266012661126621266312664126651266612667126681266912670126711267212673126741267512676126771267812679126801268112682126831268412685126861268712688126891269012691126921269312694126951269612697126981269912700127011270212703127041270512706127071270812709127101271112712127131271412715127161271712718127191272012721127221272312724127251272612727127281272912730127311273212733127341273512736127371273812739127401274112742127431274412745127461274712748127491275012751127521275312754127551275612757127581275912760127611276212763127641276512766127671276812769127701277112772127731277412775127761277712778127791278012781127821278312784127851278612787127881278912790127911279212793127941279512796127971279812799128001280112802128031280412805128061280712808128091281012811128121281312814128151281612817128181281912820128211282212823128241282512826128271282812829128301283112832128331283412835128361283712838128391284012841128421284312844128451284612847128481284912850128511285212853128541285512856128571285812859128601286112862128631286412865128661286712868128691287012871128721287312874128751287612877128781287912880128811288212883128841288512886128871288812889128901289112892128931289412895128961289712898128991290012901129021290312904129051290612907129081290912910129111291212913129141291512916129171291812919129201292112922129231292412925129261292712928129291293012931129321293312934129351293612937129381293912940129411294212943129441294512946129471294812949129501295112952129531295412955129561295712958129591296012961129621296312964129651296612967129681296912970129711297212973129741297512976129771297812979129801298112982129831298412985129861298712988129891299012991129921299312994129951299612997129981299913000130011300213003130041300513006130071300813009130101301113012130131301413015130161301713018130191302013021130221302313024130251302613027130281302913030130311303213033130341303513036130371303813039130401304113042130431304413045130461304713048130491305013051130521305313054130551305613057130581305913060130611306213063130641306513066130671306813069130701307113072130731307413075130761307713078130791308013081130821308313084130851308613087130881308913090130911309213093130941309513096130971309813099131001310113102131031310413105131061310713108131091311013111131121311313114131151311613117131181311913120131211312213123131241312513126131271312813129131301313113132131331313413135131361313713138131391314013141131421314313144131451314613147131481314913150131511315213153131541315513156131571315813159131601316113162131631316413165131661316713168131691317013171131721317313174131751317613177131781317913180131811318213183131841318513186131871318813189131901319113192131931319413195131961319713198131991320013201132021320313204132051320613207132081320913210132111321213213132141321513216132171321813219132201322113222132231322413225132261322713228132291323013231132321323313234132351323613237132381323913240132411324213243132441324513246132471324813249132501325113252132531325413255132561325713258132591326013261132621326313264132651326613267132681326913270132711327213273132741327513276132771327813279132801328113282132831328413285132861328713288132891329013291132921329313294132951329613297132981329913300133011330213303133041330513306133071330813309133101331113312133131331413315133161331713318133191332013321133221332313324133251332613327133281332913330133311333213333133341333513336133371333813339133401334113342133431334413345133461334713348133491335013351133521335313354133551335613357133581335913360133611336213363133641336513366133671336813369133701337113372133731337413375133761337713378133791338013381133821338313384133851338613387133881338913390133911339213393133941339513396133971339813399134001340113402134031340413405134061340713408134091341013411134121341313414134151341613417134181341913420134211342213423134241342513426134271342813429134301343113432134331343413435134361343713438134391344013441134421344313444134451344613447134481344913450134511345213453134541345513456134571345813459134601346113462134631346413465134661346713468134691347013471134721347313474134751347613477134781347913480134811348213483134841348513486134871348813489134901349113492134931349413495134961349713498134991350013501135021350313504135051350613507135081350913510135111351213513135141351513516135171351813519135201352113522135231352413525135261352713528135291353013531135321353313534135351353613537135381353913540135411354213543135441354513546135471354813549135501355113552135531355413555135561355713558135591356013561135621356313564135651356613567135681356913570135711357213573135741357513576135771357813579135801358113582135831358413585135861358713588135891359013591135921359313594135951359613597135981359913600136011360213603136041360513606136071360813609136101361113612136131361413615136161361713618136191362013621136221362313624136251362613627136281362913630136311363213633136341363513636136371363813639136401364113642136431364413645136461364713648136491365013651136521365313654136551365613657136581365913660136611366213663136641366513666136671366813669136701367113672136731367413675136761367713678136791368013681136821368313684136851368613687136881368913690136911369213693136941369513696136971369813699137001370113702137031370413705137061370713708137091371013711137121371313714137151371613717137181371913720137211372213723137241372513726137271372813729137301373113732137331373413735137361373713738137391374013741137421374313744137451374613747137481374913750137511375213753137541375513756137571375813759137601376113762137631376413765137661376713768137691377013771137721377313774137751377613777137781377913780137811378213783137841378513786137871378813789137901379113792137931379413795137961379713798137991380013801138021380313804138051380613807138081380913810138111381213813138141381513816138171381813819138201382113822138231382413825138261382713828138291383013831138321383313834138351383613837138381383913840138411384213843138441384513846138471384813849138501385113852138531385413855138561385713858138591386013861138621386313864138651386613867138681386913870138711387213873138741387513876138771387813879138801388113882138831388413885138861388713888138891389013891138921389313894138951389613897138981389913900139011390213903139041390513906139071390813909139101391113912139131391413915139161391713918139191392013921139221392313924139251392613927139281392913930139311393213933139341393513936139371393813939139401394113942139431394413945139461394713948139491395013951139521395313954139551395613957139581395913960139611396213963139641396513966139671396813969139701397113972139731397413975139761397713978139791398013981139821398313984139851398613987139881398913990139911399213993139941399513996139971399813999140001400114002140031400414005140061400714008140091401014011140121401314014140151401614017140181401914020140211402214023140241402514026140271402814029140301403114032140331403414035140361403714038140391404014041140421404314044140451404614047140481404914050140511405214053140541405514056140571405814059140601406114062140631406414065140661406714068140691407014071140721407314074140751407614077140781407914080140811408214083140841408514086140871408814089140901409114092140931409414095140961409714098140991410014101141021410314104141051410614107141081410914110141111411214113141141411514116141171411814119141201412114122141231412414125141261412714128141291413014131141321413314134141351413614137141381413914140141411414214143141441414514146141471414814149141501415114152141531415414155141561415714158141591416014161141621416314164141651416614167141681416914170141711417214173141741417514176141771417814179141801418114182141831418414185141861418714188141891419014191141921419314194141951419614197141981419914200142011420214203142041420514206142071420814209142101421114212142131421414215142161421714218142191422014221142221422314224142251422614227142281422914230142311423214233142341423514236142371423814239142401424114242142431424414245142461424714248142491425014251142521425314254142551425614257142581425914260142611426214263142641426514266142671426814269142701427114272142731427414275142761427714278142791428014281142821428314284142851428614287142881428914290142911429214293142941429514296142971429814299143001430114302143031430414305143061430714308143091431014311143121431314314143151431614317143181431914320143211432214323143241432514326143271432814329143301433114332143331433414335143361433714338143391434014341143421434314344143451434614347143481434914350143511435214353143541435514356143571435814359143601436114362143631436414365143661436714368143691437014371143721437314374143751437614377143781437914380143811438214383143841438514386143871438814389143901439114392143931439414395143961439714398143991440014401144021440314404144051440614407144081440914410144111441214413144141441514416144171441814419144201442114422144231442414425144261442714428144291443014431144321443314434144351443614437144381443914440144411444214443144441444514446144471444814449144501445114452144531445414455144561445714458144591446014461144621446314464144651446614467144681446914470144711447214473144741447514476144771447814479144801448114482144831448414485144861448714488144891449014491144921449314494144951449614497144981449914500145011450214503145041450514506145071450814509145101451114512145131451414515145161451714518145191452014521145221452314524145251452614527145281452914530145311453214533145341453514536145371453814539145401454114542145431454414545145461454714548145491455014551145521455314554145551455614557145581455914560145611456214563145641456514566145671456814569145701457114572145731457414575145761457714578145791458014581145821458314584145851458614587145881458914590145911459214593145941459514596145971459814599146001460114602146031460414605146061460714608146091461014611146121461314614146151461614617146181461914620146211462214623146241462514626146271462814629146301463114632146331463414635146361463714638146391464014641146421464314644146451464614647146481464914650146511465214653146541465514656146571465814659146601466114662146631466414665146661466714668146691467014671146721467314674146751467614677146781467914680146811468214683146841468514686146871468814689146901469114692146931469414695146961469714698146991470014701147021470314704147051470614707147081470914710147111471214713147141471514716147171471814719147201472114722147231472414725147261472714728147291473014731147321473314734147351473614737147381473914740147411474214743147441474514746147471474814749147501475114752147531475414755147561475714758147591476014761147621476314764147651476614767147681476914770147711477214773147741477514776147771477814779147801478114782147831478414785147861478714788147891479014791147921479314794147951479614797147981479914800148011480214803148041480514806148071480814809148101481114812148131481414815148161481714818148191482014821148221482314824148251482614827148281482914830148311483214833148341483514836148371483814839148401484114842148431484414845148461484714848148491485014851148521485314854148551485614857148581485914860148611486214863148641486514866148671486814869148701487114872148731487414875148761487714878148791488014881148821488314884148851488614887148881488914890148911489214893148941489514896148971489814899149001490114902149031490414905149061490714908149091491014911149121491314914149151491614917149181491914920149211492214923149241492514926149271492814929149301493114932149331493414935149361493714938149391494014941149421494314944149451494614947149481494914950149511495214953149541495514956149571495814959149601496114962149631496414965149661496714968149691497014971149721497314974149751497614977149781497914980149811498214983149841498514986149871498814989149901499114992149931499414995149961499714998149991500015001150021500315004150051500615007150081500915010150111501215013150141501515016150171501815019150201502115022150231502415025150261502715028150291503015031150321503315034150351503615037150381503915040150411504215043150441504515046150471504815049150501505115052150531505415055150561505715058150591506015061150621506315064150651506615067150681506915070150711507215073150741507515076150771507815079150801508115082150831508415085150861508715088150891509015091150921509315094150951509615097150981509915100151011510215103151041510515106151071510815109151101511115112151131511415115151161511715118151191512015121151221512315124151251512615127151281512915130151311513215133151341513515136151371513815139151401514115142151431514415145151461514715148151491515015151151521515315154151551515615157151581515915160151611516215163151641516515166151671516815169151701517115172151731517415175151761517715178151791518015181151821518315184151851518615187151881518915190151911519215193151941519515196151971519815199152001520115202152031520415205152061520715208152091521015211152121521315214152151521615217152181521915220152211522215223152241522515226152271522815229152301523115232152331523415235152361523715238152391524015241152421524315244152451524615247152481524915250152511525215253152541525515256152571525815259152601526115262152631526415265152661526715268152691527015271152721527315274152751527615277152781527915280152811528215283152841528515286152871528815289152901529115292152931529415295152961529715298152991530015301153021530315304153051530615307153081530915310153111531215313153141531515316153171531815319153201532115322153231532415325153261532715328153291533015331153321533315334153351533615337153381533915340153411534215343153441534515346153471534815349153501535115352153531535415355153561535715358153591536015361153621536315364153651536615367153681536915370153711537215373153741537515376153771537815379153801538115382153831538415385153861538715388153891539015391153921539315394153951539615397153981539915400154011540215403154041540515406154071540815409154101541115412154131541415415154161541715418154191542015421154221542315424154251542615427154281542915430154311543215433154341543515436154371543815439154401544115442154431544415445154461544715448154491545015451154521545315454154551545615457154581545915460154611546215463154641546515466154671546815469154701547115472154731547415475154761547715478154791548015481154821548315484154851548615487154881548915490154911549215493154941549515496154971549815499155001550115502155031550415505155061550715508155091551015511155121551315514155151551615517155181551915520155211552215523155241552515526155271552815529155301553115532155331553415535155361553715538155391554015541155421554315544155451554615547155481554915550155511555215553155541555515556155571555815559155601556115562155631556415565155661556715568155691557015571155721557315574155751557615577155781557915580155811558215583155841558515586155871558815589155901559115592155931559415595155961559715598155991560015601156021560315604156051560615607156081560915610156111561215613156141561515616156171561815619156201562115622156231562415625156261562715628156291563015631156321563315634156351563615637156381563915640156411564215643156441564515646156471564815649156501565115652156531565415655156561565715658156591566015661156621566315664156651566615667156681566915670156711567215673156741567515676156771567815679156801568115682156831568415685156861568715688156891569015691156921569315694156951569615697156981569915700157011570215703157041570515706157071570815709157101571115712157131571415715157161571715718157191572015721157221572315724157251572615727157281572915730157311573215733157341573515736157371573815739157401574115742157431574415745157461574715748157491575015751157521575315754157551575615757157581575915760157611576215763157641576515766157671576815769157701577115772157731577415775157761577715778157791578015781157821578315784157851578615787157881578915790157911579215793157941579515796157971579815799158001580115802158031580415805158061580715808158091581015811158121581315814158151581615817158181581915820158211582215823158241582515826158271582815829158301583115832158331583415835158361583715838158391584015841158421584315844158451584615847158481584915850158511585215853158541585515856158571585815859158601586115862158631586415865158661586715868158691587015871158721587315874158751587615877158781587915880158811588215883158841588515886158871588815889158901589115892158931589415895158961589715898158991590015901159021590315904159051590615907159081590915910159111591215913159141591515916159171591815919159201592115922159231592415925159261592715928159291593015931159321593315934159351593615937159381593915940159411594215943159441594515946159471594815949159501595115952159531595415955159561595715958159591596015961159621596315964159651596615967159681596915970159711597215973159741597515976159771597815979159801598115982159831598415985159861598715988159891599015991159921599315994159951599615997159981599916000160011600216003160041600516006160071600816009160101601116012160131601416015160161601716018160191602016021160221602316024160251602616027160281602916030160311603216033160341603516036160371603816039160401604116042160431604416045160461604716048160491605016051160521605316054160551605616057160581605916060160611606216063160641606516066160671606816069160701607116072160731607416075160761607716078160791608016081160821608316084160851608616087160881608916090160911609216093160941609516096160971609816099161001610116102161031610416105161061610716108161091611016111161121611316114161151611616117161181611916120161211612216123161241612516126161271612816129161301613116132161331613416135161361613716138161391614016141161421614316144161451614616147161481614916150161511615216153161541615516156161571615816159161601616116162161631616416165161661616716168161691617016171161721617316174161751617616177161781617916180161811618216183161841618516186161871618816189161901619116192161931619416195161961619716198161991620016201162021620316204162051620616207162081620916210162111621216213162141621516216162171621816219162201622116222162231622416225162261622716228162291623016231162321623316234162351623616237162381623916240162411624216243162441624516246162471624816249162501625116252162531625416255162561625716258162591626016261162621626316264162651626616267162681626916270162711627216273162741627516276162771627816279162801628116282162831628416285162861628716288162891629016291162921629316294162951629616297162981629916300163011630216303163041630516306163071630816309163101631116312163131631416315163161631716318163191632016321163221632316324163251632616327163281632916330163311633216333163341633516336163371633816339163401634116342163431634416345163461634716348163491635016351163521635316354163551635616357163581635916360163611636216363163641636516366163671636816369163701637116372163731637416375163761637716378163791638016381163821638316384163851638616387163881638916390163911639216393163941639516396163971639816399164001640116402164031640416405164061640716408164091641016411164121641316414164151641616417164181641916420164211642216423164241642516426164271642816429164301643116432164331643416435164361643716438164391644016441164421644316444164451644616447164481644916450164511645216453164541645516456164571645816459164601646116462164631646416465164661646716468164691647016471164721647316474164751647616477164781647916480164811648216483164841648516486164871648816489164901649116492164931649416495164961649716498164991650016501165021650316504165051650616507165081650916510165111651216513165141651516516165171651816519165201652116522165231652416525165261652716528165291653016531165321653316534165351653616537165381653916540165411654216543165441654516546165471654816549165501655116552165531655416555165561655716558165591656016561165621656316564165651656616567165681656916570165711657216573165741657516576165771657816579165801658116582165831658416585165861658716588165891659016591165921659316594165951659616597165981659916600166011660216603166041660516606166071660816609166101661116612166131661416615166161661716618166191662016621166221662316624166251662616627166281662916630166311663216633166341663516636166371663816639166401664116642166431664416645166461664716648166491665016651166521665316654166551665616657166581665916660166611666216663166641666516666166671666816669166701667116672166731667416675166761667716678166791668016681166821668316684166851668616687166881668916690166911669216693166941669516696166971669816699167001670116702167031670416705167061670716708167091671016711167121671316714167151671616717167181671916720167211672216723167241672516726167271672816729167301673116732167331673416735167361673716738167391674016741167421674316744167451674616747167481674916750167511675216753167541675516756167571675816759167601676116762167631676416765167661676716768167691677016771167721677316774167751677616777167781677916780167811678216783167841678516786167871678816789167901679116792167931679416795167961679716798167991680016801168021680316804168051680616807168081680916810168111681216813168141681516816168171681816819168201682116822168231682416825168261682716828168291683016831168321683316834168351683616837168381683916840168411684216843168441684516846168471684816849168501685116852168531685416855168561685716858168591686016861168621686316864168651686616867168681686916870168711687216873168741687516876168771687816879168801688116882168831688416885168861688716888168891689016891168921689316894168951689616897168981689916900169011690216903169041690516906169071690816909169101691116912169131691416915169161691716918169191692016921169221692316924169251692616927169281692916930169311693216933169341693516936169371693816939169401694116942169431694416945169461694716948169491695016951169521695316954169551695616957169581695916960169611696216963169641696516966169671696816969169701697116972169731697416975169761697716978169791698016981169821698316984169851698616987169881698916990169911699216993169941699516996169971699816999170001700117002170031700417005170061700717008170091701017011170121701317014170151701617017170181701917020170211702217023170241702517026170271702817029170301703117032170331703417035170361703717038170391704017041170421704317044170451704617047170481704917050170511705217053170541705517056170571705817059170601706117062170631706417065170661706717068170691707017071170721707317074170751707617077170781707917080170811708217083170841708517086170871708817089170901709117092170931709417095170961709717098170991710017101171021710317104171051710617107171081710917110171111711217113171141711517116171171711817119171201712117122171231712417125171261712717128171291713017131171321713317134171351713617137171381713917140171411714217143171441714517146171471714817149171501715117152171531715417155171561715717158171591716017161171621716317164171651716617167171681716917170171711717217173171741717517176171771717817179171801718117182171831718417185171861718717188171891719017191171921719317194171951719617197171981719917200172011720217203172041720517206172071720817209172101721117212172131721417215172161721717218172191722017221172221722317224172251722617227172281722917230172311723217233172341723517236172371723817239172401724117242172431724417245172461724717248172491725017251172521725317254172551725617257172581725917260172611726217263172641726517266172671726817269172701727117272172731727417275172761727717278172791728017281172821728317284172851728617287172881728917290172911729217293172941729517296172971729817299173001730117302173031730417305173061730717308173091731017311173121731317314173151731617317173181731917320173211732217323173241732517326173271732817329173301733117332173331733417335173361733717338173391734017341173421734317344173451734617347173481734917350173511735217353173541735517356173571735817359173601736117362173631736417365173661736717368173691737017371173721737317374173751737617377173781737917380173811738217383173841738517386173871738817389173901739117392173931739417395173961739717398173991740017401174021740317404174051740617407174081740917410174111741217413174141741517416174171741817419174201742117422174231742417425174261742717428174291743017431174321743317434174351743617437174381743917440174411744217443174441744517446174471744817449174501745117452174531745417455174561745717458174591746017461174621746317464174651746617467174681746917470174711747217473174741747517476174771747817479174801748117482174831748417485174861748717488174891749017491174921749317494174951749617497174981749917500175011750217503175041750517506175071750817509175101751117512175131751417515175161751717518175191752017521175221752317524175251752617527175281752917530175311753217533175341753517536175371753817539175401754117542175431754417545175461754717548175491755017551175521755317554175551755617557175581755917560175611756217563175641756517566175671756817569175701757117572175731757417575175761757717578175791758017581175821758317584175851758617587175881758917590175911759217593175941759517596175971759817599176001760117602176031760417605176061760717608176091761017611176121761317614176151761617617176181761917620176211762217623176241762517626176271762817629176301763117632176331763417635176361763717638176391764017641176421764317644176451764617647176481764917650176511765217653176541765517656176571765817659176601766117662176631766417665176661766717668176691767017671176721767317674176751767617677176781767917680176811768217683176841768517686176871768817689176901769117692176931769417695176961769717698176991770017701177021770317704177051770617707177081770917710177111771217713177141771517716177171771817719177201772117722177231772417725177261772717728177291773017731177321773317734177351773617737177381773917740177411774217743177441774517746177471774817749177501775117752177531775417755177561775717758177591776017761177621776317764177651776617767177681776917770177711777217773177741777517776177771777817779177801778117782177831778417785177861778717788177891779017791177921779317794177951779617797177981779917800178011780217803178041780517806178071780817809178101781117812178131781417815178161781717818178191782017821178221782317824178251782617827178281782917830178311783217833178341783517836178371783817839178401784117842178431784417845178461784717848178491785017851178521785317854178551785617857178581785917860178611786217863178641786517866178671786817869178701787117872178731787417875178761787717878178791788017881178821788317884178851788617887178881788917890178911789217893178941789517896178971789817899179001790117902179031790417905179061790717908179091791017911179121791317914179151791617917179181791917920179211792217923179241792517926179271792817929179301793117932179331793417935179361793717938179391794017941179421794317944179451794617947179481794917950179511795217953179541795517956179571795817959179601796117962179631796417965179661796717968179691797017971179721797317974179751797617977179781797917980179811798217983179841798517986179871798817989179901799117992179931799417995179961799717998179991800018001180021800318004180051800618007180081800918010180111801218013180141801518016180171801818019180201802118022180231802418025180261802718028180291803018031180321803318034180351803618037180381803918040180411804218043180441804518046180471804818049180501805118052180531805418055180561805718058180591806018061180621806318064180651806618067180681806918070180711807218073180741807518076180771807818079180801808118082180831808418085180861808718088180891809018091180921809318094180951809618097180981809918100181011810218103181041810518106181071810818109181101811118112181131811418115181161811718118181191812018121181221812318124181251812618127181281812918130181311813218133181341813518136181371813818139181401814118142181431814418145181461814718148181491815018151181521815318154181551815618157181581815918160181611816218163181641816518166181671816818169181701817118172181731817418175181761817718178181791818018181181821818318184181851818618187181881818918190181911819218193181941819518196181971819818199182001820118202182031820418205182061820718208182091821018211182121821318214182151821618217182181821918220182211822218223182241822518226182271822818229182301823118232182331823418235182361823718238182391824018241182421824318244182451824618247182481824918250182511825218253182541825518256182571825818259182601826118262182631826418265182661826718268182691827018271182721827318274182751827618277182781827918280182811828218283182841828518286182871828818289182901829118292182931829418295182961829718298182991830018301183021830318304183051830618307183081830918310183111831218313183141831518316183171831818319183201832118322183231832418325183261832718328183291833018331183321833318334183351833618337183381833918340183411834218343183441834518346183471834818349183501835118352183531835418355183561835718358183591836018361183621836318364183651836618367183681836918370183711837218373183741837518376183771837818379183801838118382183831838418385183861838718388183891839018391183921839318394183951839618397183981839918400184011840218403184041840518406184071840818409184101841118412184131841418415184161841718418184191842018421184221842318424184251842618427184281842918430184311843218433184341843518436184371843818439184401844118442184431844418445184461844718448184491845018451184521845318454184551845618457184581845918460184611846218463184641846518466184671846818469184701847118472184731847418475184761847718478184791848018481184821848318484184851848618487184881848918490184911849218493184941849518496184971849818499185001850118502185031850418505185061850718508185091851018511185121851318514185151851618517185181851918520185211852218523185241852518526185271852818529185301853118532185331853418535185361853718538185391854018541185421854318544185451854618547185481854918550185511855218553185541855518556185571855818559185601856118562185631856418565185661856718568185691857018571185721857318574185751857618577185781857918580185811858218583185841858518586185871858818589185901859118592185931859418595185961859718598185991860018601186021860318604186051860618607186081860918610186111861218613186141861518616186171861818619186201862118622186231862418625186261862718628186291863018631186321863318634186351863618637186381863918640186411864218643186441864518646186471864818649186501865118652186531865418655186561865718658186591866018661186621866318664186651866618667 | diff -Nur linux-2.6.37.orig/arch/mips/Kconfig linux-2.6.37/arch/mips/Kconfig--- linux-2.6.37.orig/arch/mips/Kconfig	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/arch/mips/Kconfig	2011-01-11 20:25:48.000000000 +0100@@ -65,6 +65,23 @@ 	  Support for the Texas Instruments AR7 System-on-a-Chip 	  family: TNETD7100, 7200 and 7300. +config ATHEROS_AR71XX+	bool "Atheros AR71xx based boards"+	select CEVT_R4K+	select CSRC_R4K+	select DMA_NONCOHERENT+	select HW_HAS_PCI+	select IRQ_CPU+	select ARCH_REQUIRE_GPIOLIB+	select SYS_HAS_CPU_MIPS32_R1+	select SYS_HAS_CPU_MIPS32_R2+	select SYS_SUPPORTS_32BIT_KERNEL+	select SYS_SUPPORTS_BIG_ENDIAN+	select SYS_HAS_EARLY_PRINTK+	select MIPS_MACHINE+	help+	  Support for Atheros AR71xx based boards.+ config BCM47XX 	bool "Broadcom BCM47XX based boards" 	select CEVT_R4K@@ -717,6 +734,7 @@ endchoice  source "arch/mips/alchemy/Kconfig"+source "arch/mips/ar71xx/Kconfig" source "arch/mips/bcm63xx/Kconfig" source "arch/mips/jazz/Kconfig" source "arch/mips/jz4740/Kconfig"@@ -880,9 +898,15 @@ config MIPS_DISABLE_OBSOLETE_IDE 	bool +config MYLOADER+	bool+ config SYNC_R4K 	bool +config MIPS_MACHINE+	def_bool n+ config NO_IOPORT 	def_bool n diff -Nur linux-2.6.37.orig/arch/mips/Makefile linux-2.6.37/arch/mips/Makefile--- linux-2.6.37.orig/arch/mips/Makefile	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/arch/mips/Makefile	2011-01-11 20:25:48.000000000 +0100@@ -158,6 +158,13 @@ endif cflags-$(CONFIG_CAVIUM_CN63XXP1) += -Wa,-mfix-cn63xxp1 +#+# Atheros AR71xx+#+core-$(CONFIG_ATHEROS_AR71XX)	+= arch/mips/ar71xx/+cflags-$(CONFIG_ATHEROS_AR71XX)	+= -I$(srctree)/arch/mips/include/asm/mach-ar71xx+load-$(CONFIG_ATHEROS_AR71XX)	+= 0xffffffff80060000+ cflags-$(CONFIG_CPU_R4000_WORKAROUNDS)	+= $(call cc-option,-mfix-r4000,) cflags-$(CONFIG_CPU_R4400_WORKAROUNDS)	+= $(call cc-option,-mfix-r4400,) cflags-$(CONFIG_CPU_DADDI_WORKAROUNDS)	+= $(call cc-option,-mno-daddi,)diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/Kconfig linux-2.6.37/arch/mips/ar71xx/Kconfig--- linux-2.6.37.orig/arch/mips/ar71xx/Kconfig	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/Kconfig	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,264 @@+if ATHEROS_AR71XX++menu "Atheros AR71xx machine selection"++config AR71XX_MACH_AP81+	bool "Atheros AP81 board support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_AR913X_WMAC+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_DEV_USB+	default n++config AR71XX_MACH_AP83+	bool "Atheros AP83 board support"+	select AR71XX_DEV_AR913X_WMAC+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_DEV_USB+	default n++config AR71XX_MACH_DIR_600_A1+	bool "D-Link DIR-600 rev. A1 support"+	select AR71XX_DEV_AP91_ETH+	select AR71XX_DEV_AP91_PCI if PCI+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_NVRAM+	default n++config AR71XX_MACH_DIR_615_C1+	bool "D-Link DIR-615 rev. C1 support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_AR913X_WMAC+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_NVRAM+	default n++config AR71XX_MACH_DIR_825_B1+	bool "D-Link DIR-825 rev. B1 board support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_AP94_PCI if PCI+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_DEV_USB+	default n++config AR71XX_MACH_PB42+	bool "Atheros PB42 board support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_PB42_PCI if PCI+	default n++config AR71XX_MACH_PB44+	bool "Atheros PB44 board support"+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_PB42_PCI if PCI+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_DEV_USB+	default n++config AR71XX_MACH_PB92+	bool "Atheros PB92 board support"+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_PB9X_PCI if PCI+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_DEV_USB+	default n++config AR71XX_MACH_AW_NR580+	bool "AzureWave AW-NR580 board support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_PB42_PCI if PCI+	select AR71XX_DEV_LEDS_GPIO+	default n++config AR71XX_MACH_WZR_HP_G300NH+	bool "Buffalo WZR-HP-G300NH board support"+	select AR71XX_DEV_AR913X_WMAC+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_DEV_USB+	default y++config AR71XX_MACH_WP543+	bool "Compex WP543/WPJ543 board support"+	select MYLOADER+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_PB42_PCI if PCI+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_DEV_USB+	default n++config AR71XX_MACH_WRT160NL+	bool "Linksys WRT160NL board support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_AR913X_WMAC+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_DEV_USB+	select AR71XX_NVRAM+	default n++config AR71XX_MACH_WRT400N+	bool "Linksys WRT400N board support"+	select AR71XX_DEV_AP94_PCI if PCI+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	default n++config AR71XX_MACH_RB4XX+	bool "MikroTik RouterBOARD 4xx series support"+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_DEV_USB+	default n++config AR71XX_MACH_RB750+	bool "MikroTik RouterBOARD 750 support"+	select AR71XX_DEV_AP91_ETH+	default n++config AR71XX_MACH_WNDR3700+	bool "NETGEAR WNDR3700 board support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_AP94_PCI if PCI+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_DEV_USB+	default n++config AR71XX_MACH_WNR2000+	bool "NETGEAR WNR2000 board support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_AR913X_WMAC+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	default n++config AR71XX_MACH_MZK_W04NU+	bool "Planex MZK-W04NU board support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_AR913X_WMAC+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_DEV_USB+	default n++config AR71XX_MACH_MZK_W300NH+	bool "Planex MZK-W300NH board support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_AR913X_WMAC+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	default n++config AR71XX_MACH_NBG460N+	bool "Zyxel NBG460N/550N/550NH board support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_AR913X_WMAC+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	default n+	+config AR71XX_MACH_TL_WR741ND+	bool "TP-LINK TL-WR741ND support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_AP91_ETH+	select AR71XX_DEV_AP91_PCI if PCI+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	default n++config AR71XX_MACH_TL_WR841N_V1+	bool "TP-LINK TL-WR841N v1 support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_PB42_PCI if PCI+	select AR71XX_DEV_DSA+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	default n++config AR71XX_MACH_TL_WR941ND+	bool "TP-LINK TL-WR941ND support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_AR913X_WMAC+	select AR71XX_DEV_DSA+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	default n++config AR71XX_MACH_TL_WR1043ND+	bool "TP-LINK TL-WR1043ND support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_AR913X_WMAC+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_DEV_USB+	default n++config AR71XX_MACH_TEW_632BRP+	bool "TRENDnet TEW-632BRP support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_AR913X_WMAC+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_NVRAM+	default n++config AR71XX_MACH_UBNT+	bool "Ubiquiti AR71xx based boards support"+	select AR71XX_DEV_M25P80+	select AR71XX_DEV_AP91_PCI if PCI+	select AR71XX_DEV_GPIO_BUTTONS+	select AR71XX_DEV_LEDS_GPIO+	select AR71XX_DEV_PB42_PCI if PCI+	select AR71XX_DEV_USB+	default n++endmenu++config AR71XX_DEV_M25P80+	def_bool n++config AR71XX_DEV_AP91_PCI+	def_bool n++config AR71XX_DEV_AP91_ETH+	def_bool n++config AR71XX_DEV_AP94_PCI+	def_bool n++config AR71XX_DEV_AR913X_WMAC+	def_bool n++config AR71XX_DEV_DSA+	def_bool n++config AR71XX_DEV_GPIO_BUTTONS+	def_bool n++config AR71XX_DEV_LEDS_GPIO+	def_bool n++config AR71XX_DEV_PB42_PCI+	def_bool n++config AR71XX_DEV_PB9X_PCI+	def_bool n++config AR71XX_DEV_USB+	def_bool n++config AR71XX_NVRAM+	def_bool n++endifdiff -Nur linux-2.6.37.orig/arch/mips/ar71xx/Makefile linux-2.6.37/arch/mips/ar71xx/Makefile--- linux-2.6.37.orig/arch/mips/ar71xx/Makefile	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/Makefile	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,54 @@+#+# Makefile for the Atheros AR71xx SoC specific parts of the kernel+#+# Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+# Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+#+# This program is free software; you can redistribute it and/or modify it+# under the terms of the GNU General Public License version 2 as published+# by the Free Software Foundation.++obj-y	:= prom.o irq.o setup.o devices.o gpio.o ar71xx.o++obj-$(CONFIG_EARLY_PRINTK)		+= early_printk.o+obj-$(CONFIG_PCI)			+= pci.o++obj-$(CONFIG_AR71XX_DEV_AP91_ETH)	+= dev-ap91-eth.o+obj-$(CONFIG_AR71XX_DEV_AP91_PCI)	+= dev-ap91-pci.o+obj-$(CONFIG_AR71XX_DEV_AP94_PCI)	+= dev-ap94-pci.o+obj-$(CONFIG_AR71XX_DEV_AR913X_WMAC)	+= dev-ar913x-wmac.o+obj-$(CONFIG_AR71XX_DEV_DSA)		+= dev-dsa.o+obj-$(CONFIG_AR71XX_DEV_GPIO_BUTTONS)	+= dev-gpio-buttons.o+obj-$(CONFIG_AR71XX_DEV_LEDS_GPIO)	+= dev-leds-gpio.o+obj-$(CONFIG_AR71XX_DEV_M25P80)		+= dev-m25p80.o+obj-$(CONFIG_AR71XX_DEV_PB42_PCI)	+= dev-pb42-pci.o+obj-$(CONFIG_AR71XX_DEV_PB9X_PCI)	+= dev-pb9x-pci.o+obj-$(CONFIG_AR71XX_DEV_USB)		+= dev-usb.o++obj-$(CONFIG_AR71XX_NVRAM)		+= nvram.o++obj-$(CONFIG_AR71XX_MACH_AP81)		+= mach-ap81.o+obj-$(CONFIG_AR71XX_MACH_AP83)		+= mach-ap83.o+obj-$(CONFIG_AR71XX_MACH_AW_NR580)	+= mach-aw-nr580.o+obj-$(CONFIG_AR71XX_MACH_DIR_600_A1)	+= mach-dir-600-a1.o+obj-$(CONFIG_AR71XX_MACH_DIR_615_C1)	+= mach-dir-615-c1.o+obj-$(CONFIG_AR71XX_MACH_DIR_825_B1)	+= mach-dir-825-b1.o+obj-$(CONFIG_AR71XX_MACH_MZK_W04NU)	+= mach-mzk-w04nu.o+obj-$(CONFIG_AR71XX_MACH_MZK_W300NH)	+= mach-mzk-w300nh.o+obj-$(CONFIG_AR71XX_MACH_NBG460N)	+= mach-nbg460n.o+obj-$(CONFIG_AR71XX_MACH_PB42)		+= mach-pb42.o+obj-$(CONFIG_AR71XX_MACH_PB44)		+= mach-pb44.o+obj-$(CONFIG_AR71XX_MACH_PB92)		+= mach-pb92.o+obj-$(CONFIG_AR71XX_MACH_RB4XX)		+= mach-rb4xx.o+obj-$(CONFIG_AR71XX_MACH_RB750)		+= mach-rb750.o+obj-$(CONFIG_AR71XX_MACH_TEW_632BRP)	+= mach-tew-632brp.o+obj-$(CONFIG_AR71XX_MACH_TL_WR741ND)	+= mach-tl-wr741nd.o+obj-$(CONFIG_AR71XX_MACH_TL_WR841N_V1)	+= mach-tl-wr841n.o+obj-$(CONFIG_AR71XX_MACH_TL_WR941ND)	+= mach-tl-wr941nd.o+obj-$(CONFIG_AR71XX_MACH_TL_WR1043ND)	+= mach-tl-wr1043nd.o+obj-$(CONFIG_AR71XX_MACH_UBNT)		+= mach-ubnt.o+obj-$(CONFIG_AR71XX_MACH_WNDR3700)	+= mach-wndr3700.o+obj-$(CONFIG_AR71XX_MACH_WNR2000)	+= mach-wnr2000.o+obj-$(CONFIG_AR71XX_MACH_WP543)		+= mach-wp543.o+obj-$(CONFIG_AR71XX_MACH_WRT160NL)	+= mach-wrt160nl.o+obj-$(CONFIG_AR71XX_MACH_WRT400N)	+= mach-wrt400n.odiff -Nur linux-2.6.37.orig/arch/mips/ar71xx/ar71xx.c linux-2.6.37/arch/mips/ar71xx/ar71xx.c--- linux-2.6.37.orig/arch/mips/ar71xx/ar71xx.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/ar71xx.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,177 @@+/*+ *  AR71xx SoC routines+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/kernel.h>+#include <linux/module.h>+#include <linux/types.h>+#include <linux/mutex.h>++#include <asm/mach-ar71xx/ar71xx.h>++static DEFINE_MUTEX(ar71xx_flash_mutex);++void __iomem *ar71xx_ddr_base;+EXPORT_SYMBOL_GPL(ar71xx_ddr_base);++void __iomem *ar71xx_pll_base;+EXPORT_SYMBOL_GPL(ar71xx_pll_base);++void __iomem *ar71xx_reset_base;+EXPORT_SYMBOL_GPL(ar71xx_reset_base);++void __iomem *ar71xx_gpio_base;+EXPORT_SYMBOL_GPL(ar71xx_gpio_base);++void __iomem *ar71xx_usb_ctrl_base;+EXPORT_SYMBOL_GPL(ar71xx_usb_ctrl_base);++void ar71xx_device_stop(u32 mask)+{+	unsigned long flags;+	u32 mask_inv;+	u32 t;++	switch (ar71xx_soc) {+	case AR71XX_SOC_AR7130:+	case AR71XX_SOC_AR7141:+	case AR71XX_SOC_AR7161:+		local_irq_save(flags);+		t = ar71xx_reset_rr(AR71XX_RESET_REG_RESET_MODULE);+		ar71xx_reset_wr(AR71XX_RESET_REG_RESET_MODULE, t | mask);+		local_irq_restore(flags);+		break;++	case AR71XX_SOC_AR7240:+	case AR71XX_SOC_AR7241:+	case AR71XX_SOC_AR7242:+		mask_inv = mask & RESET_MODULE_USB_OHCI_DLL_7240;+		local_irq_save(flags);+		t = ar71xx_reset_rr(AR724X_RESET_REG_RESET_MODULE);+		t |= mask;+		t &= ~mask_inv;+		ar71xx_reset_wr(AR724X_RESET_REG_RESET_MODULE, t);+		local_irq_restore(flags);+		break;++	case AR71XX_SOC_AR9130:+	case AR71XX_SOC_AR9132:+		local_irq_save(flags);+		t = ar71xx_reset_rr(AR91XX_RESET_REG_RESET_MODULE);+		ar71xx_reset_wr(AR91XX_RESET_REG_RESET_MODULE, t | mask);+		local_irq_restore(flags);+		break;++	default:+		BUG();+	}+}+EXPORT_SYMBOL_GPL(ar71xx_device_stop);++void ar71xx_device_start(u32 mask)+{+	unsigned long flags;+	u32 mask_inv;+	u32 t;++	switch (ar71xx_soc) {+	case AR71XX_SOC_AR7130:+	case AR71XX_SOC_AR7141:+	case AR71XX_SOC_AR7161:+		local_irq_save(flags);+		t = ar71xx_reset_rr(AR71XX_RESET_REG_RESET_MODULE);+		ar71xx_reset_wr(AR71XX_RESET_REG_RESET_MODULE, t & ~mask);+		local_irq_restore(flags);+		break;++	case AR71XX_SOC_AR7240:+	case AR71XX_SOC_AR7241:+	case AR71XX_SOC_AR7242:+		mask_inv = mask & RESET_MODULE_USB_OHCI_DLL_7240;+		local_irq_save(flags);+		t = ar71xx_reset_rr(AR724X_RESET_REG_RESET_MODULE);+		t &= ~mask;+		t |= mask_inv;+		ar71xx_reset_wr(AR724X_RESET_REG_RESET_MODULE, t);+		local_irq_restore(flags);+		break;++	case AR71XX_SOC_AR9130:+	case AR71XX_SOC_AR9132:+		local_irq_save(flags);+		t = ar71xx_reset_rr(AR91XX_RESET_REG_RESET_MODULE);+		ar71xx_reset_wr(AR91XX_RESET_REG_RESET_MODULE, t & ~mask);+		local_irq_restore(flags);+		break;++	default:+		BUG();+	}+}+EXPORT_SYMBOL_GPL(ar71xx_device_start);++int ar71xx_device_stopped(u32 mask)+{+	unsigned long flags;+	u32 t;++	switch (ar71xx_soc) {+	case AR71XX_SOC_AR7130:+	case AR71XX_SOC_AR7141:+	case AR71XX_SOC_AR7161:+		local_irq_save(flags);+		t = ar71xx_reset_rr(AR71XX_RESET_REG_RESET_MODULE);+		local_irq_restore(flags);+		break;++	case AR71XX_SOC_AR7240:+	case AR71XX_SOC_AR7241:+	case AR71XX_SOC_AR7242:+		local_irq_save(flags);+		t = ar71xx_reset_rr(AR724X_RESET_REG_RESET_MODULE);+		local_irq_restore(flags);+		break;++	case AR71XX_SOC_AR9130:+	case AR71XX_SOC_AR9132:+		local_irq_save(flags);+		t = ar71xx_reset_rr(AR91XX_RESET_REG_RESET_MODULE);+		local_irq_restore(flags);+		break;++	default:+		BUG();+	}++	return ((t & mask) == mask);+}+EXPORT_SYMBOL_GPL(ar71xx_device_stopped);++void ar71xx_ddr_flush(u32 reg)+{+	ar71xx_ddr_wr(reg, 1);+	while ((ar71xx_ddr_rr(reg) & 0x1));++	ar71xx_ddr_wr(reg, 1);+	while ((ar71xx_ddr_rr(reg) & 0x1));+}+EXPORT_SYMBOL_GPL(ar71xx_ddr_flush);++void ar71xx_flash_acquire(void)+{+	mutex_lock(&ar71xx_flash_mutex);+}+EXPORT_SYMBOL_GPL(ar71xx_flash_acquire);++void ar71xx_flash_release(void)+{+	mutex_unlock(&ar71xx_flash_mutex);+}+EXPORT_SYMBOL_GPL(ar71xx_flash_release);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-ap91-eth.c linux-2.6.37/arch/mips/ar71xx/dev-ap91-eth.c--- linux-2.6.37.orig/arch/mips/ar71xx/dev-ap91-eth.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-ap91-eth.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,70 @@+/*+ *  Atheros AP91 reference board ethernet initialization+ *+ *  Copyright (C) 2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include "devices.h"+#include "dev-dsa.h"+#include "dev-ap91-eth.h"++static struct dsa_chip_data ap91_dsa_chip = {+	.port_names[0]  = "cpu",+	.port_names[1]  = "lan1",+	.port_names[2]  = "lan2",+	.port_names[3]  = "lan3",+	.port_names[4]  = "lan4",+};++static struct dsa_platform_data ap91_dsa_data = {+	.nr_chips	= 1,+	.chip		= &ap91_dsa_chip,+};++static void ap91_eth_set_port_name(unsigned port, const char *name)+{+	if (port < 1 || port > 5)+		return;++	if (name)+		ap91_dsa_chip.port_names[port] = (char *) name;+}++void __init ap91_eth_init(u8 *mac_addr, const char *port_names[])+{+	if (mac_addr)+		ar71xx_set_mac_base(mac_addr);++	if (port_names) {+		int i;++		for (i = 0; i < AP91_ETH_NUM_PORT_NAMES; i++)+			ap91_eth_set_port_name(i + 1, port_names[i]);+	}++	/* WAN port */+	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth0_data.speed = SPEED_100;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;+	ar71xx_eth0_data.fifo_cfg1 = 0x0fff0000;+	ar71xx_eth0_data.fifo_cfg2 = 0x00001fff;+	ar71xx_eth0_data.fifo_cfg3 = 0x008001ff;++	/* LAN ports */+	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.speed = SPEED_1000;+	ar71xx_eth1_data.duplex = DUPLEX_FULL;+	ar71xx_eth1_data.fifo_cfg1 = 0x0fff0000;+	ar71xx_eth1_data.fifo_cfg2 = 0x00001fff;+	ar71xx_eth1_data.fifo_cfg3 = 0x008001ff;++	ar71xx_add_device_mdio(0x0);+	ar71xx_add_device_eth(1);+	ar71xx_add_device_eth(0);++	ar71xx_add_device_dsa(1, &ap91_dsa_data);+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-ap91-eth.h linux-2.6.37/arch/mips/ar71xx/dev-ap91-eth.h--- linux-2.6.37.orig/arch/mips/ar71xx/dev-ap91-eth.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-ap91-eth.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,23 @@+/*+ *  Atheros AP91 reference board ethernet initialization+ *+ *  Copyright (C) 2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef _AR71XX_DEV_AP91_ETH_H+#define _AR71XX_DEV_AP91_ETH_H++#define AP91_ETH_NUM_PORT_NAMES	4++#if defined(CONFIG_AR71XX_DEV_AP91_ETH)+void ap91_eth_init(u8 *mac_addr, const char *port_names[]) __init;+#else+static inline void ap91_eth_init(u8 *mac_addr) { }+#endif++#endif /* _AR71XX_DEV_AP91_ETH_H */+diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-ap91-pci.c linux-2.6.37/arch/mips/ar71xx/dev-ap91-pci.c--- linux-2.6.37.orig/arch/mips/ar71xx/dev-ap91-pci.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-ap91-pci.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,114 @@+/*+ *  Atheros AP91 reference board PCI initialization+ *+ *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/pci.h>+#include <linux/ath9k_platform.h>+#include <linux/delay.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/pci.h>++#include "dev-ap91-pci.h"++static struct ath9k_platform_data ap91_wmac_data;+static char ap91_wmac_mac[6];+static int ap91_pci_fixup_enabled;++static struct ar71xx_pci_irq ap91_pci_irqs[] __initdata = {+	{+		.slot	= 0,+		.pin	= 1,+		.irq	= AR71XX_PCI_IRQ_DEV0,+	}+};++static int ap91_pci_plat_dev_init(struct pci_dev *dev)+{+	switch(PCI_SLOT(dev->devfn)) {+	case 0:+		dev->dev.platform_data = &ap91_wmac_data;+		break;+	}++	return 0;+}++static void ap91_pci_fixup(struct pci_dev *dev)+{+	void __iomem *mem;+	u16 *cal_data;+	u16 cmd;+	u32 val;++	if (!ap91_pci_fixup_enabled)+		return;++	printk(KERN_INFO "PCI: fixup device %s\n", pci_name(dev));++	cal_data = ap91_wmac_data.eeprom_data;+	if (*cal_data != 0xa55a) {+		printk(KERN_ERR "PCI: no calibration data found for %s\n",+		       pci_name(dev));+		return;+	}++	mem = ioremap(AR71XX_PCI_MEM_BASE, 0x10000);+	if (!mem) {+		printk(KERN_ERR "PCI: ioremap error for device %s\n",+		       pci_name(dev));+		return;+	}++	/* Setup the PCI device to allow access to the internal registers */+	pci_write_config_dword(dev, PCI_BASE_ADDRESS_0, 0xffff);+	pci_read_config_word(dev, PCI_COMMAND, &cmd);+	cmd |= PCI_COMMAND_MASTER | PCI_COMMAND_MEMORY;+	pci_write_config_word(dev, PCI_COMMAND, cmd);++        /* set pointer to first reg address */+	cal_data += 3;+	while (*cal_data != 0xffff) {+		u32 reg;+		reg = *cal_data++;+		val = *cal_data++;+		val |= (*cal_data++) << 16;++		__raw_writel(val, mem + reg);+		udelay(100);+	}++	pci_read_config_dword(dev, PCI_VENDOR_ID, &val);+	dev->vendor = val & 0xffff;+	dev->device = (val >> 16) & 0xffff;++	pci_read_config_dword(dev, PCI_CLASS_REVISION, &val);+	dev->revision = val & 0xff;+	dev->class = val >> 8; /* upper 3 bytes */++	iounmap(mem);+}+DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_ATHEROS, PCI_ANY_ID, ap91_pci_fixup);++void __init ap91_pci_init(u8 *cal_data, u8 *mac_addr)+{+	if (cal_data)+		memcpy(ap91_wmac_data.eeprom_data, cal_data,+		       sizeof(ap91_wmac_data.eeprom_data));++	if (mac_addr) {+		memcpy(ap91_wmac_mac, mac_addr, sizeof(ap91_wmac_mac));+		ap91_wmac_data.macaddr = ap91_wmac_mac;+	}++	ar71xx_pci_plat_dev_init = ap91_pci_plat_dev_init;+	ar71xx_pci_init(ARRAY_SIZE(ap91_pci_irqs), ap91_pci_irqs);++	ap91_pci_fixup_enabled = 1;+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-ap91-pci.h linux-2.6.37/arch/mips/ar71xx/dev-ap91-pci.h--- linux-2.6.37.orig/arch/mips/ar71xx/dev-ap91-pci.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-ap91-pci.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,21 @@+/*+ *  Atheros AP91 reference board PCI initialization+ *+ *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef _AR71XX_DEV_AP91_PCI_H+#define _AR71XX_DEV_AP91_PCI_H++#if defined(CONFIG_AR71XX_DEV_AP91_PCI)+void ap91_pci_init(u8 *cal_data, u8 *mac_addr) __init;+#else+static inline void ap91_pci_init(u8 *cal_data, u8 *mac_addr) { }+#endif++#endif /* _AR71XX_DEV_AP91_PCI_H */+diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-ap94-pci.c linux-2.6.37/arch/mips/ar71xx/dev-ap94-pci.c--- linux-2.6.37.orig/arch/mips/ar71xx/dev-ap94-pci.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-ap94-pci.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,159 @@+/*+ *  Atheros AP94 reference board PCI initialization+ *+ *  Copyright (C) 2009-2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/pci.h>+#include <linux/ath9k_platform.h>+#include <linux/delay.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/pci.h>++#include "dev-ap94-pci.h"++static struct ath9k_platform_data ap94_wmac0_data;+static struct ath9k_platform_data ap94_wmac1_data;+static char ap94_wmac0_mac[6];+static char ap94_wmac1_mac[6];+static int ap94_pci_fixup_enabled;++static struct ar71xx_pci_irq ap94_pci_irqs[] __initdata = {+        {+                .slot   = 0,+                .pin    = 1,+                .irq    = AR71XX_PCI_IRQ_DEV0,+        }, {+                .slot   = 1,+                .pin    = 1,+                .irq    = AR71XX_PCI_IRQ_DEV1,+        }+};++static int ap94_pci_plat_dev_init(struct pci_dev *dev)+{+	switch(PCI_SLOT(dev->devfn)) {+	case 17:+		dev->dev.platform_data = &ap94_wmac0_data;+		break;++	case 18:+		dev->dev.platform_data = &ap94_wmac1_data;+		break;+	}++	return 0;+}++static void ap94_pci_fixup(struct pci_dev *dev)+{+	void __iomem *mem;+	u16 *cal_data;+	u16 cmd;+	u32 bar0;+	u32 val;++	if (!ap94_pci_fixup_enabled)+		return;++	switch (PCI_SLOT(dev->devfn)) {+	case 17:+		cal_data = ap94_wmac0_data.eeprom_data;+		break;+	case 18:+		cal_data = ap94_wmac1_data.eeprom_data;+		break;+	default:+		return;+	}++	if (*cal_data != 0xa55a) {+		printk(KERN_ERR "PCI: no calibration data found for %s\n",+		       pci_name(dev));+		return;+	}++	mem = ioremap(AR71XX_PCI_MEM_BASE, 0x10000);+	if (!mem) {+		printk(KERN_ERR "PCI: ioremap error for device %s\n",+		       pci_name(dev));+		return;+	}++	printk(KERN_INFO "PCI: fixup device %s\n", pci_name(dev));++	pci_read_config_dword(dev, PCI_BASE_ADDRESS_0, &bar0);++	/* Setup the PCI device to allow access to the internal registers */+	pci_write_config_dword(dev, PCI_BASE_ADDRESS_0, AR71XX_PCI_MEM_BASE);+	pci_read_config_word(dev, PCI_COMMAND, &cmd);+	cmd |= PCI_COMMAND_MASTER | PCI_COMMAND_MEMORY;+	pci_write_config_word(dev, PCI_COMMAND, cmd);++	/* set pointer to first reg address */+	cal_data += 3;+	while (*cal_data != 0xffff) {+		u32 reg;+		reg = *cal_data++;+		val = *cal_data++;+		val |= (*cal_data++) << 16;++		__raw_writel(val, mem + reg);+		udelay(100);+	}++	pci_read_config_dword(dev, PCI_VENDOR_ID, &val);+	dev->vendor = val & 0xffff;+	dev->device = (val >> 16) & 0xffff;++	pci_read_config_dword(dev, PCI_CLASS_REVISION, &val);+	dev->revision = val & 0xff;+	dev->class = val >> 8; /* upper 3 bytes */++	pci_read_config_word(dev, PCI_COMMAND, &cmd);+	cmd &= ~(PCI_COMMAND_MASTER | PCI_COMMAND_MEMORY);+	pci_write_config_word(dev, PCI_COMMAND, cmd);++	pci_write_config_dword(dev, PCI_BASE_ADDRESS_0, bar0);++	iounmap(mem);+}+DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_ATHEROS, PCI_ANY_ID, ap94_pci_fixup);++void __init ap94_pci_enable_quirk_wndr3700(void)+{+	ap94_wmac0_data.quirk_wndr3700 = 1;+	ap94_wmac1_data.quirk_wndr3700 = 1;+}++void __init ap94_pci_init(u8 *cal_data0, u8 *mac_addr0,+			  u8 *cal_data1, u8 *mac_addr1)+{+	if (cal_data0)+		memcpy(ap94_wmac0_data.eeprom_data, cal_data0,+		       sizeof(ap94_wmac0_data.eeprom_data));++	if (cal_data1)+		memcpy(ap94_wmac1_data.eeprom_data, cal_data1,+		       sizeof(ap94_wmac1_data.eeprom_data));++	if (mac_addr0) {+		memcpy(ap94_wmac0_mac, mac_addr0, sizeof(ap94_wmac0_mac));+		ap94_wmac0_data.macaddr = ap94_wmac0_mac;+	}++	if (mac_addr1) {+		memcpy(ap94_wmac1_mac, mac_addr1, sizeof(ap94_wmac1_mac));+		ap94_wmac1_data.macaddr = ap94_wmac1_mac;+	}++	ar71xx_pci_plat_dev_init = ap94_pci_plat_dev_init;+	ar71xx_pci_init(ARRAY_SIZE(ap94_pci_irqs), ap94_pci_irqs);++	ap94_pci_fixup_enabled = 1;+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-ap94-pci.h linux-2.6.37/arch/mips/ar71xx/dev-ap94-pci.h--- linux-2.6.37.orig/arch/mips/ar71xx/dev-ap94-pci.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-ap94-pci.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,28 @@+/*+ *  Atheros AP94 reference board PCI initialization+ *+ *  Copyright (C) 2009-2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef _AR71XX_DEV_AP94_PCI_H+#define _AR71XX_DEV_AP94_PCI_H++#if defined(CONFIG_AR71XX_DEV_AP94_PCI)+void ap94_pci_init(u8 *cal_data0, u8 *mac_addr0,+		   u8 *cal_data1, u8 *mac_addr1) __init;++void ap94_pci_enable_quirk_wndr3700(void) __init;++#else+static inline void ap94_pci_init(u8 *cal_data0, u8 *mac_addr0,+				 u8 *cal_data1, u8 *mac_addr1) {}++static inline void ap94_pci_enable_quirk_wndr3700(void) {}+#endif++#endif /* _AR71XX_DEV_AP94_PCI_H */+diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-ar913x-wmac.c linux-2.6.37/arch/mips/ar71xx/dev-ar913x-wmac.c--- linux-2.6.37.orig/arch/mips/ar71xx/dev-ar913x-wmac.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-ar913x-wmac.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,68 @@+/*+ *  Atheros AR913x SoC built-in WMAC device support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Parts of this file are based on Atheros' 2.6.15 BSP+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/kernel.h>+#include <linux/init.h>+#include <linux/delay.h>+#include <linux/etherdevice.h>+#include <linux/platform_device.h>+#include <linux/ath9k_platform.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "dev-ar913x-wmac.h"++static struct ath9k_platform_data ar913x_wmac_data;+static char ar913x_wmac_mac[6];++static struct resource ar913x_wmac_resources[] = {+	{+		.start	= AR91XX_WMAC_BASE,+		.end	= AR91XX_WMAC_BASE + AR91XX_WMAC_SIZE - 1,+		.flags	= IORESOURCE_MEM,+	}, {+		.start	= AR71XX_CPU_IRQ_IP2,+		.end	= AR71XX_CPU_IRQ_IP2,+		.flags	= IORESOURCE_IRQ,+	},+};++static struct platform_device ar913x_wmac_device = {+	.name		= "ath9k",+	.id		= -1,+	.resource	= ar913x_wmac_resources,+	.num_resources	= ARRAY_SIZE(ar913x_wmac_resources),+	.dev = {+		.platform_data = &ar913x_wmac_data,+	},+};++void __init ar913x_add_device_wmac(u8 *cal_data, u8 *mac_addr)+{+	if (cal_data)+		memcpy(ar913x_wmac_data.eeprom_data, cal_data,+		       sizeof(ar913x_wmac_data.eeprom_data));++	if (mac_addr) {+		memcpy(ar913x_wmac_mac, mac_addr, sizeof(ar913x_wmac_mac));+		ar913x_wmac_data.macaddr = ar913x_wmac_mac;+	}++	ar71xx_device_stop(RESET_MODULE_AMBA2WMAC);+	mdelay(10);++	ar71xx_device_start(RESET_MODULE_AMBA2WMAC);+	mdelay(10);++	platform_device_register(&ar913x_wmac_device);+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-ar913x-wmac.h linux-2.6.37/arch/mips/ar71xx/dev-ar913x-wmac.h--- linux-2.6.37.orig/arch/mips/ar71xx/dev-ar913x-wmac.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-ar913x-wmac.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,19 @@+/*+ *  Atheros AR913x SoC built-in WMAC device support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Parts of this file are based on Atheros' 2.6.15 BSP+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef _AR71XX_DEV_AR913X_WMAC_H+#define _AR71XX_DEV_AR913X_WMAC_H++void ar913x_add_device_wmac(u8 *cal_data, u8 *mac_addr) __init;++#endif /* _AR71XX_DEV_AR913X_WMAC_H */diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-dsa.c linux-2.6.37/arch/mips/ar71xx/dev-dsa.c--- linux-2.6.37.orig/arch/mips/ar71xx/dev-dsa.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-dsa.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,50 @@+/*+ *  Atheros AR71xx DSA switch device support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/init.h>+#include <linux/platform_device.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "devices.h"+#include "dev-dsa.h"++static struct platform_device ar71xx_dsa_switch_device = {+	.name		= "dsa",+	.id		= 0,+};++void __init ar71xx_add_device_dsa(unsigned int id,+				  struct dsa_platform_data *d)+{+	int i;++	switch (id) {+	case 0:+		d->netdev = &ar71xx_eth0_device.dev;+		break;+	case 1:+		d->netdev = &ar71xx_eth1_device.dev;+		break;+	default:+		printk(KERN_ERR+			"ar71xx: invalid ethernet id %d for DSA switch\n",+			id);+		return;+	}++	for (i = 0; i < d->nr_chips; i++)+		d->chip[i].mii_bus = &ar71xx_mdio_device.dev;++	ar71xx_dsa_switch_device.dev.platform_data = d;++	platform_device_register(&ar71xx_dsa_switch_device);+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-dsa.h linux-2.6.37/arch/mips/ar71xx/dev-dsa.h--- linux-2.6.37.orig/arch/mips/ar71xx/dev-dsa.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-dsa.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,20 @@+/*+ *  Atheros AR71xx DSA switch device support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef _AR71XX_DEV_DSA_H+#define _AR71XX_DEV_DSA_H++#include <net/dsa.h>++void ar71xx_add_device_dsa(unsigned int id,+			   struct dsa_platform_data *d) __init;++#endif /* _AR71XX_DEV_DSA_H */diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-gpio-buttons.c linux-2.6.37/arch/mips/ar71xx/dev-gpio-buttons.c--- linux-2.6.37.orig/arch/mips/ar71xx/dev-gpio-buttons.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-gpio-buttons.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,58 @@+/*+ *  Atheros AR71xx GPIO button support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include "linux/init.h"+#include <linux/platform_device.h>++#include "dev-gpio-buttons.h"++void __init ar71xx_add_device_gpio_buttons(int id,+					   unsigned poll_interval,+					   unsigned nbuttons,+					   struct gpio_button *buttons)+{+	struct platform_device *pdev;+	struct gpio_buttons_platform_data pdata;+	struct gpio_button *p;+	int err;++	p = kmalloc(nbuttons * sizeof(*p), GFP_KERNEL);+	if (!p)+		return;++	memcpy(p, buttons, nbuttons * sizeof(*p));++	pdev = platform_device_alloc("gpio-buttons", id);+	if (!pdev)+		goto err_free_buttons;++	memset(&pdata, 0, sizeof(pdata));+	pdata.poll_interval = poll_interval;+	pdata.nbuttons = nbuttons;+	pdata.buttons = p;++	err = platform_device_add_data(pdev, &pdata, sizeof(pdata));+	if (err)+		goto err_put_pdev;+++	err = platform_device_add(pdev);+	if (err)+		goto err_put_pdev;++	return;++err_put_pdev:+	platform_device_put(pdev);++err_free_buttons:+	kfree(p);+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-gpio-buttons.h linux-2.6.37/arch/mips/ar71xx/dev-gpio-buttons.h--- linux-2.6.37.orig/arch/mips/ar71xx/dev-gpio-buttons.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-gpio-buttons.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,25 @@+/*+ *  Atheros AR71xx GPIO button support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef _AR71XX_DEV_GPIO_BUTTONS_H+#define _AR71XX_DEV_GPIO_BUTTONS_H++#include <linux/input.h>+#include <linux/gpio_buttons.h>++#include <asm/mach-ar71xx/platform.h>++void ar71xx_add_device_gpio_buttons(int id,+				    unsigned poll_interval,+				    unsigned nbuttons,+				    struct gpio_button *buttons) __init;++#endif /* _AR71XX_DEV_GPIO_BUTTONS_H */diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-leds-gpio.c linux-2.6.37/arch/mips/ar71xx/dev-leds-gpio.c--- linux-2.6.37.orig/arch/mips/ar71xx/dev-leds-gpio.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-leds-gpio.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,57 @@+/*+ *  Atheros AR71xx GPIO LED device support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Parts of this file are based on Atheros' 2.6.15 BSP+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/init.h>+#include <linux/platform_device.h>+#include <linux/slab.h>++#include "dev-leds-gpio.h"++void __init ar71xx_add_device_leds_gpio(int id, unsigned num_leds,+					struct gpio_led *leds)+{+	struct platform_device *pdev;+	struct gpio_led_platform_data pdata;+	struct gpio_led *p;+	int err;++	p = kmalloc(num_leds * sizeof(*p), GFP_KERNEL);+	if (!p)+		return;++	memcpy(p, leds, num_leds * sizeof(*p));++	pdev = platform_device_alloc("leds-gpio", id);+	if (!pdev)+		goto err_free_leds;++	memset(&pdata, 0, sizeof(pdata));+	pdata.num_leds = num_leds;+	pdata.leds = p;++	err = platform_device_add_data(pdev, &pdata, sizeof(pdata));+	if (err)+		goto err_put_pdev;++	err = platform_device_add(pdev);+	if (err)+		goto err_put_pdev;++	return;++err_put_pdev:+	platform_device_put(pdev);++err_free_leds:+	kfree(p);+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-leds-gpio.h linux-2.6.37/arch/mips/ar71xx/dev-leds-gpio.h--- linux-2.6.37.orig/arch/mips/ar71xx/dev-leds-gpio.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-leds-gpio.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,21 @@+/*+ *  Atheros AR71xx GPIO LED device support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef _AR71XX_DEV_LEDS_GPIO_H+#define _AR71XX_DEV_LEDS_GPIO_H++#include <linux/leds.h>++void ar71xx_add_device_leds_gpio(int id,+				 unsigned num_leds,+				 struct gpio_led *leds) __init;++#endif /* _AR71XX_DEV_LEDS_GPIO_H */diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-m25p80.c linux-2.6.37/arch/mips/ar71xx/dev-m25p80.c--- linux-2.6.37.orig/arch/mips/ar71xx/dev-m25p80.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-m25p80.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,30 @@+/*+ *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/init.h>+#include <linux/spi/spi.h>+#include <linux/spi/flash.h>++#include "devices.h"+#include "dev-m25p80.h"++static struct spi_board_info ar71xx_spi_info[] = {+	{+		.bus_num	= 0,+		.chip_select	= 0,+		.max_speed_hz	= 25000000,+		.modalias	= "m25p80",+	}+};++void __init ar71xx_add_device_m25p80(struct flash_platform_data *pdata)+{+	ar71xx_spi_info[0].platform_data = pdata;+	ar71xx_add_device_spi(NULL, ar71xx_spi_info,+			      ARRAY_SIZE(ar71xx_spi_info));+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-m25p80.h linux-2.6.37/arch/mips/ar71xx/dev-m25p80.h--- linux-2.6.37.orig/arch/mips/ar71xx/dev-m25p80.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-m25p80.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,16 @@+/*+ *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef _AR71XX_DEV_M25P80_H+#define _AR71XX_DEV_M25P80_H++#include <linux/spi/flash.h>++void ar71xx_add_device_m25p80(struct flash_platform_data *pdata) __init;++#endif /* _AR71XX_DEV_M25P80_H */diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-pb42-pci.c linux-2.6.37/arch/mips/ar71xx/dev-pb42-pci.c--- linux-2.6.37.orig/arch/mips/ar71xx/dev-pb42-pci.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-pb42-pci.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,40 @@+/*+ *  Atheros PB42 reference board PCI initialization+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Parts of this file are based on Atheros' 2.6.15 BSP+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/pci.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/pci.h>++#include "dev-pb42-pci.h"++static struct ar71xx_pci_irq pb42_pci_irqs[] __initdata = {+	{+		.slot	= 0,+		.pin	= 1,+		.irq	= AR71XX_PCI_IRQ_DEV0,+	}, {+		.slot	= 1,+		.pin	= 1,+		.irq	= AR71XX_PCI_IRQ_DEV1,+	}, {+		.slot	= 2,+		.pin	= 1,+		.irq	= AR71XX_PCI_IRQ_DEV2,+	}+};++void __init pb42_pci_init(void)+{+	ar71xx_pci_init(ARRAY_SIZE(pb42_pci_irqs), pb42_pci_irqs);+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-pb42-pci.h linux-2.6.37/arch/mips/ar71xx/dev-pb42-pci.h--- linux-2.6.37.orig/arch/mips/ar71xx/dev-pb42-pci.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-pb42-pci.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,21 @@+/*+ *  Atheros PB42 reference board PCI initialization+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef _AR71XX_DEV_PB42_PCI_H+#define _AR71XX_DEV_PB42_PCI_H++#if defined(CONFIG_AR71XX_DEV_PB42_PCI)+void pb42_pci_init(void) __init;+#else+static inline void pb42_pci_init(void) { }+#endif++#endif /* _AR71XX_DEV_PB42_PCI_H */diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-pb9x-pci.c linux-2.6.37/arch/mips/ar71xx/dev-pb9x-pci.c--- linux-2.6.37.orig/arch/mips/ar71xx/dev-pb9x-pci.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-pb9x-pci.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,33 @@+/*+ *  Atheros PB9x reference board PCI initialization+ *+ *  Copyright (C) 2010 Felix Fietkau <nbd@openwrt.org>+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Parts of this file are based on Atheros' 2.6.15 BSP+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/pci.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/pci.h>++#include "dev-pb9x-pci.h"++static struct ar71xx_pci_irq pb9x_pci_irqs[] __initdata = {+	{+		.slot	= 0,+		.pin	= 1,+		.irq	= AR71XX_PCI_IRQ_DEV0,+	}+};++void __init pb9x_pci_init(void)+{+	ar71xx_pci_init(ARRAY_SIZE(pb9x_pci_irqs), pb9x_pci_irqs);+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-pb9x-pci.h linux-2.6.37/arch/mips/ar71xx/dev-pb9x-pci.h--- linux-2.6.37.orig/arch/mips/ar71xx/dev-pb9x-pci.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-pb9x-pci.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,22 @@+/*+ *  Atheros PB9x reference board PCI initialization+ *+ *  Copyright (C) 2010 Felix Fietkau <nbd@openwrt.org>+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef _AR71XX_DEV_PB9X_PCI_H+#define _AR71XX_DEV_PB9X_PCI_H++#if defined(CONFIG_AR71XX_DEV_PB9X_PCI)+void pb9x_pci_init(void) __init;+#else+static inline void pb9x_pci_init(void) { }+#endif++#endif /* _AR71XX_DEV_PB9X_PCI_H */diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-usb.c linux-2.6.37/arch/mips/ar71xx/dev-usb.c--- linux-2.6.37.orig/arch/mips/ar71xx/dev-usb.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-usb.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,181 @@+/*+ *  Atheros AR71xx USB host device support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Parts of this file are based on Atheros' 2.6.15 BSP+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/kernel.h>+#include <linux/init.h>+#include <linux/delay.h>+#include <linux/dma-mapping.h>+#include <linux/platform_device.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/platform.h>++#include "dev-usb.h"++/*+ * OHCI (USB full speed host controller)+ */+static struct resource ar71xx_ohci_resources[] = {+	[0] = {+		.start	= AR71XX_OHCI_BASE,+		.end	= AR71XX_OHCI_BASE + AR71XX_OHCI_SIZE - 1,+		.flags	= IORESOURCE_MEM,+	},+	[1] = {+		.start	= AR71XX_MISC_IRQ_OHCI,+		.end	= AR71XX_MISC_IRQ_OHCI,+		.flags	= IORESOURCE_IRQ,+	},+};++static struct resource ar7240_ohci_resources[] = {+	[0] = {+		.start	= AR7240_OHCI_BASE,+		.end	= AR7240_OHCI_BASE + AR7240_OHCI_SIZE - 1,+		.flags	= IORESOURCE_MEM,+	},+	[1] = {+		.start	= AR71XX_CPU_IRQ_USB,+		.end	= AR71XX_CPU_IRQ_USB,+		.flags	= IORESOURCE_IRQ,+	},+};++static u64 ar71xx_ohci_dmamask = DMA_BIT_MASK(32);+static struct platform_device ar71xx_ohci_device = {+	.name		= "ar71xx-ohci",+	.id		= -1,+	.resource	= ar71xx_ohci_resources,+	.num_resources	= ARRAY_SIZE(ar71xx_ohci_resources),+	.dev = {+		.dma_mask		= &ar71xx_ohci_dmamask,+		.coherent_dma_mask	= DMA_BIT_MASK(32),+	},+};++/*+ * EHCI (USB full speed host controller)+ */+static struct resource ar71xx_ehci_resources[] = {+	[0] = {+		.start	= AR71XX_EHCI_BASE,+		.end	= AR71XX_EHCI_BASE + AR71XX_EHCI_SIZE - 1,+		.flags	= IORESOURCE_MEM,+	},+	[1] = {+		.start	= AR71XX_CPU_IRQ_USB,+		.end	= AR71XX_CPU_IRQ_USB,+		.flags	= IORESOURCE_IRQ,+	},+};++static u64 ar71xx_ehci_dmamask = DMA_BIT_MASK(32);+static struct ar71xx_ehci_platform_data ar71xx_ehci_data;++static struct platform_device ar71xx_ehci_device = {+	.name		= "ar71xx-ehci",+	.id		= -1,+	.resource	= ar71xx_ehci_resources,+	.num_resources	= ARRAY_SIZE(ar71xx_ehci_resources),+	.dev = {+		.dma_mask		= &ar71xx_ehci_dmamask,+		.coherent_dma_mask	= DMA_BIT_MASK(32),+		.platform_data		= &ar71xx_ehci_data,+	},+};++#define AR71XX_USB_RESET_MASK \+	(RESET_MODULE_USB_HOST | RESET_MODULE_USB_PHY \+	| RESET_MODULE_USB_OHCI_DLL)++#define AR7240_USB_RESET_MASK \+	(RESET_MODULE_USB_HOST | RESET_MODULE_USB_OHCI_DLL_7240)++static void __init ar71xx_usb_setup(void)+{+	ar71xx_device_stop(AR71XX_USB_RESET_MASK);+	mdelay(1000);+	ar71xx_device_start(AR71XX_USB_RESET_MASK);++	/* Turning on the Buff and Desc swap bits */+	ar71xx_usb_ctrl_wr(USB_CTRL_REG_CONFIG, 0xf0000);++	/* WAR for HW bug. Here it adjusts the duration between two SOFS */+	ar71xx_usb_ctrl_wr(USB_CTRL_REG_FLADJ, 0x20c00);++	mdelay(900);++	platform_device_register(&ar71xx_ohci_device);+	platform_device_register(&ar71xx_ehci_device);+}++static void __init ar7240_usb_setup(void)+{+	ar71xx_device_stop(AR7240_USB_RESET_MASK);+	mdelay(1000);+	ar71xx_device_start(AR7240_USB_RESET_MASK);++	/* WAR for HW bug. Here it adjusts the duration between two SOFS */+	ar71xx_usb_ctrl_wr(USB_CTRL_REG_FLADJ, 0x3);++	if (ar71xx_soc == AR71XX_SOC_AR7241 || ar71xx_soc == AR71XX_SOC_AR7242) {+		ar71xx_ehci_data.is_ar91xx = 1;+		ar71xx_ehci_device.resource = ar7240_ohci_resources;+		ar71xx_ehci_device.num_resources = ARRAY_SIZE(ar7240_ohci_resources);+		platform_device_register(&ar71xx_ehci_device);+	} else {+		ar71xx_ohci_device.resource = ar7240_ohci_resources;+		ar71xx_ohci_device.num_resources = ARRAY_SIZE(ar7240_ohci_resources);+		platform_device_register(&ar71xx_ohci_device);+	}+}++static void __init ar91xx_usb_setup(void)+{+	ar71xx_device_stop(RESET_MODULE_USBSUS_OVERRIDE);+	mdelay(10);++	ar71xx_device_start(RESET_MODULE_USB_HOST);+	mdelay(10);++	ar71xx_device_start(RESET_MODULE_USB_PHY);+	mdelay(10);++	ar71xx_ehci_data.is_ar91xx = 1;+	platform_device_register(&ar71xx_ehci_device);+}++void __init ar71xx_add_device_usb(void)+{+	switch (ar71xx_soc) {+	case AR71XX_SOC_AR7240:+	case AR71XX_SOC_AR7241:+	case AR71XX_SOC_AR7242:+		ar7240_usb_setup();+		break;++	case AR71XX_SOC_AR7130:+	case AR71XX_SOC_AR7141:+	case AR71XX_SOC_AR7161:+		ar71xx_usb_setup();+		break;++	case AR71XX_SOC_AR9130:+	case AR71XX_SOC_AR9132:+		ar91xx_usb_setup();+		break;++	default:+		BUG();+	}+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/dev-usb.h linux-2.6.37/arch/mips/ar71xx/dev-usb.h--- linux-2.6.37.orig/arch/mips/ar71xx/dev-usb.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/dev-usb.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,17 @@+/*+ *  Atheros AR71xx USB host device support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef _AR71XX_DEV_USB_H+#define _AR71XX_DEV_USB_H++void ar71xx_add_device_usb(void) __init;++#endif /* _AR71XX_DEV_USB_H */diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/devices.c linux-2.6.37/arch/mips/ar71xx/devices.c--- linux-2.6.37.orig/arch/mips/ar71xx/devices.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/devices.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,575 @@+/*+ *  Atheros AR71xx SoC platform devices+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Parts of this file are based on Atheros' 2.6.15 BSP+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/kernel.h>+#include <linux/init.h>+#include <linux/delay.h>+#include <linux/etherdevice.h>+#include <linux/platform_device.h>+#include <linux/serial_8250.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "devices.h"++static u8 ar71xx_mac_base[ETH_ALEN] __initdata;++static struct resource ar71xx_uart_resources[] = {+	{+		.start	= AR71XX_UART_BASE,+		.end	= AR71XX_UART_BASE + AR71XX_UART_SIZE - 1,+		.flags	= IORESOURCE_MEM,+	},+};++#define AR71XX_UART_FLAGS (UPF_BOOT_AUTOCONF | UPF_SKIP_TEST | UPF_IOREMAP)+static struct plat_serial8250_port ar71xx_uart_data[] = {+	{+		.mapbase	= AR71XX_UART_BASE,+		.irq		= AR71XX_MISC_IRQ_UART,+		.flags		= AR71XX_UART_FLAGS,+		.iotype		= UPIO_MEM32,+		.regshift	= 2,+	}, {+		/* terminating entry */+	}+};++static struct platform_device ar71xx_uart_device = {+	.name		= "serial8250",+	.id		= PLAT8250_DEV_PLATFORM,+	.resource	= ar71xx_uart_resources,+	.num_resources	= ARRAY_SIZE(ar71xx_uart_resources),+	.dev = {+		.platform_data	= ar71xx_uart_data+	},+};++void __init ar71xx_add_device_uart(void)+{+	ar71xx_uart_data[0].uartclk = ar71xx_ahb_freq;+	platform_device_register(&ar71xx_uart_device);+}++static struct resource ar71xx_mdio_resources[] = {+	{+		.name	= "mdio_base",+		.flags	= IORESOURCE_MEM,+		.start	= AR71XX_GE0_BASE,+		.end	= AR71XX_GE0_BASE + 0x200 - 1,+	}+};++static struct ag71xx_mdio_platform_data ar71xx_mdio_data;++struct platform_device ar71xx_mdio_device = {+	.name		= "ag71xx-mdio",+	.id		= -1,+	.resource	= ar71xx_mdio_resources,+	.num_resources	= ARRAY_SIZE(ar71xx_mdio_resources),+	.dev = {+		.platform_data = &ar71xx_mdio_data,+	},+};++void __init ar71xx_add_device_mdio(u32 phy_mask)+{+	switch (ar71xx_soc) {+	case AR71XX_SOC_AR7240:+	case AR71XX_SOC_AR7241:+	case AR71XX_SOC_AR7242:+		ar71xx_mdio_data.is_ar7240 = 1;+		break;+	default:+		break;+	}++	ar71xx_mdio_data.phy_mask = phy_mask;++	platform_device_register(&ar71xx_mdio_device);+}++static void ar71xx_set_pll(u32 cfg_reg, u32 pll_reg, u32 pll_val, u32 shift)+{+	void __iomem *base;+	u32 t;++	base = ioremap_nocache(AR71XX_PLL_BASE, AR71XX_PLL_SIZE);++	t = __raw_readl(base + cfg_reg);+	t &= ~(3 << shift);+	t |=  (2 << shift);+	__raw_writel(t, base + cfg_reg);+	udelay(100);++	__raw_writel(pll_val, base + pll_reg);++	t |= (3 << shift);+	__raw_writel(t, base + cfg_reg);+	udelay(100);++	t &= ~(3 << shift);+	__raw_writel(t, base + cfg_reg);+	udelay(100);++	printk(KERN_DEBUG "ar71xx: pll_reg %#x: %#x\n",+		(unsigned int)(base + pll_reg), __raw_readl(base + pll_reg));++	iounmap(base);+}++struct ar71xx_eth_pll_data ar71xx_eth0_pll_data;+struct ar71xx_eth_pll_data ar71xx_eth1_pll_data;++static u32 ar71xx_get_eth_pll(unsigned int mac, int speed)+{+	struct ar71xx_eth_pll_data *pll_data;+	u32 pll_val;++	switch (mac) {+	case 0:+		pll_data = &ar71xx_eth0_pll_data;+		break;+	case 1:+		pll_data = &ar71xx_eth1_pll_data;+		break;+	default:+		BUG();+	}++	switch (speed) {+	case SPEED_10:+		pll_val = pll_data->pll_10;+		break;+	case SPEED_100:+		pll_val = pll_data->pll_100;+		break;+	case SPEED_1000:+		pll_val = pll_data->pll_1000;+		break;+	default:+		BUG();+	}++	return pll_val;+}++static void ar71xx_set_pll_ge0(int speed)+{+	u32 val = ar71xx_get_eth_pll(0, speed);++	ar71xx_set_pll(AR71XX_PLL_REG_SEC_CONFIG, AR71XX_PLL_REG_ETH0_INT_CLOCK,+			val, AR71XX_ETH0_PLL_SHIFT);+}++static void ar71xx_set_pll_ge1(int speed)+{+	u32 val = ar71xx_get_eth_pll(1, speed);++	ar71xx_set_pll(AR71XX_PLL_REG_SEC_CONFIG, AR71XX_PLL_REG_ETH1_INT_CLOCK,+			 val, AR71XX_ETH1_PLL_SHIFT);+}++static void ar724x_set_pll_ge0(int speed)+{+	/* TODO */+}++static void ar724x_set_pll_ge1(int speed)+{+	/* TODO */+}++static void ar91xx_set_pll_ge0(int speed)+{+	u32 val = ar71xx_get_eth_pll(0, speed);++	ar71xx_set_pll(AR91XX_PLL_REG_ETH_CONFIG, AR91XX_PLL_REG_ETH0_INT_CLOCK,+			 val, AR91XX_ETH0_PLL_SHIFT);+}++static void ar91xx_set_pll_ge1(int speed)+{+	u32 val = ar71xx_get_eth_pll(1, speed);++	ar71xx_set_pll(AR91XX_PLL_REG_ETH_CONFIG, AR91XX_PLL_REG_ETH1_INT_CLOCK,+			 val, AR91XX_ETH1_PLL_SHIFT);+}++static void ar71xx_ddr_flush_ge0(void)+{+	ar71xx_ddr_flush(AR71XX_DDR_REG_FLUSH_GE0);+}++static void ar71xx_ddr_flush_ge1(void)+{+	ar71xx_ddr_flush(AR71XX_DDR_REG_FLUSH_GE1);+}++static void ar724x_ddr_flush_ge0(void)+{+	ar71xx_ddr_flush(AR724X_DDR_REG_FLUSH_GE0);+}++static void ar724x_ddr_flush_ge1(void)+{+	ar71xx_ddr_flush(AR724X_DDR_REG_FLUSH_GE1);+}++static void ar91xx_ddr_flush_ge0(void)+{+	ar71xx_ddr_flush(AR91XX_DDR_REG_FLUSH_GE0);+}++static void ar91xx_ddr_flush_ge1(void)+{+	ar71xx_ddr_flush(AR91XX_DDR_REG_FLUSH_GE1);+}++static struct resource ar71xx_eth0_resources[] = {+	{+		.name	= "mac_base",+		.flags	= IORESOURCE_MEM,+		.start	= AR71XX_GE0_BASE,+		.end	= AR71XX_GE0_BASE + 0x200 - 1,+	}, {+		.name	= "mii_ctrl",+		.flags	= IORESOURCE_MEM,+		.start	= AR71XX_MII_BASE + MII_REG_MII0_CTRL,+		.end	= AR71XX_MII_BASE + MII_REG_MII0_CTRL + 3,+	}, {+		.name	= "mac_irq",+		.flags	= IORESOURCE_IRQ,+		.start	= AR71XX_CPU_IRQ_GE0,+		.end	= AR71XX_CPU_IRQ_GE0,+	},+};++struct ag71xx_platform_data ar71xx_eth0_data = {+	.reset_bit	= RESET_MODULE_GE0_MAC,+};++struct platform_device ar71xx_eth0_device = {+	.name		= "ag71xx",+	.id		= 0,+	.resource	= ar71xx_eth0_resources,+	.num_resources	= ARRAY_SIZE(ar71xx_eth0_resources),+	.dev = {+		.platform_data = &ar71xx_eth0_data,+	},+};++static struct resource ar71xx_eth1_resources[] = {+	{+		.name	= "mac_base",+		.flags	= IORESOURCE_MEM,+		.start	= AR71XX_GE1_BASE,+		.end	= AR71XX_GE1_BASE + 0x200 - 1,+	}, {+		.name	= "mii_ctrl",+		.flags	= IORESOURCE_MEM,+		.start	= AR71XX_MII_BASE + MII_REG_MII1_CTRL,+		.end	= AR71XX_MII_BASE + MII_REG_MII1_CTRL + 3,+	}, {+		.name	= "mac_irq",+		.flags	= IORESOURCE_IRQ,+		.start	= AR71XX_CPU_IRQ_GE1,+		.end	= AR71XX_CPU_IRQ_GE1,+	},+};++struct ag71xx_platform_data ar71xx_eth1_data = {+	.reset_bit	= RESET_MODULE_GE1_MAC,+};++struct platform_device ar71xx_eth1_device = {+	.name		= "ag71xx",+	.id		= 1,+	.resource	= ar71xx_eth1_resources,+	.num_resources	= ARRAY_SIZE(ar71xx_eth1_resources),+	.dev = {+		.platform_data = &ar71xx_eth1_data,+	},+};++#define AR71XX_PLL_VAL_1000	0x00110000+#define AR71XX_PLL_VAL_100	0x00001099+#define AR71XX_PLL_VAL_10	0x00991099++#define AR724X_PLL_VAL_1000	0x00110000+#define AR724X_PLL_VAL_100	0x00001099+#define AR724X_PLL_VAL_10	0x00991099++#define AR91XX_PLL_VAL_1000	0x1a000000+#define AR91XX_PLL_VAL_100	0x13000a44+#define AR91XX_PLL_VAL_10	0x00441099++static void __init ar71xx_init_eth_pll_data(unsigned int id)+{+	struct ar71xx_eth_pll_data *pll_data;+	u32 pll_10, pll_100, pll_1000;++	switch (id) {+	case 0:+		pll_data = &ar71xx_eth0_pll_data;+		break;+	case 1:+		pll_data = &ar71xx_eth1_pll_data;+		break;+	default:+		BUG();+	}++	switch (ar71xx_soc) {+	case AR71XX_SOC_AR7130:+	case AR71XX_SOC_AR7141:+	case AR71XX_SOC_AR7161:+		pll_10 = AR71XX_PLL_VAL_10;+		pll_100 = AR71XX_PLL_VAL_100;+		pll_1000 = AR71XX_PLL_VAL_1000;+		break;++	case AR71XX_SOC_AR7240:+	case AR71XX_SOC_AR7241:+	case AR71XX_SOC_AR7242:+		pll_10 = AR724X_PLL_VAL_10;+		pll_100 = AR724X_PLL_VAL_100;+		pll_1000 = AR724X_PLL_VAL_1000;+		break;++	case AR71XX_SOC_AR9130:+	case AR71XX_SOC_AR9132:+		pll_10 = AR91XX_PLL_VAL_10;+		pll_100 = AR91XX_PLL_VAL_100;+		pll_1000 = AR91XX_PLL_VAL_1000;+		break;+	default:+		BUG();+	}++	if (!pll_data->pll_10)+		pll_data->pll_10 = pll_10;++	if (!pll_data->pll_100)+		pll_data->pll_100 = pll_100;++	if (!pll_data->pll_1000)+		pll_data->pll_1000 = pll_1000;+}++static int ar71xx_eth_instance __initdata;+void __init ar71xx_add_device_eth(unsigned int id)+{+	struct platform_device *pdev;+	struct ag71xx_platform_data *pdata;++	ar71xx_init_eth_pll_data(id);++	switch (id) {+	case 0:+		switch (ar71xx_eth0_data.phy_if_mode) {+		case PHY_INTERFACE_MODE_MII:+			ar71xx_eth0_data.mii_if = MII0_CTRL_IF_MII;+			break;+		case PHY_INTERFACE_MODE_GMII:+			ar71xx_eth0_data.mii_if = MII0_CTRL_IF_GMII;+			break;+		case PHY_INTERFACE_MODE_RGMII:+			ar71xx_eth0_data.mii_if = MII0_CTRL_IF_RGMII;+			break;+		case PHY_INTERFACE_MODE_RMII:+			ar71xx_eth0_data.mii_if = MII0_CTRL_IF_RMII;+			break;+		default:+			printk(KERN_ERR "ar71xx: invalid PHY interface mode "+					"for eth0\n");+			return;+		}+		pdev = &ar71xx_eth0_device;+		break;+	case 1:+		switch (ar71xx_eth1_data.phy_if_mode) {+		case PHY_INTERFACE_MODE_RMII:+			ar71xx_eth1_data.mii_if = MII1_CTRL_IF_RMII;+			break;+		case PHY_INTERFACE_MODE_RGMII:+			ar71xx_eth1_data.mii_if = MII1_CTRL_IF_RGMII;+			break;+		default:+			printk(KERN_ERR "ar71xx: invalid PHY interface mode "+					"for eth1\n");+			return;+		}+		pdev = &ar71xx_eth1_device;+		break;+	default:+		printk(KERN_ERR "ar71xx: invalid ethernet id %d\n", id);+		return;+	}++	pdata = pdev->dev.platform_data;++	switch (ar71xx_soc) {+	case AR71XX_SOC_AR7130:+		pdata->ddr_flush = id ? ar71xx_ddr_flush_ge1+				      : ar71xx_ddr_flush_ge0;+		pdata->set_pll =  id ? ar71xx_set_pll_ge1+				     : ar71xx_set_pll_ge0;+		break;++	case AR71XX_SOC_AR7141:+	case AR71XX_SOC_AR7161:+		pdata->ddr_flush = id ? ar71xx_ddr_flush_ge1+				      : ar71xx_ddr_flush_ge0;+		pdata->set_pll =  id ? ar71xx_set_pll_ge1+				     : ar71xx_set_pll_ge0;+		pdata->has_gbit = 1;+		break;++	case AR71XX_SOC_AR7241:+	case AR71XX_SOC_AR7242:+		ar71xx_eth0_data.reset_bit |= AR724X_RESET_GE0_MDIO;+		ar71xx_eth1_data.reset_bit |= AR724X_RESET_GE1_MDIO;+		/* fall through */+	case AR71XX_SOC_AR7240:+		pdata->ddr_flush = id ? ar724x_ddr_flush_ge1+				      : ar724x_ddr_flush_ge0;+		pdata->set_pll =  id ? ar724x_set_pll_ge1+				     : ar724x_set_pll_ge0;+		pdata->is_ar724x = 1;+		break;++	case AR71XX_SOC_AR9130:+		pdata->ddr_flush = id ? ar91xx_ddr_flush_ge1+				      : ar91xx_ddr_flush_ge0;+		pdata->set_pll =  id ? ar91xx_set_pll_ge1+				     : ar91xx_set_pll_ge0;+		pdata->is_ar91xx = 1;+		break;++	case AR71XX_SOC_AR9132:+		pdata->ddr_flush = id ? ar91xx_ddr_flush_ge1+				      : ar91xx_ddr_flush_ge0;+		pdata->set_pll =  id ? ar91xx_set_pll_ge1+				      : ar91xx_set_pll_ge0;+		pdata->is_ar91xx = 1;+		pdata->has_gbit = 1;+		break;++	default:+		BUG();+	}++	switch (pdata->phy_if_mode) {+	case PHY_INTERFACE_MODE_GMII:+	case PHY_INTERFACE_MODE_RGMII:+		if (!pdata->has_gbit) {+			printk(KERN_ERR "ar71xx: no gbit available on eth%d\n",+					id);+			return;+		}+		/* fallthrough */+	default:+		break;+	}++	if (is_valid_ether_addr(ar71xx_mac_base)) {+		memcpy(pdata->mac_addr, ar71xx_mac_base, ETH_ALEN);+		pdata->mac_addr[5] += ar71xx_eth_instance;+	} else {+		random_ether_addr(pdata->mac_addr);+		printk(KERN_DEBUG+			"ar71xx: using random MAC address for eth%d\n",+			ar71xx_eth_instance);+	}++	if (pdata->mii_bus_dev == NULL)+		pdata->mii_bus_dev = &ar71xx_mdio_device.dev;++	/* Reset the device */+	ar71xx_device_stop(pdata->reset_bit);+	mdelay(100);++	ar71xx_device_start(pdata->reset_bit);+	mdelay(100);++	platform_device_register(pdev);+	ar71xx_eth_instance++;+}++static struct resource ar71xx_spi_resources[] = {+	[0] = {+		.start	= AR71XX_SPI_BASE,+		.end	= AR71XX_SPI_BASE + AR71XX_SPI_SIZE - 1,+		.flags	= IORESOURCE_MEM,+	},+};++static struct platform_device ar71xx_spi_device = {+	.name		= "ar71xx-spi",+	.id		= -1,+	.resource	= ar71xx_spi_resources,+	.num_resources	= ARRAY_SIZE(ar71xx_spi_resources),+};++void __init ar71xx_add_device_spi(struct ar71xx_spi_platform_data *pdata,+				struct spi_board_info const *info,+				unsigned n)+{+	spi_register_board_info(info, n);+	ar71xx_spi_device.dev.platform_data = pdata;+	platform_device_register(&ar71xx_spi_device);+}++void __init ar71xx_add_device_wdt(void)+{+	platform_device_register_simple("ar71xx-wdt", -1, NULL, 0);+}++void __init ar71xx_set_mac_base(unsigned char *mac)+{+	memcpy(ar71xx_mac_base, mac, ETH_ALEN);+}++void __init ar71xx_parse_mac_addr(char *mac_str)+{+	u8 tmp[ETH_ALEN];+	int t;++	t = sscanf(mac_str, "%02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx",+			&tmp[0], &tmp[1], &tmp[2], &tmp[3], &tmp[4], &tmp[5]);++	if (t != ETH_ALEN)+		t = sscanf(mac_str, "%02hhx.%02hhx.%02hhx.%02hhx.%02hhx.%02hhx",+			&tmp[0], &tmp[1], &tmp[2], &tmp[3], &tmp[4], &tmp[5]);++	if (t == ETH_ALEN)+		ar71xx_set_mac_base(tmp);+	else+		printk(KERN_DEBUG "ar71xx: failed to parse mac address "+				"\"%s\"\n", mac_str);+}++static int __init ar71xx_ethaddr_setup(char *str)+{+	ar71xx_parse_mac_addr(str);+	return 1;+}+__setup("ethaddr=", ar71xx_ethaddr_setup);++static int __init ar71xx_kmac_setup(char *str)+{+	ar71xx_parse_mac_addr(str);+	return 1;+}+__setup("kmac=", ar71xx_kmac_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/devices.h linux-2.6.37/arch/mips/ar71xx/devices.h--- linux-2.6.37.orig/arch/mips/ar71xx/devices.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/devices.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,48 @@+/*+ *  Atheros AR71xx SoC device definitions+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef __AR71XX_DEVICES_H+#define __AR71XX_DEVICES_H++#include <asm/mach-ar71xx/platform.h>++struct platform_device;++void ar71xx_add_device_spi(struct ar71xx_spi_platform_data *pdata,+			   struct spi_board_info const *info,+			   unsigned n) __init;++void ar71xx_set_mac_base(unsigned char *mac) __init;+void ar71xx_parse_mac_addr(char *mac_str) __init;++struct ar71xx_eth_pll_data {+	u32	pll_10;+	u32	pll_100;+	u32	pll_1000;+};++extern struct ar71xx_eth_pll_data ar71xx_eth0_pll_data;+extern struct ar71xx_eth_pll_data ar71xx_eth1_pll_data;++extern struct ag71xx_platform_data ar71xx_eth0_data;+extern struct ag71xx_platform_data ar71xx_eth1_data;+extern struct platform_device ar71xx_eth0_device;+extern struct platform_device ar71xx_eth1_device;+void ar71xx_add_device_eth(unsigned int id) __init;++extern struct platform_device ar71xx_mdio_device;+void ar71xx_add_device_mdio(u32 phy_mask) __init;++void ar71xx_add_device_uart(void) __init;++void ar71xx_add_device_wdt(void) __init;++#endif /* __AR71XX_DEVICES_H */diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/early_printk.c linux-2.6.37/arch/mips/ar71xx/early_printk.c--- linux-2.6.37.orig/arch/mips/ar71xx/early_printk.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/early_printk.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,30 @@+/*+ *  Atheros AR71xx SoC early printk support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/io.h>+#include <linux/serial_reg.h>+#include <asm/addrspace.h>++#include <asm/mach-ar71xx/ar71xx.h>++#define UART_READ(r) \+	__raw_readl((void __iomem *)(KSEG1ADDR(AR71XX_UART_BASE) + 4 * (r)))++#define UART_WRITE(r, v) \+	__raw_writel((v), (void __iomem *)(KSEG1ADDR(AR71XX_UART_BASE) + 4*(r)))++void prom_putchar(unsigned char ch)+{+	while (((UART_READ(UART_LSR)) & UART_LSR_THRE) == 0);+	UART_WRITE(UART_TX, ch);+	while (((UART_READ(UART_LSR)) & UART_LSR_THRE) == 0);+}+diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/gpio.c linux-2.6.37/arch/mips/ar71xx/gpio.c--- linux-2.6.37.orig/arch/mips/ar71xx/gpio.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/gpio.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,182 @@+/*+ *  Atheros AR71xx SoC GPIO API support+ *+ *  Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/kernel.h>+#include <linux/init.h>+#include <linux/module.h>+#include <linux/types.h>+#include <linux/spinlock.h>+#include <linux/io.h>+#include <linux/ioport.h>+#include <linux/gpio.h>++#include <asm/mach-ar71xx/ar71xx.h>++static DEFINE_SPINLOCK(ar71xx_gpio_lock);++unsigned long ar71xx_gpio_count;+EXPORT_SYMBOL(ar71xx_gpio_count);++void __ar71xx_gpio_set_value(unsigned gpio, int value)+{+	void __iomem *base = ar71xx_gpio_base;++	if (value)+		__raw_writel(1 << gpio, base + GPIO_REG_SET);+	else+		__raw_writel(1 << gpio, base + GPIO_REG_CLEAR);+}+EXPORT_SYMBOL(__ar71xx_gpio_set_value);++int __ar71xx_gpio_get_value(unsigned gpio)+{+	return (__raw_readl(ar71xx_gpio_base + GPIO_REG_IN) >> gpio) & 1;+}+EXPORT_SYMBOL(__ar71xx_gpio_get_value);++static int ar71xx_gpio_get_value(struct gpio_chip *chip, unsigned offset)+{+	return __ar71xx_gpio_get_value(offset);+}++static void ar71xx_gpio_set_value(struct gpio_chip *chip,+				  unsigned offset, int value)+{+	__ar71xx_gpio_set_value(offset, value);+}++static int ar71xx_gpio_direction_input(struct gpio_chip *chip,+				       unsigned offset)+{+	void __iomem *base = ar71xx_gpio_base;+	unsigned long flags;++	spin_lock_irqsave(&ar71xx_gpio_lock, flags);++	__raw_writel(__raw_readl(base + GPIO_REG_OE) & ~(1 << offset),+		     base + GPIO_REG_OE);++	spin_unlock_irqrestore(&ar71xx_gpio_lock, flags);++	return 0;+}++static int ar71xx_gpio_direction_output(struct gpio_chip *chip,+					unsigned offset, int value)+{+	void __iomem *base = ar71xx_gpio_base;+	unsigned long flags;++	spin_lock_irqsave(&ar71xx_gpio_lock, flags);++	if (value)+		__raw_writel(1 << offset, base + GPIO_REG_SET);+	else+		__raw_writel(1 << offset, base + GPIO_REG_CLEAR);++	__raw_writel(__raw_readl(base + GPIO_REG_OE) | (1 << offset),+		     base + GPIO_REG_OE);++	spin_unlock_irqrestore(&ar71xx_gpio_lock, flags);++	return 0;+}++static struct gpio_chip ar71xx_gpio_chip = {+	.label			= "ar71xx",+	.get			= ar71xx_gpio_get_value,+	.set			= ar71xx_gpio_set_value,+	.direction_input	= ar71xx_gpio_direction_input,+	.direction_output	= ar71xx_gpio_direction_output,+	.base			= 0,+	.ngpio			= AR71XX_GPIO_COUNT,+};++void ar71xx_gpio_function_enable(u32 mask)+{+	void __iomem *base = ar71xx_gpio_base;+	unsigned long flags;++	spin_lock_irqsave(&ar71xx_gpio_lock, flags);++	__raw_writel(__raw_readl(base + GPIO_REG_FUNC) | mask,+		     base + GPIO_REG_FUNC);+	/* flush write */+	(void) __raw_readl(base + GPIO_REG_FUNC);++	spin_unlock_irqrestore(&ar71xx_gpio_lock, flags);+}++void ar71xx_gpio_function_disable(u32 mask)+{+	void __iomem *base = ar71xx_gpio_base;+	unsigned long flags;++	spin_lock_irqsave(&ar71xx_gpio_lock, flags);++	__raw_writel(__raw_readl(base + GPIO_REG_FUNC) & ~mask,+		     base + GPIO_REG_FUNC);+	/* flush write */+	(void) __raw_readl(base + GPIO_REG_FUNC);++	spin_unlock_irqrestore(&ar71xx_gpio_lock, flags);+}++void ar71xx_gpio_function_setup(u32 set, u32 clear)+{+	void __iomem *base = ar71xx_gpio_base;+	unsigned long flags;++	spin_lock_irqsave(&ar71xx_gpio_lock, flags);++	__raw_writel((__raw_readl(base + GPIO_REG_FUNC) & ~clear) | set,+		     base + GPIO_REG_FUNC);+	/* flush write */+	(void) __raw_readl(base + GPIO_REG_FUNC);++	spin_unlock_irqrestore(&ar71xx_gpio_lock, flags);+}+EXPORT_SYMBOL(ar71xx_gpio_function_setup);++void __init ar71xx_gpio_init(void)+{+	int err;++	if (!request_mem_region(AR71XX_GPIO_BASE, AR71XX_GPIO_SIZE,+				"AR71xx GPIO controller"))+		panic("cannot allocate AR71xx GPIO registers page");++	switch (ar71xx_soc) {+	case AR71XX_SOC_AR7130:+	case AR71XX_SOC_AR7141:+	case AR71XX_SOC_AR7161:+		ar71xx_gpio_chip.ngpio = AR71XX_GPIO_COUNT;+		break;++	case AR71XX_SOC_AR7240:+	case AR71XX_SOC_AR7241:+	case AR71XX_SOC_AR7242:+		ar71xx_gpio_chip.ngpio = AR724X_GPIO_COUNT;+		break;++	case AR71XX_SOC_AR9130:+	case AR71XX_SOC_AR9132:+		ar71xx_gpio_chip.ngpio = AR91XX_GPIO_COUNT;+		break;++	default:+		BUG();+	}++	err = gpiochip_add(&ar71xx_gpio_chip);+	if (err)+		panic("cannot add AR71xx GPIO chip, error=%d", err);+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/irq.c linux-2.6.37/arch/mips/ar71xx/irq.c--- linux-2.6.37.orig/arch/mips/ar71xx/irq.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/irq.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,295 @@+/*+ *  Atheros AR71xx SoC specific interrupt handling+ *+ *  Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Parts of this file are based on Atheros' 2.6.15 BSP+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/kernel.h>+#include <linux/init.h>+#include <linux/interrupt.h>+#include <linux/irq.h>++#include <asm/irq_cpu.h>+#include <asm/mipsregs.h>++#include <asm/mach-ar71xx/ar71xx.h>++static int ip2_flush_reg;++static void ar71xx_gpio_irq_dispatch(void)+{+	void __iomem *base = ar71xx_gpio_base;+	u32 pending;++	pending = __raw_readl(base + GPIO_REG_INT_PENDING) &+		  __raw_readl(base + GPIO_REG_INT_ENABLE);++	if (pending)+		do_IRQ(AR71XX_GPIO_IRQ_BASE + fls(pending) - 1);+	else+		spurious_interrupt();+}++static void ar71xx_gpio_irq_unmask(unsigned int irq)+{+	void __iomem *base = ar71xx_gpio_base;+	u32 t;++	irq -= AR71XX_GPIO_IRQ_BASE;++	t = __raw_readl(base + GPIO_REG_INT_ENABLE);+	__raw_writel(t | (1 << irq), base + GPIO_REG_INT_ENABLE);++	/* flush write */+	(void) __raw_readl(base + GPIO_REG_INT_ENABLE);+}++static void ar71xx_gpio_irq_mask(unsigned int irq)+{+	void __iomem *base = ar71xx_gpio_base;+	u32 t;++	irq -= AR71XX_GPIO_IRQ_BASE;++	t = __raw_readl(base + GPIO_REG_INT_ENABLE);+	__raw_writel(t & ~(1 << irq), base + GPIO_REG_INT_ENABLE);++	/* flush write */+	(void) __raw_readl(base + GPIO_REG_INT_ENABLE);+}++#if 0+static int ar71xx_gpio_irq_set_type(unsigned int irq, unsigned int flow_type)+{+	/* TODO: implement */+	return 0;+}+#else+#define ar71xx_gpio_irq_set_type	NULL+#endif++static struct irq_chip ar71xx_gpio_irq_chip = {+	.name		= "AR71XX GPIO",+	.unmask		= ar71xx_gpio_irq_unmask,+	.mask		= ar71xx_gpio_irq_mask,+	.mask_ack	= ar71xx_gpio_irq_mask,+	.set_type	= ar71xx_gpio_irq_set_type,+};++static struct irqaction ar71xx_gpio_irqaction = {+	.handler	= no_action,+	.name		= "cascade [AR71XX GPIO]",+};++#define GPIO_IRQ_INIT_STATUS (IRQ_LEVEL | IRQ_TYPE_LEVEL_HIGH | IRQ_DISABLED)+#define GPIO_INT_ALL	0xffff++static void __init ar71xx_gpio_irq_init(void)+{+	void __iomem *base = ar71xx_gpio_base;+	int i;++	__raw_writel(0, base + GPIO_REG_INT_ENABLE);+	__raw_writel(0, base + GPIO_REG_INT_PENDING);++	/* setup type of all GPIO interrupts to level sensitive */+	__raw_writel(GPIO_INT_ALL, base + GPIO_REG_INT_TYPE);++	/* setup polarity of all GPIO interrupts to active high */+	__raw_writel(GPIO_INT_ALL, base + GPIO_REG_INT_POLARITY);++	for (i = AR71XX_GPIO_IRQ_BASE;+	     i < AR71XX_GPIO_IRQ_BASE + AR71XX_GPIO_IRQ_COUNT; i++) {+		irq_desc[i].status = GPIO_IRQ_INIT_STATUS;+		set_irq_chip_and_handler(i, &ar71xx_gpio_irq_chip,+					 handle_level_irq);+	}++	setup_irq(AR71XX_MISC_IRQ_GPIO, &ar71xx_gpio_irqaction);+}++static void ar71xx_misc_irq_dispatch(void)+{+	u32 pending;++	pending = ar71xx_reset_rr(AR71XX_RESET_REG_MISC_INT_STATUS)+	    & ar71xx_reset_rr(AR71XX_RESET_REG_MISC_INT_ENABLE);++	if (pending & MISC_INT_UART)+		do_IRQ(AR71XX_MISC_IRQ_UART);++	else if (pending & MISC_INT_DMA)+		do_IRQ(AR71XX_MISC_IRQ_DMA);++	else if (pending & MISC_INT_PERFC)+		do_IRQ(AR71XX_MISC_IRQ_PERFC);++	else if (pending & MISC_INT_TIMER)+		do_IRQ(AR71XX_MISC_IRQ_TIMER);++	else if (pending & MISC_INT_OHCI)+		do_IRQ(AR71XX_MISC_IRQ_OHCI);++	else if (pending & MISC_INT_ERROR)+		do_IRQ(AR71XX_MISC_IRQ_ERROR);++	else if (pending & MISC_INT_GPIO)+		ar71xx_gpio_irq_dispatch();++	else if (pending & MISC_INT_WDOG)+		do_IRQ(AR71XX_MISC_IRQ_WDOG);++	else+		spurious_interrupt();+}++static void ar71xx_misc_irq_unmask(unsigned int irq)+{+	void __iomem *base = ar71xx_reset_base;+	u32 t;++	irq -= AR71XX_MISC_IRQ_BASE;++	t = __raw_readl(base + AR71XX_RESET_REG_MISC_INT_ENABLE);+	__raw_writel(t | (1 << irq), base + AR71XX_RESET_REG_MISC_INT_ENABLE);++	/* flush write */+	(void) __raw_readl(base + AR71XX_RESET_REG_MISC_INT_ENABLE);+}++static void ar71xx_misc_irq_mask(unsigned int irq)+{+	void __iomem *base = ar71xx_reset_base;+	u32 t;++	irq -= AR71XX_MISC_IRQ_BASE;++	t = __raw_readl(base + AR71XX_RESET_REG_MISC_INT_ENABLE);+	__raw_writel(t & ~(1 << irq), base + AR71XX_RESET_REG_MISC_INT_ENABLE);++	/* flush write */+	(void) __raw_readl(base + AR71XX_RESET_REG_MISC_INT_ENABLE);+}++static void ar724x_misc_irq_ack(unsigned int irq)+{+	void __iomem *base = ar71xx_reset_base;+	u32 t;++	irq -= AR71XX_MISC_IRQ_BASE;++	t = __raw_readl(base + AR71XX_RESET_REG_MISC_INT_STATUS);+	__raw_writel(t & ~(1 << irq), base + AR71XX_RESET_REG_MISC_INT_STATUS);++	/* flush write */+	(void) __raw_readl(base + AR71XX_RESET_REG_MISC_INT_STATUS);+}++static struct irq_chip ar71xx_misc_irq_chip = {+	.name		= "AR71XX MISC",+	.unmask		= ar71xx_misc_irq_unmask,+	.mask		= ar71xx_misc_irq_mask,+};++static struct irqaction ar71xx_misc_irqaction = {+	.handler	= no_action,+	.name		= "cascade [AR71XX MISC]",+};++static void __init ar71xx_misc_irq_init(void)+{+	void __iomem *base = ar71xx_reset_base;+	int i;++	__raw_writel(0, base + AR71XX_RESET_REG_MISC_INT_ENABLE);+	__raw_writel(0, base + AR71XX_RESET_REG_MISC_INT_STATUS);++	switch (ar71xx_soc) {+	case AR71XX_SOC_AR7240:+	case AR71XX_SOC_AR7241:+	case AR71XX_SOC_AR7242:+		ar71xx_misc_irq_chip.ack = ar724x_misc_irq_ack;+		break;+	default:+		ar71xx_misc_irq_chip.mask_ack = ar71xx_misc_irq_mask;+		break;+	}++	for (i = AR71XX_MISC_IRQ_BASE;+	     i < AR71XX_MISC_IRQ_BASE + AR71XX_MISC_IRQ_COUNT; i++) {+		irq_desc[i].status = IRQ_DISABLED;+		set_irq_chip_and_handler(i, &ar71xx_misc_irq_chip,+					 handle_level_irq);+	}++	setup_irq(AR71XX_CPU_IRQ_MISC, &ar71xx_misc_irqaction);+}++asmlinkage void plat_irq_dispatch(void)+{+	unsigned long pending;++	pending = read_c0_status() & read_c0_cause() & ST0_IM;++	if (pending & STATUSF_IP7)+		do_IRQ(AR71XX_CPU_IRQ_TIMER);++	else if (pending & STATUSF_IP2) {+		/*+		 * This IRQ is meant for a PCI device. Drivers for PCI devices+		 * typically allocate coherent DMA memory for the descriptor+		 * ring, however the DMA controller may still have some+		 * unsynchronized data in the FIFO.+		 * Issue a flush here to ensure that the driver sees the update.+		 */+		ar71xx_ddr_flush(ip2_flush_reg);+		do_IRQ(AR71XX_CPU_IRQ_IP2);+	}++	else if (pending & STATUSF_IP4)+		do_IRQ(AR71XX_CPU_IRQ_GE0);++	else if (pending & STATUSF_IP5)+		do_IRQ(AR71XX_CPU_IRQ_GE1);++	else if (pending & STATUSF_IP3)+		do_IRQ(AR71XX_CPU_IRQ_USB);++	else if (pending & STATUSF_IP6)+		ar71xx_misc_irq_dispatch();++	else+		spurious_interrupt();+}++void __init arch_init_irq(void)+{+	switch(ar71xx_soc) {+	case AR71XX_SOC_AR7240:+	case AR71XX_SOC_AR7241:+	case AR71XX_SOC_AR7242:+		ip2_flush_reg = AR724X_DDR_REG_FLUSH_PCIE;+		break;+	case AR71XX_SOC_AR9130:+	case AR71XX_SOC_AR9132:+		ip2_flush_reg = AR91XX_DDR_REG_FLUSH_WMAC;+		break;+	default:+		ip2_flush_reg = AR71XX_DDR_REG_FLUSH_PCI;+		break;+	}+	mips_cpu_irq_init();++	ar71xx_misc_irq_init();++	cp0_perfcount_irq = AR71XX_MISC_IRQ_PERFC;++	ar71xx_gpio_irq_init();+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-ap81.c linux-2.6.37/arch/mips/ar71xx/mach-ap81.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-ap81.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-ap81.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,140 @@+/*+ *  Atheros AP81 board support+ *+ *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2009 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-ar913x-wmac.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"+#include "dev-usb.h"++#define AP81_GPIO_LED_STATUS	1+#define AP81_GPIO_LED_AOSS	3+#define AP81_GPIO_LED_WLAN	6+#define AP81_GPIO_LED_POWER	14++#define AP81_GPIO_BTN_SW4	12+#define AP81_GPIO_BTN_SW1	21++#define AP81_BUTTONS_POLL_INTERVAL	20++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition ap81_partitions[] = {+	{+		.name		= "u-boot",+		.offset		= 0,+		.size		= 0x040000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "u-boot-env",+		.offset		= 0x040000,+		.size		= 0x010000,+	} , {+		.name		= "rootfs",+		.offset		= 0x050000,+		.size		= 0x500000,+	} , {+		.name		= "uImage",+		.offset		= 0x550000,+		.size		= 0x100000,+	} , {+		.name		= "ART",+		.offset		= 0x650000,+		.size		= 0x1b0000,+		.mask_flags	= MTD_WRITEABLE,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data ap81_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = ap81_partitions,+        .nr_parts       = ARRAY_SIZE(ap81_partitions),+#endif+};++static struct gpio_led ap81_leds_gpio[] __initdata = {+	{+		.name		= "ap81:green:status",+		.gpio		= AP81_GPIO_LED_STATUS,+		.active_low	= 1,+	}, {+		.name		= "ap81:amber:aoss",+		.gpio		= AP81_GPIO_LED_AOSS,+		.active_low	= 1,+	}, {+		.name		= "ap81:green:wlan",+		.gpio		= AP81_GPIO_LED_WLAN,+		.active_low	= 1,+	}, {+		.name		= "ap81:green:power",+		.gpio		= AP81_GPIO_LED_POWER,+		.active_low	= 1,+	}+};++static struct gpio_button ap81_gpio_buttons[] __initdata = {+	{+		.desc		= "sw1",+		.type		= EV_KEY,+		.code		= BTN_0,+		.threshold	= 3,+		.gpio		= AP81_GPIO_BTN_SW1,+		.active_low	= 1,+	} , {+		.desc		= "sw4",+		.type		= EV_KEY,+		.code		= BTN_1,+		.threshold	= 3,+		.gpio		= AP81_GPIO_BTN_SW4,+		.active_low	= 1,+	}+};++static void __init ap81_setup(void)+{+	u8 *eeprom = (u8 *) KSEG1ADDR(0x1fff1000);++	ar71xx_set_mac_base(eeprom);+	ar71xx_add_device_mdio(0x0);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth0_data.speed = SPEED_100;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;+	ar71xx_eth0_data.has_ar8216 = 1;++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.phy_mask = 0x10;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_add_device_usb();++	ar71xx_add_device_m25p80(&ap81_flash_data);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(ap81_leds_gpio),+					ap81_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, AP81_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(ap81_gpio_buttons),+					ap81_gpio_buttons);++	ar913x_add_device_wmac(eeprom, NULL);+}++MIPS_MACHINE(AR71XX_MACH_AP81, "AP81", "Atheros AP81", ap81_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-ap83.c linux-2.6.37/arch/mips/ar71xx/mach-ap83.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-ap83.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-ap83.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,266 @@+/*+ *  Atheros AP83 board support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/delay.h>+#include <linux/platform_device.h>+#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>+#include <linux/spi/spi.h>+#include <linux/spi/spi_gpio.h>+#include <linux/spi/vsc7385.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/ar91xx_flash.h>++#include "machtype.h"+#include "devices.h"+#include "dev-ar913x-wmac.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"+#include "dev-usb.h"++#define AP83_GPIO_LED_WLAN	6+#define AP83_GPIO_LED_POWER	14+#define AP83_GPIO_LED_JUMPSTART	15+#define AP83_GPIO_BTN_JUMPSTART	12+#define AP83_GPIO_BTN_RESET	21++#define AP83_050_GPIO_VSC7385_CS	1+#define AP83_050_GPIO_VSC7385_MISO	3+#define AP83_050_GPIO_VSC7385_MOSI	16+#define AP83_050_GPIO_VSC7385_SCK	17++#define AP83_BUTTONS_POLL_INTERVAL	20++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition ap83_flash_partitions[] = {+	{+		.name		= "u-boot",+		.offset		= 0,+		.size		= 0x040000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "u-boot-env",+		.offset		= 0x040000,+		.size		= 0x020000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "kernel",+		.offset		= 0x060000,+		.size		= 0x140000,+	} , {+		.name		= "rootfs",+		.offset		= 0x1a0000,+		.size		= 0x650000,+	} , {+		.name		= "art",+		.offset		= 0x7f0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "firmware",+		.offset		= 0x060000,+		.size		= 0x790000,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct ar91xx_flash_platform_data ap83_flash_data = {+	.width		= 2,+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = ap83_flash_partitions,+        .nr_parts       = ARRAY_SIZE(ap83_flash_partitions),+#endif+};++static struct resource ap83_flash_resources[] = {+	[0] = {+		.start	= AR71XX_SPI_BASE,+		.end	= AR71XX_SPI_BASE + AR71XX_SPI_SIZE - 1,+		.flags	= IORESOURCE_MEM,+	},+};++static struct platform_device ap83_flash_device = {+	.name		= "ar91xx-flash",+	.id		= -1,+	.resource	= ap83_flash_resources,+	.num_resources	= ARRAY_SIZE(ap83_flash_resources),+	.dev		= {+		.platform_data = &ap83_flash_data,+	}+};++static struct gpio_led ap83_leds_gpio[] __initdata = {+	{+		.name		= "ap83:green:jumpstart",+		.gpio		= AP83_GPIO_LED_JUMPSTART,+		.active_low	= 0,+	}, {+		.name		= "ap83:green:power",+		.gpio		= AP83_GPIO_LED_POWER,+		.active_low	= 0,+	}, {+		.name		= "ap83:green:wlan",+		.gpio		= AP83_GPIO_LED_WLAN,+		.active_low	= 0,+	},+};++static struct gpio_button ap83_gpio_buttons[] __initdata = {+	{+		.desc		= "soft_reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= AP83_GPIO_BTN_RESET,+		.active_low	= 1,+	} , {+		.desc		= "jumpstart",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= AP83_GPIO_BTN_JUMPSTART,+		.active_low	= 1,+	}+};++static struct resource ap83_040_spi_resources[] = {+	[0] = {+		.start	= AR71XX_SPI_BASE,+		.end	= AR71XX_SPI_BASE + AR71XX_SPI_SIZE - 1,+		.flags	= IORESOURCE_MEM,+	},+};++static struct platform_device ap83_040_spi_device = {+	.name		= "ap83-spi",+	.id		= 0,+	.resource	= ap83_040_spi_resources,+	.num_resources	= ARRAY_SIZE(ap83_040_spi_resources),+};++static struct spi_gpio_platform_data ap83_050_spi_data = {+	.miso	= AP83_050_GPIO_VSC7385_MISO,+	.mosi	= AP83_050_GPIO_VSC7385_MOSI,+	.sck	= AP83_050_GPIO_VSC7385_SCK,+	.num_chipselect = 1,+};++static struct platform_device ap83_050_spi_device = {+	.name		= "spi_gpio",+	.id		= 0,+	.dev		= {+		.platform_data = &ap83_050_spi_data,+	}+};++static void ap83_vsc7385_reset(void)+{+	ar71xx_device_stop(RESET_MODULE_GE1_PHY);+	udelay(10);+	ar71xx_device_start(RESET_MODULE_GE1_PHY);+	mdelay(50);+}++static struct vsc7385_platform_data ap83_vsc7385_data = {+	.reset		= ap83_vsc7385_reset,+	.ucode_name	= "vsc7385_ucode_ap83.bin",+	.mac_cfg = {+		.tx_ipg		= 6,+		.bit2		= 0,+		.clk_sel	= 3,+	},+};++static struct spi_board_info ap83_spi_info[] = {+	{+		.bus_num	= 0,+		.chip_select	= 0,+		.max_speed_hz	= 25000000,+		.modalias	= "spi-vsc7385",+		.platform_data	= &ap83_vsc7385_data,+		.controller_data = (void *) AP83_050_GPIO_VSC7385_CS,+	}+};++static void __init ap83_generic_setup(void)+{+	u8 *eeprom = (u8 *) KSEG1ADDR(0x1fff1000);++	ar71xx_set_mac_base(eeprom);++	ar71xx_add_device_mdio(0xfffffffe);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;+	ar71xx_eth0_data.phy_mask = 0x1;++	ar71xx_add_device_eth(0);++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;+	ar71xx_eth1_data.speed = SPEED_1000;+	ar71xx_eth1_data.duplex = DUPLEX_FULL;++	ar71xx_eth1_pll_data.pll_1000 = 0x1f000000;++	ar71xx_add_device_eth(1);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(ap83_leds_gpio),+					ap83_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, AP83_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(ap83_gpio_buttons),+					ap83_gpio_buttons);++	ar71xx_add_device_usb();++	ar913x_add_device_wmac(eeprom, NULL);++	platform_device_register(&ap83_flash_device);++	spi_register_board_info(ap83_spi_info, ARRAY_SIZE(ap83_spi_info));+}++static void __init ap83_040_setup(void)+{+	ap83_flash_data.is_shared=1;+	ap83_generic_setup();+	platform_device_register(&ap83_040_spi_device);+}++static void __init ap83_050_setup(void)+{+	ap83_generic_setup();+	platform_device_register(&ap83_050_spi_device);+}++static void __init ap83_setup(void)+{+	u8 *board_id = (u8 *) KSEG1ADDR(0x1fff1244);+	unsigned int board_version;++	board_version = (unsigned int)(board_id[0] - '0');+	board_version += ((unsigned int)(board_id[1] - '0')) * 10;++	switch (board_version) {+	case 40:+		ap83_040_setup();+		break;+	case 50:+		ap83_050_setup();+		break;+	default:+		printk(KERN_WARNING "AP83-%03u board is not yet supported\n",+		       board_version);+	}+}++MIPS_MACHINE(AR71XX_MACH_AP83, "AP83", "Atheros AP83", ap83_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-aw-nr580.c linux-2.6.37/arch/mips/ar71xx/mach-aw-nr580.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-aw-nr580.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-aw-nr580.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,101 @@+/*+ *  AzureWave AW-NR580 board support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>++#include <asm/mips_machine.h>+#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-gpio-buttons.h"+#include "dev-pb42-pci.h"+#include "dev-leds-gpio.h"++#define AW_NR580_GPIO_LED_READY_RED	0+#define AW_NR580_GPIO_LED_WLAN		1+#define AW_NR580_GPIO_LED_READY_GREEN	2+#define AW_NR580_GPIO_LED_WPS_GREEN	4+#define AW_NR580_GPIO_LED_WPS_AMBER	5++#define AW_NR580_GPIO_BTN_WPS		3+#define AW_NR580_GPIO_BTN_RESET		11++#define AW_NR580_BUTTONS_POLL_INTERVAL	20++static struct gpio_led aw_nr580_leds_gpio[] __initdata = {+	{+		.name		= "aw-nr580:red:ready",+		.gpio		= AW_NR580_GPIO_LED_READY_RED,+		.active_low	= 0,+	}, {+		.name		= "aw-nr580:green:ready",+		.gpio		= AW_NR580_GPIO_LED_READY_GREEN,+		.active_low	= 0,+	}, {+		.name		= "aw-nr580:green:wps",+		.gpio		= AW_NR580_GPIO_LED_WPS_GREEN,+		.active_low	= 0,+	}, {+		.name		= "aw-nr580:amber:wps",+		.gpio		= AW_NR580_GPIO_LED_WPS_AMBER,+		.active_low	= 0,+	}, {+		.name		= "aw-nr580:green:wlan",+		.gpio		= AW_NR580_GPIO_LED_WLAN,+		.active_low	= 0,+	}+};++static struct gpio_button aw_nr580_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= AW_NR580_GPIO_BTN_RESET,+		.active_low	= 1,+	}, {+		.desc		= "wps",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= AW_NR580_GPIO_BTN_WPS,+		.active_low	= 1,+	}+};++static void __init aw_nr580_setup(void)+{+	ar71xx_add_device_mdio(0x0);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_MII;+	ar71xx_eth0_data.speed = SPEED_100;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;++	ar71xx_add_device_eth(0);++	pb42_pci_init();++	ar71xx_add_device_m25p80(NULL);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(aw_nr580_leds_gpio),+					aw_nr580_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, AW_NR580_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(aw_nr580_gpio_buttons),+					aw_nr580_gpio_buttons);+}++MIPS_MACHINE(AR71XX_MACH_AW_NR580, "AW-NR580", "AzureWave AW-NR580",+	     aw_nr580_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-dir-600-a1.c linux-2.6.37/arch/mips/ar71xx/mach-dir-600-a1.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-dir-600-a1.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-dir-600-a1.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,138 @@+/*+ *  D-Link DIR-600 rev. A1 board support+ *+ *  Copyright (C) 2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-ap91-eth.h"+#include "dev-ap91-pci.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"+#include "nvram.h"++#define DIR_600_A1_GPIO_LED_WPS			0+#define DIR_600_A1_GPIO_LED_POWER_AMBER		1+#define DIR_600_A1_GPIO_LED_POWER_GREEN		6++#define DIR_600_A1_GPIO_BTN_RESET		8+#define DIR_600_A1_GPIO_BTN_WPS			12++#define DIR_600_A1_BUTTONS_POLL_INTERVAL	20++#define DIR_600_A1_NVRAM_ADDR	0x1f030000+#define DIR_600_A1_NVRAM_SIZE	0x10000++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition dir_600_a1_partitions[] = {+	{+		.name		= "u-boot",+		.offset		= 0,+		.size		= 0x030000,+		.mask_flags	= MTD_WRITEABLE,+	}, {+		.name		= "nvram",+		.offset		= 0x030000,+		.size		= 0x010000,+	}, {+		.name		= "kernel",+		.offset		= 0x040000,+		.size		= 0x0e0000,+	}, {+		.name		= "rootfs",+		.offset		= 0x120000,+		.size		= 0x2c0000,+	}, {+		.name		= "mac",+		.offset		= 0x3e0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	}, {+		.name		= "art",+		.offset		= 0x3f0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	}, {+		.name		= "firmware",+		.offset		= 0x040000,+		.size		= 0x3a0000,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data dir_600_a1_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = dir_600_a1_partitions,+        .nr_parts       = ARRAY_SIZE(dir_600_a1_partitions),+#endif+};++static struct gpio_led dir_600_a1_leds_gpio[] __initdata = {+	{+		.name		= "dir-600-a1:green:power",+		.gpio		= DIR_600_A1_GPIO_LED_POWER_GREEN,+	}, {+		.name		= "dir-600-a1:amber:power",+		.gpio		= DIR_600_A1_GPIO_LED_POWER_AMBER,+	}, {+		.name		= "dir-600-a1:blue:wps",+		.gpio		= DIR_600_A1_GPIO_LED_WPS,+		.active_low	= 1,+	}+};++static struct gpio_button dir_600_a1_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= DIR_600_A1_GPIO_BTN_RESET,+		.active_low	= 1,+	}, {+		.desc		= "wps",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= DIR_600_A1_GPIO_BTN_WPS,+		.active_low	= 1,+	}+};++static void __init dir_600_a1_setup(void)+{+	const char *nvram = (char *) KSEG1ADDR(DIR_600_A1_NVRAM_ADDR);+	u8 *ee = (u8 *) KSEG1ADDR(0x1fff1000);+	u8 mac_buff[6];+	u8 *mac = NULL;++	if (nvram_parse_mac_addr(nvram, DIR_600_A1_NVRAM_SIZE,+			         "lan_mac=", mac_buff) == 0)+		mac = mac_buff;++	ar71xx_add_device_m25p80(&dir_600_a1_flash_data);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(dir_600_a1_leds_gpio),+					dir_600_a1_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, DIR_600_A1_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(dir_600_a1_gpio_buttons),+					dir_600_a1_gpio_buttons);++	ap91_eth_init(mac, NULL);+	ap91_pci_init(ee, mac);+}++MIPS_MACHINE(AR71XX_MACH_DIR_600_A1, "DIR-600-A1", "D-Link DIR-600 rev. A1",+	     dir_600_a1_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-dir-615-c1.c linux-2.6.37/arch/mips/ar71xx/mach-dir-615-c1.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-dir-615-c1.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-dir-615-c1.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,173 @@+/*+ *  D-Link DIR-615 rev C1 board support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-ar913x-wmac.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"+#include "nvram.h"++#define DIR_615C1_GPIO_LED_ORANGE_STATUS 1	/* ORANGE:STATUS:TRICOLOR */+#define DIR_615C1_GPIO_LED_BLUE_WPS	3	/* BLUE:WPS */+#define DIR_615C1_GPIO_LED_GREEN_WAN	4       /* GREEN:WAN:TRICOLOR */+#define DIR_615C1_GPIO_LED_GREEN_WANCPU	5       /* GREEN:WAN:CPU:TRICOLOR */+#define DIR_615C1_GPIO_LED_GREEN_WLAN	6	/* GREEN:WLAN */+#define DIR_615C1_GPIO_LED_GREEN_STATUS	14	/* GREEN:STATUS:TRICOLOR */+#define DIR_615C1_GPIO_LED_ORANGE_WAN	15	/* ORANGE:WAN:TRICOLOR */++/* buttons may need refinement */++#define DIR_615C1_GPIO_BTN_WPS		12+#define DIR_615C1_GPIO_BTN_RESET	21++#define DIR_615C1_BUTTONS_POLL_INTERVAL	20++#define DIR_615C1_CONFIG_ADDR		0x1f020000+#define DIR_615C1_CONFIG_SIZE		0x10000++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition dir_615c1_partitions[] = {+	{+		.name		= "u-boot",+		.offset		= 0,+		.size		= 0x020000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "config",+		.offset		= 0x020000,+		.size		= 0x010000,+	} , {+		.name		= "kernel",+		.offset		= 0x030000,+		.size		= 0x0d0000,+	} , {+		.name		= "rootfs",+		.offset		= 0x100000,+		.size		= 0x2f0000,+	} , {+		.name		= "art",+		.offset		= 0x3f0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "firmware",+		.offset		= 0x030000,+		.size		= 0x3c0000,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data dir_615c1_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = dir_615c1_partitions,+        .nr_parts       = ARRAY_SIZE(dir_615c1_partitions),+#endif+};++static struct gpio_led dir_615c1_leds_gpio[] __initdata = {+	{+		.name		= "dir-615c1:orange:status",+		.gpio		= DIR_615C1_GPIO_LED_ORANGE_STATUS,+		.active_low	= 1,+	}, {+		.name		= "dir-615c1:blue:wps",+		.gpio		= DIR_615C1_GPIO_LED_BLUE_WPS,+		.active_low	= 1,+	}, {+		.name		= "dir-615c1:green:wan",+		.gpio		= DIR_615C1_GPIO_LED_GREEN_WAN,+		.active_low	= 1,+	}, {+		.name		= "dir-615c1:green:wancpu",+		.gpio		= DIR_615C1_GPIO_LED_GREEN_WANCPU,+		.active_low	= 1,+        }, {+		.name		= "dir-615c1:green:wlan",+		.gpio		= DIR_615C1_GPIO_LED_GREEN_WLAN,+		.active_low	= 1,+        }, {+		.name           = "dir-615c1:green:status",+		.gpio           = DIR_615C1_GPIO_LED_GREEN_STATUS,+		.active_low     = 1,+	}, {+		.name		= "dir-615c1:orange:wan",+		.gpio		= DIR_615C1_GPIO_LED_ORANGE_WAN,+		.active_low	= 1,+	}++};++static struct gpio_button dir_615c1_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= DIR_615C1_GPIO_BTN_RESET,+	}, {+		.desc		= "wps",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= DIR_615C1_GPIO_BTN_WPS,+	}+};++#define DIR_615C1_LAN_PHYMASK	BIT(0)+#define DIR_615C1_WAN_PHYMASK	BIT(4)+#define DIR_615C1_MDIO_MASK	(~(DIR_615C1_LAN_PHYMASK | \+				   DIR_615C1_WAN_PHYMASK))++static void __init dir_615c1_setup(void)+{+	const char *config = (char *) KSEG1ADDR(DIR_615C1_CONFIG_ADDR);+	u8 *eeprom = (u8 *) KSEG1ADDR(0x1fff1000);+	u8 mac[6];+	u8 *wlan_mac = NULL;++	if (nvram_parse_mac_addr(config, DIR_615C1_CONFIG_SIZE,+			         "lan_mac=", mac) == 0) {+		ar71xx_set_mac_base(mac);+		wlan_mac = mac;+	}++	ar71xx_add_device_mdio(DIR_615C1_MDIO_MASK);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth0_data.phy_mask = DIR_615C1_LAN_PHYMASK;++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.phy_mask = DIR_615C1_WAN_PHYMASK;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_add_device_m25p80(&dir_615c1_flash_data);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(dir_615c1_leds_gpio),+					dir_615c1_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, DIR_615C1_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(dir_615c1_gpio_buttons),+					dir_615c1_gpio_buttons);++	ar913x_add_device_wmac(eeprom, wlan_mac);+}++MIPS_MACHINE(AR71XX_MACH_DIR_615_C1, "DIR-615-C1", "D-Link DIR-615 rev. C1",+	     dir_615c1_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-dir-825-b1.c linux-2.6.37/arch/mips/ar71xx/mach-dir-825-b1.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-dir-825-b1.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-dir-825-b1.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,192 @@+/*+ *  D-Link DIR-825 rev. B1 board support+ *+ *  Copyright (C) 2009 Lukas Kuna, Evkanet, s.r.o.+ *+ *  based on mach-wndr3700.c+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/platform_device.h>+#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>+#include <linux/delay.h>+#include <linux/rtl8366s.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-ap94-pci.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"+#include "dev-usb.h"++#define DIR825B1_GPIO_LED_BLUE_USB		0+#define DIR825B1_GPIO_LED_ORANGE_POWER		1+#define DIR825B1_GPIO_LED_BLUE_POWER		2+#define DIR825B1_GPIO_LED_BLUE_POWERSAVE	4+#define DIR825B1_GPIO_LED_ORANGE_PLANET		6+#define DIR825B1_GPIO_LED_BLUE_PLANET		11++#define DIR825B1_GPIO_BTN_RESET			3+#define DIR825B1_GPIO_BTN_POWERSAVE		8++#define DIR825B1_GPIO_RTL8366_SDA		5+#define DIR825B1_GPIO_RTL8366_SCK		7++#define DIR825B1_BUTTONS_POLL_INTERVAL		20++#define DIR825B1_CAL_LOCATION_0			0x1f661000+#define DIR825B1_CAL_LOCATION_1			0x1f665000++#define DIR825B1_MAC_LOCATION_0			0x2ffa81b8+#define DIR825B1_MAC_LOCATION_1			0x2ffa8370++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition dir825b1_partitions[] = {+	{+		.name		= "uboot",+		.offset		= 0,+		.size		= 0x040000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "config",+		.offset		= 0x040000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "firmware",+		.offset		= 0x050000,+		.size		= 0x610000,+	} , {+		.name		= "caldata",+		.offset		= 0x660000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "unknown",+		.offset		= 0x670000,+		.size		= 0x190000,+		.mask_flags	= MTD_WRITEABLE,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data dir825b1_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = dir825b1_partitions,+        .nr_parts       = ARRAY_SIZE(dir825b1_partitions),+#endif+};++static struct gpio_led dir825b1_leds_gpio[] __initdata = {+	{+		.name		= "dir825b1:blue:usb",+		.gpio		= DIR825B1_GPIO_LED_BLUE_USB,+		.active_low	= 1,+	}, {+		.name		= "dir825b1:orange:power",+		.gpio		= DIR825B1_GPIO_LED_ORANGE_POWER,+		.active_low	= 1,+	}, {+		.name		= "dir825b1:blue:power",+		.gpio		= DIR825B1_GPIO_LED_BLUE_POWER,+		.active_low	= 1,+	}, {+		.name		= "dir825b1:blue:powersave",+		.gpio		= DIR825B1_GPIO_LED_BLUE_POWERSAVE,+		.active_low	= 1,+	}, {+		.name		= "dir825b1:orange:planet",+		.gpio		= DIR825B1_GPIO_LED_ORANGE_PLANET,+		.active_low	= 1,+	}, {+		.name		= "dir825b1:blue:planet",+		.gpio		= DIR825B1_GPIO_LED_BLUE_PLANET,+		.active_low	= 1,+	}+};++static struct gpio_button dir825b1_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= DIR825B1_GPIO_BTN_RESET,+		.active_low	= 1,+	} , {+		.desc		= "powersave",+		.type		= EV_KEY,+		.code		= BTN_1,+		.threshold	= 3,+		.gpio		= DIR825B1_GPIO_BTN_POWERSAVE,+		.active_low	= 1,+	}+};++static struct rtl8366s_platform_data dir825b1_rtl8366s_data = {+	.gpio_sda        = DIR825B1_GPIO_RTL8366_SDA,+	.gpio_sck        = DIR825B1_GPIO_RTL8366_SCK,+};++static struct platform_device dir825b1_rtl8366s_device = {+	.name		= RTL8366S_DRIVER_NAME,+	.id		= -1,+	.dev = {+		.platform_data	= &dir825b1_rtl8366s_data,+	}+};++static void __init dir825b1_setup(void)+{+        u8 mac[6], i;++	memcpy(mac, (u8*)KSEG1ADDR(DIR825B1_MAC_LOCATION_1), 6);+	for(i = 5; i >= 3; i--)+		if(++mac[i] != 0x00) break;++	ar71xx_set_mac_base(mac);++	ar71xx_add_device_mdio(0x0);++	ar71xx_eth0_data.mii_bus_dev = &dir825b1_rtl8366s_device.dev;+	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;+	ar71xx_eth0_data.speed = SPEED_1000;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;+	ar71xx_eth0_pll_data.pll_1000 = 0x11110000;++	ar71xx_eth1_data.mii_bus_dev = &dir825b1_rtl8366s_device.dev;+	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;+	ar71xx_eth1_data.phy_mask = 0x10;+	ar71xx_eth1_pll_data.pll_1000 = 0x11110000;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_add_device_m25p80(&dir825b1_flash_data);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(dir825b1_leds_gpio),+					dir825b1_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, DIR825B1_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(dir825b1_gpio_buttons),+					dir825b1_gpio_buttons);++	ar71xx_add_device_usb();++	platform_device_register(&dir825b1_rtl8366s_device);++	ap94_pci_init((u8 *) KSEG1ADDR(DIR825B1_CAL_LOCATION_0),+		      (u8 *) KSEG1ADDR(DIR825B1_MAC_LOCATION_0),+		      (u8 *) KSEG1ADDR(DIR825B1_CAL_LOCATION_1),+		      (u8 *) KSEG1ADDR(DIR825B1_MAC_LOCATION_1));+}++MIPS_MACHINE(AR71XX_MACH_DIR_825_B1, "DIR-825-B1", "D-Link DIR-825 rev. B1",+	     dir825b1_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-mzk-w04nu.c linux-2.6.37/arch/mips/ar71xx/mach-mzk-w04nu.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-mzk-w04nu.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-mzk-w04nu.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,165 @@+/*+ *  Planex MZK-W04NU board support+ *+ *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-ar913x-wmac.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"+#include "dev-m25p80.h"+#include "dev-usb.h"++#define MZK_W04NU_GPIO_LED_USB		0+#define MZK_W04NU_GPIO_LED_STATUS	1+#define MZK_W04NU_GPIO_LED_WPS		3+#define MZK_W04NU_GPIO_LED_WLAN		6+#define MZK_W04NU_GPIO_LED_AP		15+#define MZK_W04NU_GPIO_LED_ROUTER	16++#define MZK_W04NU_GPIO_BTN_APROUTER	5+#define MZK_W04NU_GPIO_BTN_WPS		12+#define MZK_W04NU_GPIO_BTN_RESET	21++#define MZK_W04NU_BUTTONS_POLL_INTERVAL	20++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition mzk_w04nu_partitions[] = {+	{+		.name		= "u-boot",+		.offset		= 0,+		.size		= 0x040000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "u-boot-env",+		.offset		= 0x040000,+		.size		= 0x010000,+	} , {+		.name		= "kernel",+		.offset		= 0x050000,+		.size		= 0x160000,+	} , {+		.name		= "rootfs",+		.offset		= 0x1b0000,+		.size		= 0x630000,+	} , {+		.name		= "art",+		.offset		= 0x7e0000,+		.size		= 0x020000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "firmware",+		.offset		= 0x050000,+		.size		= 0x790000,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data mzk_w04nu_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = mzk_w04nu_partitions,+        .nr_parts       = ARRAY_SIZE(mzk_w04nu_partitions),+#endif+};++static struct gpio_led mzk_w04nu_leds_gpio[] __initdata = {+	{+		.name		= "mzk-w04nu:green:status",+		.gpio		= MZK_W04NU_GPIO_LED_STATUS,+		.active_low	= 1,+	}, {+		.name		= "mzk-w04nu:blue:wps",+		.gpio		= MZK_W04NU_GPIO_LED_WPS,+		.active_low	= 1,+	}, {+		.name		= "mzk-w04nu:green:wlan",+		.gpio		= MZK_W04NU_GPIO_LED_WLAN,+		.active_low	= 1,+	}, {+		.name		= "mzk-w04nu:green:usb",+		.gpio		= MZK_W04NU_GPIO_LED_USB,+		.active_low	= 1,+	}, {+		.name		= "mzk-w04nu:green:ap",+		.gpio		= MZK_W04NU_GPIO_LED_AP,+		.active_low	= 1,+	}, {+		.name		= "mzk-w04nu:green:router",+		.gpio		= MZK_W04NU_GPIO_LED_ROUTER,+		.active_low	= 1,+	}+};++static struct gpio_button mzk_w04nu_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= MZK_W04NU_GPIO_BTN_RESET,+		.active_low	= 1,+	}, {+		.desc		= "wps",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= MZK_W04NU_GPIO_BTN_WPS,+		.active_low	= 1,+	}, {+		.desc		= "aprouter",+		.type		= EV_KEY,+		.code		= BTN_2,+		.threshold	= 3,+		.gpio		= MZK_W04NU_GPIO_BTN_APROUTER,+		.active_low	= 0,+	}+};++#define MZK_W04NU_WAN_PHYMASK	BIT(4)+#define MZK_W04NU_MDIO_MASK	(~MZK_W04NU_WAN_PHYMASK)++static void __init mzk_w04nu_setup(void)+{+	u8 *eeprom = (u8 *) KSEG1ADDR(0x1fff1000);++	ar71xx_set_mac_base(eeprom);++	ar71xx_add_device_mdio(MZK_W04NU_MDIO_MASK);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth0_data.speed = SPEED_100;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;+	ar71xx_eth0_data.has_ar8216 = 1;++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.phy_mask = MZK_W04NU_WAN_PHYMASK;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_add_device_m25p80(&mzk_w04nu_flash_data);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(mzk_w04nu_leds_gpio),+					mzk_w04nu_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, MZK_W04NU_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(mzk_w04nu_gpio_buttons),+					mzk_w04nu_gpio_buttons);+	ar71xx_add_device_usb();++	ar913x_add_device_wmac(eeprom, NULL);+}++MIPS_MACHINE(AR71XX_MACH_MZK_W04NU, "MZK-W04NU", "Planex MZK-W04NU",+	     mzk_w04nu_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-mzk-w300nh.c linux-2.6.37/arch/mips/ar71xx/mach-mzk-w300nh.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-mzk-w300nh.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-mzk-w300nh.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,158 @@+/*+ *  Planex MZK-W300NH board support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-ar913x-wmac.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"++#define MZK_W300NH_GPIO_LED_STATUS	1+#define MZK_W300NH_GPIO_LED_WPS		3+#define MZK_W300NH_GPIO_LED_WLAN	6+#define MZK_W300NH_GPIO_LED_AP		15+#define MZK_W300NH_GPIO_LED_ROUTER	16++#define MZK_W300NH_GPIO_BTN_APROUTER	5+#define MZK_W300NH_GPIO_BTN_WPS		12+#define MZK_W300NH_GPIO_BTN_RESET	21++#define MZK_W04NU_BUTTONS_POLL_INTERVAL	20++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition mzk_w300nh_partitions[] = {+	{+		.name		= "u-boot",+		.offset		= 0,+		.size		= 0x040000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "u-boot-env",+		.offset		= 0x040000,+		.size		= 0x010000,+	} , {+		.name		= "kernel",+		.offset		= 0x050000,+		.size		= 0x160000,+	} , {+		.name		= "rootfs",+		.offset		= 0x1b0000,+		.size		= 0x630000,+	} , {+		.name		= "art",+		.offset		= 0x7e0000,+		.size		= 0x020000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "firmware",+		.offset		= 0x050000,+		.size		= 0x790000,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data mzk_w300nh_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = mzk_w300nh_partitions,+        .nr_parts       = ARRAY_SIZE(mzk_w300nh_partitions),+#endif+};++static struct gpio_led mzk_w300nh_leds_gpio[] __initdata = {+	{+		.name		= "mzk-w300nh:green:status",+		.gpio		= MZK_W300NH_GPIO_LED_STATUS,+		.active_low	= 1,+	}, {+		.name		= "mzk-w300nh:blue:wps",+		.gpio		= MZK_W300NH_GPIO_LED_WPS,+		.active_low	= 1,+	}, {+		.name		= "mzk-w300nh:green:wlan",+		.gpio		= MZK_W300NH_GPIO_LED_WLAN,+		.active_low	= 1,+	}, {+		.name		= "mzk-w300nh:green:ap",+		.gpio		= MZK_W300NH_GPIO_LED_AP,+		.active_low	= 1,+	}, {+		.name		= "mzk-w300nh:green:router",+		.gpio		= MZK_W300NH_GPIO_LED_ROUTER,+		.active_low	= 1,+	}+};++static struct gpio_button mzk_w300nh_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= MZK_W300NH_GPIO_BTN_RESET,+		.active_low	= 1,+	}, {+		.desc		= "wps",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= MZK_W300NH_GPIO_BTN_WPS,+		.active_low	= 1,+	}, {+		.desc		= "aprouter",+		.type		= EV_KEY,+		.code		= BTN_2,+		.threshold	= 3,+		.gpio		= MZK_W300NH_GPIO_BTN_APROUTER,+		.active_low	= 0,+	}+};++#define MZK_W300NH_WAN_PHYMASK	BIT(4)+#define MZK_W300NH_MDIO_MASK	(~MZK_W300NH_WAN_PHYMASK)++static void __init mzk_w300nh_setup(void)+{+	u8 *eeprom = (u8 *) KSEG1ADDR(0x1fff1000);++	ar71xx_set_mac_base(eeprom);++	ar71xx_add_device_mdio(MZK_W300NH_MDIO_MASK);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth0_data.speed = SPEED_100;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;+	ar71xx_eth0_data.has_ar8216 = 1;++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.phy_mask = MZK_W300NH_WAN_PHYMASK;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_add_device_m25p80(&mzk_w300nh_flash_data);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(mzk_w300nh_leds_gpio),+				    mzk_w300nh_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, MZK_W04NU_BUTTONS_POLL_INTERVAL,+				       ARRAY_SIZE(mzk_w300nh_gpio_buttons),+				       mzk_w300nh_gpio_buttons);+	ar913x_add_device_wmac(eeprom, NULL);+}++MIPS_MACHINE(AR71XX_MACH_MZK_W300NH, "MZK-W300NH", "Planex MZK-W300NH",+	     mzk_w300nh_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-nbg460n.c linux-2.6.37/arch/mips/ar71xx/mach-nbg460n.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-nbg460n.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-nbg460n.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,222 @@+/*+ *  Zyxel NBG 460N/550N/550NH board support+ *+ *  Copyright (C) 2010 Michael Kurz <michi.kurz@googlemail.com>+ *+ *  based on mach-tl-wr1043nd.c+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/platform_device.h>+#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>+#include <linux/delay.h>+#include <linux/rtl8366s.h>++#include <linux/i2c.h>+#include <linux/i2c-algo-bit.h>+#include <linux/i2c-gpio.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-ar913x-wmac.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"++/* LEDs */+#define NBG460N_GPIO_LED_WPS		3+#define NBG460N_GPIO_LED_WAN		6+#define NBG460N_GPIO_LED_POWER		14+#define NBG460N_GPIO_LED_WLAN		15++/* Buttons */+#define NBG460N_GPIO_BTN_WPS		12+#define NBG460N_GPIO_BTN_RESET		21+#define NBG460N_BUTTONS_POLL_INTERVAL	20++/* RTC chip PCF8563 I2C interface */+#define NBG460N_GPIO_PCF8563_SDA	8+#define NBG460N_GPIO_PCF8563_SCK	7++/* Switch configuration I2C interface */+#define NBG460N_GPIO_RTL8366_SDA	16+#define NBG460N_GPIO_RTL8366_SCK	18++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition nbg460n_partitions[] = {+	{+		.name		= "Bootbase",+		.offset		= 0,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "U-Boot Config",+		.offset		= 0x010000,+		.size		= 0x030000,+	} , {+		.name		= "U-Boot",+		.offset		= 0x040000,+		.size		= 0x030000,+	} , {+		.name		= "linux",+		.offset		= 0x070000,+		.size		= 0x0e0000,+	} , {+		.name		= "rootfs",+		.offset		= 0x150000,+		.size		= 0x2a0000,+	} , {+		.name		= "CalibData",+		.offset		= 0x3f0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "firmware",+		.offset		= 0x070000,+		.size		= 0x380000,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data nbg460n_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = nbg460n_partitions,+        .nr_parts       = ARRAY_SIZE(nbg460n_partitions),+#endif+};++static struct gpio_led nbg460n_leds_gpio[] __initdata = {+	{+		.name		= "nbg460n:green:power",+		.gpio		= NBG460N_GPIO_LED_POWER,+		.active_low	= 0,+		.default_trigger = "default-on",+	}, {+		.name		= "nbg460n:green:wps",+		.gpio		= NBG460N_GPIO_LED_WPS,+		.active_low	= 0,+	}, {+		.name		= "nbg460n:green:wlan",+		.gpio		= NBG460N_GPIO_LED_WLAN,+		.active_low	= 0,+	}, {+		/* Not really for controlling the LED,+		   when set low the LED blinks uncontrollable  */+		.name		= "nbg460n:green:wan",+		.gpio		= NBG460N_GPIO_LED_WAN,+		.active_low	= 0,+	}+};++static struct gpio_button nbg460n_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= NBG460N_GPIO_BTN_RESET,+		.active_low	= 1,+	}, {+		.desc		= "wps",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= NBG460N_GPIO_BTN_WPS,+		.active_low	= 1,+	}+};++static struct i2c_gpio_platform_data nbg460n_i2c_device_platdata = {+	.sda_pin	= NBG460N_GPIO_PCF8563_SDA,+	.scl_pin	= NBG460N_GPIO_PCF8563_SCK,+	.udelay		= 10,+};++static struct platform_device nbg460n_i2c_device = {+	.name		= "i2c-gpio",+	.id		= -1,+	.num_resources	= 0,+	.resource	= NULL,+	.dev		= {+		.platform_data	= &nbg460n_i2c_device_platdata,+	},+};++static struct i2c_board_info nbg460n_i2c_devs[] __initdata = {+	{+		I2C_BOARD_INFO("pcf8563", 0x51),+	},+};++static void __devinit nbg460n_i2c_init(void)+{+	/* The gpio interface */+	platform_device_register(&nbg460n_i2c_device);+	/* I2C devices */+	i2c_register_board_info(0, nbg460n_i2c_devs,+				ARRAY_SIZE(nbg460n_i2c_devs));+}+++static struct rtl8366s_platform_data nbg460n_rtl8366s_data = {+	.gpio_sda        = NBG460N_GPIO_RTL8366_SDA,+	.gpio_sck        = NBG460N_GPIO_RTL8366_SCK,+};++static struct platform_device nbg460n_rtl8366s_device = {+	.name		= RTL8366S_DRIVER_NAME,+	.id		= -1,+	.dev = {+		.platform_data	= &nbg460n_rtl8366s_data,+	}+};++static void __init nbg460n_setup(void)+{+	/* end of bootloader sector contains mac address*/+	u8 *mac = (u8 *) KSEG1ADDR(0x1fc0fff8);+	/* last sector contains wlan calib data */+	u8 *eeprom = (u8 *) KSEG1ADDR(0x1fff1000);++	ar71xx_set_mac_base(mac);++	/* LAN Port */+	ar71xx_eth0_data.mii_bus_dev = &nbg460n_rtl8366s_device.dev;+	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;+	ar71xx_eth0_data.speed = SPEED_1000;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;++	/* WAN Port */+	ar71xx_eth1_data.mii_bus_dev = &nbg460n_rtl8366s_device.dev;+	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;+	ar71xx_eth1_data.phy_mask = 0x10;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	/* register the switch phy */+	platform_device_register(&nbg460n_rtl8366s_device);++	/* register flash */+	ar71xx_add_device_m25p80(&nbg460n_flash_data);++	ar913x_add_device_wmac(eeprom, mac);++	/* register RTC chip */+	nbg460n_i2c_init();++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(nbg460n_leds_gpio),+					nbg460n_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, NBG460N_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(nbg460n_gpio_buttons),+					nbg460n_gpio_buttons);+}++MIPS_MACHINE(AR71XX_MACH_NBG460N, "NBG460N", "Zyxel NBG460N/550N/550NH", nbg460n_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-pb42.c linux-2.6.37/arch/mips/ar71xx/mach-pb42.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-pb42.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-pb42.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,71 @@+/*+ *  Atheros PB42 board support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-gpio-buttons.h"+#include "dev-pb42-pci.h"+#include "dev-usb.h"++#define PB42_BUTTONS_POLL_INTERVAL	20++#define PB42_GPIO_BTN_SW4	8+#define PB42_GPIO_BTN_SW5	3++static struct gpio_button pb42_gpio_buttons[] __initdata = {+	{+		.desc		= "sw4",+		.type		= EV_KEY,+		.code		= BTN_0,+		.threshold	= 3,+		.gpio		= PB42_GPIO_BTN_SW4,+		.active_low	= 1,+	} , {+		.desc		= "sw5",+		.type		= EV_KEY,+		.code		= BTN_1,+		.threshold	= 3,+		.gpio		= PB42_GPIO_BTN_SW5,+		.active_low	= 1,+	}+};++#define PB42_WAN_PHYMASK	BIT(20)+#define PB42_LAN_PHYMASK	(BIT(16) | BIT(17) | BIT(18) | BIT(19))+#define PB42_MDIO_PHYMASK	(PB42_LAN_PHYMASK | PB42_WAN_PHYMASK)++static void __init pb42_init(void)+{+	ar71xx_add_device_m25p80(NULL);++	ar71xx_add_device_mdio(~PB42_MDIO_PHYMASK);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_MII;+	ar71xx_eth0_data.phy_mask = PB42_WAN_PHYMASK;++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.speed = SPEED_100;+	ar71xx_eth1_data.duplex = DUPLEX_FULL;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_add_device_gpio_buttons(-1, PB42_BUTTONS_POLL_INTERVAL,+				       ARRAY_SIZE(pb42_gpio_buttons),+				       pb42_gpio_buttons);++	pb42_pci_init();+}++MIPS_MACHINE(AR71XX_MACH_PB42, "PB42", "Atheros PB42", pb42_init);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-pb44.c linux-2.6.37/arch/mips/ar71xx/mach-pb44.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-pb44.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-pb44.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,207 @@+/*+ *  Atheros PB44 board support+ *+ *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/init.h>+#include <linux/bitops.h>+#include <linux/delay.h>+#include <linux/platform_device.h>+#include <linux/spi/spi.h>+#include <linux/spi/flash.h>+#include <linux/spi/vsc7385.h>+#include <linux/i2c.h>+#include <linux/i2c-gpio.h>+#include <linux/i2c/pcf857x.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-pb42-pci.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"+#include "dev-usb.h"++#define PB44_PCF8757_VSC7395_CS	0+#define PB44_PCF8757_STEREO_CS	1+#define PB44_PCF8757_SLIC_CS0	2+#define PB44_PCF8757_SLIC_TEST	3+#define PB44_PCF8757_SLIC_INT0	4+#define PB44_PCF8757_SLIC_INT1	5+#define PB44_PCF8757_SW_RESET	6+#define PB44_PCF8757_SW_JUMP	8+#define PB44_PCF8757_LED_JUMP1	9+#define PB44_PCF8757_LED_JUMP2	10+#define PB44_PCF8757_TP24	11+#define PB44_PCF8757_TP25	12+#define PB44_PCF8757_TP26	13+#define PB44_PCF8757_TP27	14+#define PB44_PCF8757_TP28	15++#define PB44_GPIO_I2C_SCL	0+#define PB44_GPIO_I2C_SDA	1++#define PB44_GPIO_EXP_BASE	16+#define PB44_GPIO_VSC7395_CS	(PB44_GPIO_EXP_BASE + PB44_PCF8757_VSC7395_CS)+#define PB44_GPIO_SW_RESET	(PB44_GPIO_EXP_BASE + PB44_PCF8757_SW_RESET)+#define PB44_GPIO_SW_JUMP	(PB44_GPIO_EXP_BASE + PB44_PCF8757_SW_JUMP)+#define PB44_GPIO_LED_JUMP1	(PB44_GPIO_EXP_BASE + PB44_PCF8757_LED_JUMP1)+#define PB44_GPIO_LED_JUMP2	(PB44_GPIO_EXP_BASE + PB44_PCF8757_LED_JUMP2)++static struct i2c_gpio_platform_data pb44_i2c_gpio_data = {+	.sda_pin        = PB44_GPIO_I2C_SDA,+	.scl_pin        = PB44_GPIO_I2C_SCL,+};++static struct platform_device pb44_i2c_gpio_device = {+	.name		= "i2c-gpio",+	.id		= 0,+	.dev = {+		.platform_data	= &pb44_i2c_gpio_data,+	}+};++static struct pcf857x_platform_data pb44_pcf857x_data = {+	.gpio_base	= PB44_GPIO_EXP_BASE,+};++static struct i2c_board_info pb44_i2c_board_info[] __initdata = {+	{+		I2C_BOARD_INFO("pcf8575", 0x20),+		.platform_data  = &pb44_pcf857x_data,+	},+};++static struct gpio_led pb44_leds_gpio[] __initdata = {+	{+		.name		= "pb44:amber:jump1",+		.gpio		= PB44_GPIO_LED_JUMP1,+		.active_low	= 1,+	}, {+		.name		= "pb44:green:jump2",+		.gpio		= PB44_GPIO_LED_JUMP2,+		.active_low	= 1,+	},+};++static struct gpio_button pb44_gpio_buttons[] __initdata = {+	{+		.desc		= "soft_reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= PB44_GPIO_SW_RESET,+		.active_low	= 1,+	} , {+		.desc		= "jumpstart",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= PB44_GPIO_SW_JUMP,+		.active_low	= 1,+	}+};++static void pb44_vsc7395_reset(void)+{+	ar71xx_device_stop(RESET_MODULE_GE1_PHY);+	udelay(10);+	ar71xx_device_start(RESET_MODULE_GE1_PHY);+	mdelay(50);+}++static struct vsc7385_platform_data pb44_vsc7395_data = {+	.reset		= pb44_vsc7395_reset,+	.ucode_name	= "vsc7395_ucode_pb44.bin",+	.mac_cfg = {+		.tx_ipg		= 6,+		.bit2		= 1,+		.clk_sel	= 0,+	},+};++static struct spi_board_info pb44_spi_info[] = {+	{+		.bus_num	= 0,+		.chip_select	= 0,+		.max_speed_hz	= 25000000,+		.modalias	= "m25p80",+	}, {+		.bus_num	= 0,+		.chip_select	= 1,+		.max_speed_hz	= 25000000,+		.modalias	= "spi-vsc7385",+		.platform_data	= &pb44_vsc7395_data,+		.controller_data = (void *) PB44_GPIO_VSC7395_CS,+	},+};++static struct resource pb44_spi_resources[] = {+	[0] = {+		.start	= AR71XX_SPI_BASE,+		.end	= AR71XX_SPI_BASE + AR71XX_SPI_SIZE - 1,+		.flags	= IORESOURCE_MEM,+	},+};++static struct ar71xx_spi_platform_data pb44_spi_data = {+	.bus_num		= 0,+	.num_chipselect		= 2,+};++static struct platform_device pb44_spi_device = {+	.name		= "pb44-spi",+	.id		= -1,+	.resource	= pb44_spi_resources,+	.num_resources	= ARRAY_SIZE(pb44_spi_resources),+	.dev = {+		.platform_data = &pb44_spi_data,+	},+};++#define PB44_WAN_PHYMASK	BIT(0)+#define PB44_LAN_PHYMASK	0+#define PB44_MDIO_PHYMASK	(PB44_LAN_PHYMASK | PB44_WAN_PHYMASK)++static void __init pb44_init(void)+{+	ar71xx_add_device_mdio(~PB44_MDIO_PHYMASK);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;+	ar71xx_eth0_data.phy_mask = PB44_WAN_PHYMASK;++	ar71xx_add_device_eth(0);++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;+	ar71xx_eth1_data.speed = SPEED_1000;+	ar71xx_eth1_data.duplex = DUPLEX_FULL;+	ar71xx_eth1_pll_data.pll_1000 = 0x110000;++	ar71xx_add_device_eth(1);++	ar71xx_add_device_usb();++	pb42_pci_init();++	i2c_register_board_info(0, pb44_i2c_board_info,+ 				ARRAY_SIZE(pb44_i2c_board_info));++	platform_device_register(&pb44_i2c_gpio_device);++	spi_register_board_info(pb44_spi_info, ARRAY_SIZE(pb44_spi_info));+	platform_device_register(&pb44_spi_device);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(pb44_leds_gpio),+				    pb44_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, 20, ARRAY_SIZE(pb44_gpio_buttons),+				       pb44_gpio_buttons);+}++MIPS_MACHINE(AR71XX_MACH_PB44, "PB44", "Atheros PB44", pb44_init);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-pb92.c linux-2.6.37/arch/mips/ar71xx/mach-pb92.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-pb92.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-pb92.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,109 @@+/*+ *  Atheros PB92 board support+ *+ *  Copyright (C) 2010 Felix Fietkau <nbd@openwrt.org>+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>+#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-gpio-buttons.h"+#include "dev-pb9x-pci.h"+#include "dev-usb.h"++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition pb92_partitions[] = {+	{+		.name		= "u-boot",+		.offset		= 0,+		.size		= 0x040000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "u-boot-env",+		.offset		= 0x040000,+		.size		= 0x010000,+	} , {+		.name		= "rootfs",+		.offset		= 0x050000,+		.size		= 0x2b0000,+	} , {+		.name		= "uImage",+		.offset		= 0x300000,+		.size		= 0x0e0000,+	} , {+		.name		= "ART",+		.offset		= 0x3e0000,+		.size		= 0x020000,+		.mask_flags	= MTD_WRITEABLE,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data pb92_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = pb92_partitions,+        .nr_parts       = ARRAY_SIZE(pb92_partitions),+#endif+};+++#define PB92_BUTTONS_POLL_INTERVAL	20++#define PB92_GPIO_BTN_SW4	8+#define PB92_GPIO_BTN_SW5	3++static struct gpio_button pb92_gpio_buttons[] __initdata = {+	{+		.desc		= "sw4",+		.type		= EV_KEY,+		.code		= BTN_0,+		.threshold	= 3,+		.gpio		= PB92_GPIO_BTN_SW4,+		.active_low	= 1,+	} , {+		.desc		= "sw5",+		.type		= EV_KEY,+		.code		= BTN_1,+		.threshold	= 3,+		.gpio		= PB92_GPIO_BTN_SW5,+		.active_low	= 1,+	}+};++static void __init pb92_init(void)+{+	u8 *mac = (u8 *) KSEG1ADDR(0x1fff0000);++	ar71xx_set_mac_base(mac);+	ar71xx_add_device_m25p80(&pb92_flash_data);++	ar71xx_add_device_mdio(~0);+	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth0_data.speed = SPEED_1000;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.speed = SPEED_1000;+	ar71xx_eth1_data.duplex = DUPLEX_FULL;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_add_device_gpio_buttons(-1, PB92_BUTTONS_POLL_INTERVAL,+				       ARRAY_SIZE(pb92_gpio_buttons),+				       pb92_gpio_buttons);++	pb9x_pci_init();+}++MIPS_MACHINE(AR71XX_MACH_PB92, "PB92", "Atheros PB92", pb92_init);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-rb4xx.c linux-2.6.37/arch/mips/ar71xx/mach-rb4xx.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-rb4xx.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-rb4xx.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,290 @@+/*+ *  MikroTik RouterBOARD 4xx series support+ *+ *  Copyright (C) 2008 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/platform_device.h>+#include <linux/irq.h>+#include <linux/mmc/host.h>+#include <linux/spi/spi.h>+#include <linux/spi/flash.h>+#include <linux/spi/mmc_spi.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/pci.h>++#include "machtype.h"+#include "devices.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"+#include "dev-usb.h"++#define RB4XX_GPIO_USER_LED	4+#define RB4XX_GPIO_RESET_SWITCH	7++#define RB4XX_BUTTONS_POLL_INTERVAL	20++static struct gpio_led rb4xx_leds_gpio[] __initdata = {+	{+		.name		= "rb4xx:yellow:user",+		.gpio		= RB4XX_GPIO_USER_LED,+		.active_low	= 0,+	},+};++static struct gpio_button rb4xx_gpio_buttons[] __initdata = {+	{+		.desc		= "reset_switch",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= RB4XX_GPIO_RESET_SWITCH,+		.active_low	= 1,+	}+};++static struct platform_device rb4xx_nand_device = {+	.name	= "rb4xx-nand",+	.id	= -1,+};++static struct ar71xx_pci_irq rb4xx_pci_irqs[] __initdata = {+	{+		.slot	= 0,+		.pin	= 1,+		.irq	= AR71XX_PCI_IRQ_DEV2,+	}, {+		.slot	= 1,+		.pin	= 1,+		.irq	= AR71XX_PCI_IRQ_DEV0,+	}, {+		.slot	= 1,+		.pin	= 2,+		.irq	= AR71XX_PCI_IRQ_DEV1,+	}, {+		.slot	= 2,+		.pin	= 1,+		.irq	= AR71XX_PCI_IRQ_DEV1,+	}, {+		.slot	= 3,+		.pin	= 1,+		.irq	= AR71XX_PCI_IRQ_DEV2,+	}+};++#if 0+/*+ * SPI device support is experimental+ */+static struct flash_platform_data rb4xx_flash_data = {+	.type	= "pm25lv512",+};++static struct spi_board_info rb4xx_spi_info[] = {+	{+		.bus_num	= 0,+		.chip_select	= 0,+		.max_speed_hz	= 25000000,+		.modalias	= "m25p80",+		.platform_data	= &rb4xx_flash_data,+	}+};++static struct mmc_spi_platform_data rb433_mmc_data = {+	.ocr_mask	= MMC_VDD_32_33 | MMC_VDD_33_34,+};++static struct spi_board_info rb433_spi_info[] = {+	{+		.bus_num	= 0,+		.chip_select	= 0,+		.max_speed_hz	= 25000000,+		.modalias	= "m25p80",+		.platform_data	= &rb433_flash_data,+	}, {+		.bus_num	= 0,+		.chip_select	= 2,+		.max_speed_hz	= 25000000,+		.modalias	= "mmc_spi",+		.platform_data	= &rb433_mmc_data,+	}+};++static u32 rb433_spi_get_ioc_base(u8 chip_select, int cs_high, int is_on)+{+	u32 ret;++	if (is_on == AR71XX_SPI_CS_INACTIVE) {+		ret = SPI_IOC_CS0 | SPI_IOC_CS1;+	} else {+		if (cs_high) {+			ret = SPI_IOC_CS0 | SPI_IOC_CS1;+		} else {+			if ((chip_select ^ 2) == 0)+				ret = SPI_IOC_CS1 ^ (SPI_IOC_CS0 | SPI_IOC_CS1);+			else+				ret = SPI_IOC_CS0 ^ (SPI_IOC_CS0 | SPI_IOC_CS1);+		}+	}++	return ret;+}++struct ar71xx_spi_platform_data rb433_spi_data = {+	.bus_num		= 0,+	.num_chipselect		= 3,+	.get_ioc_base		= rb433_spi_get_ioc_base,+};++static void rb4xx_add_device_spi(void)+{+	ar71xx_add_device_spi(NULL, rb4xx_spi_info, ARRAY_SIZE(rb4xx_spi_info));+}++static void rb433_add_device_spi(void)+{+	ar71xx_add_device_spi(&rb433_spi_data, rb433_spi_info,+				ARRAY_SIZE(rb433_spi_info));+}+#else+static inline void rb4xx_add_device_spi(void) {}+static inline void rb433_add_device_spi(void) {}+#endif++static void __init rb4xx_generic_setup(void)+{+	ar71xx_gpio_function_enable(AR71XX_GPIO_FUNC_SPI_CS1_EN |+				    AR71XX_GPIO_FUNC_SPI_CS2_EN);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(rb4xx_leds_gpio),+					rb4xx_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, RB4XX_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(rb4xx_gpio_buttons),+					rb4xx_gpio_buttons);++	platform_device_register(&rb4xx_nand_device);+}++static void __init rb411_setup(void)+{+	rb4xx_generic_setup();+	rb4xx_add_device_spi();++	ar71xx_add_device_mdio(0xfffffffc);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_MII;+	ar71xx_eth0_data.phy_mask = 0x00000003;++	ar71xx_add_device_eth(0);++	ar71xx_pci_init(ARRAY_SIZE(rb4xx_pci_irqs), rb4xx_pci_irqs);+}++MIPS_MACHINE(AR71XX_MACH_RB_411, "411", "MikroTik RouterBOARD 411/A/AH",+	     rb411_setup);++static void __init rb411u_setup(void)+{+	rb411_setup();+	ar71xx_add_device_usb();+}++MIPS_MACHINE(AR71XX_MACH_RB_411U, "411U", "MikroTik RouterBOARD 411U",+	     rb411u_setup);++static void __init rb433_setup(void)+{+	rb4xx_generic_setup();+	rb433_add_device_spi();++	ar71xx_add_device_mdio(0xffffffe9);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_MII;+	ar71xx_eth0_data.speed = SPEED_100;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.phy_mask = 0x00000010;++	ar71xx_add_device_eth(1);+	ar71xx_add_device_eth(0);++	ar71xx_pci_init(ARRAY_SIZE(rb4xx_pci_irqs), rb4xx_pci_irqs);+}++MIPS_MACHINE(AR71XX_MACH_RB_433, "433", "MikroTik RouterBOARD 433/AH",+	     rb433_setup);++static void __init rb433u_setup(void)+{+	rb433_setup();+	ar71xx_add_device_usb();+}++MIPS_MACHINE(AR71XX_MACH_RB_433U, "433U", "MikroTik RouterBOARD 433UAH",+	     rb433u_setup);++static void __init rb450_generic_setup(int gige)+{+	rb4xx_generic_setup();+	rb4xx_add_device_spi();++	ar71xx_add_device_mdio(0xffffffe0);++	ar71xx_eth0_data.phy_if_mode = (gige) ? PHY_INTERFACE_MODE_RGMII : PHY_INTERFACE_MODE_MII;+	ar71xx_eth0_data.phy_mask = (gige) ? (1 << 0) : 0;+	ar71xx_eth0_data.speed = (gige) ? SPEED_1000 : SPEED_100;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;++	ar71xx_eth1_data.phy_if_mode = (gige) ? PHY_INTERFACE_MODE_RGMII : PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.phy_mask = 0x00000010;++	ar71xx_add_device_eth(1);+	ar71xx_add_device_eth(0);+}++static void __init rb450_setup(void)+{+	rb450_generic_setup(0);+}++MIPS_MACHINE(AR71XX_MACH_RB_450, "450", "MikroTik RouterBOARD 450",+	     rb450_setup);++static void __init rb450g_setup(void)+{+	rb450_generic_setup(1);+}++MIPS_MACHINE(AR71XX_MACH_RB_450G, "450G", "MikroTik RouterBOARD 450G",+	     rb450g_setup);++static void __init rb493_setup(void)+{+	rb4xx_generic_setup();+	rb4xx_add_device_spi();++	ar71xx_add_device_mdio(0x3fffff00);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_MII;+	ar71xx_eth0_data.speed = SPEED_100;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.phy_mask = 0x00000001;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_pci_init(ARRAY_SIZE(rb4xx_pci_irqs), rb4xx_pci_irqs);+}++MIPS_MACHINE(AR71XX_MACH_RB_493, "493", "MikroTik RouterBOARD 493/AH",+	     rb493_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-rb750.c linux-2.6.37/arch/mips/ar71xx/mach-rb750.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-rb750.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-rb750.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,133 @@+/*+ *  MikroTik RouterBOARD 750 support+ *+ *  Copyright (C) 2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/platform_device.h>+#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/mach-rb750.h>++#include "machtype.h"+#include "dev-ap91-eth.h"++static struct rb750_led_data rb750_leds[] = {+	{+		.name		= "rb750:green:act",+		.mask		= RB750_LED_ACT,+		.active_low	= 1,+	}, {+		.name		= "rb750:green:port1",+		.mask		= RB750_LED_PORT5,+		.active_low	= 1,+	}, {+		.name		= "rb750:green:port2",+		.mask		= RB750_LED_PORT4,+		.active_low	= 1,+	}, {+		.name		= "rb750:green:port3",+		.mask		= RB750_LED_PORT3,+		.active_low	= 1,+	}, {+		.name		= "rb750:green:port4",+		.mask		= RB750_LED_PORT2,+		.active_low	= 1,+	}, {+		.name		= "rb750:green:port5",+		.mask		= RB750_LED_PORT1,+		.active_low	= 1,+	}+};++static struct rb750_led_platform_data rb750_leds_data = {+	.num_leds	= ARRAY_SIZE(rb750_leds),+	.leds		= rb750_leds,+};++static struct platform_device rb750_leds_device = {+	.name	= "leds-rb750",+	.dev	= {+		.platform_data = &rb750_leds_data,+	}+};++static const char *rb750_port_names[AP91_ETH_NUM_PORT_NAMES] __initdata = {+	"port5",+	"port4",+	"port3",+	"port2",+};++static struct platform_device rb750_nand_device = {+	.name	= "rb750-nand",+	.id	= -1,+};++int rb750_latch_change(u32 mask_clr, u32 mask_set)+{+	static DEFINE_SPINLOCK(lock);+	static u32 latch_set = RB750_LED_BITS | RB750_LVC573_LE;+	static u32 latch_oe;+	static u32 latch_clr;+	unsigned long flags;+	u32 t;+	int ret = 0;++	spin_lock_irqsave(&lock, flags);++	if ((mask_clr & BIT(31)) != 0 &&+	    (latch_set & RB750_LVC573_LE) == 0) {+		goto unlock;+	}++	latch_set = (latch_set | mask_set) & ~mask_clr;+	latch_clr = (latch_clr | mask_clr) & ~mask_set;++	if (latch_oe == 0)+		latch_oe = __raw_readl(ar71xx_gpio_base + GPIO_REG_OE);++	if (likely(latch_set & RB750_LVC573_LE)) {+		void __iomem *base = ar71xx_gpio_base;++		t = __raw_readl(base + GPIO_REG_OE);+		t |= mask_clr | latch_oe | mask_set;++		__raw_writel(t, base + GPIO_REG_OE);+		__raw_writel(latch_clr, base + GPIO_REG_CLEAR);+		__raw_writel(latch_set, base + GPIO_REG_SET);+	} else if (mask_clr & RB750_LVC573_LE) {+		void __iomem *base = ar71xx_gpio_base;++		latch_oe = __raw_readl(base + GPIO_REG_OE);+		__raw_writel(RB750_LVC573_LE, base + GPIO_REG_CLEAR);+		/* flush write */+		__raw_readl(base + GPIO_REG_CLEAR);+	}++	ret = 1;++ unlock:+	spin_unlock_irqrestore(&lock, flags);+	return ret;+}+EXPORT_SYMBOL_GPL(rb750_latch_change);++static void __init rb750_setup(void)+{+	ar71xx_gpio_function_disable(AR724X_GPIO_FUNC_ETH_SWITCH_LED0_EN |+				     AR724X_GPIO_FUNC_ETH_SWITCH_LED1_EN |+				     AR724X_GPIO_FUNC_ETH_SWITCH_LED2_EN |+				     AR724X_GPIO_FUNC_ETH_SWITCH_LED3_EN |+				     AR724X_GPIO_FUNC_ETH_SWITCH_LED4_EN);++	ap91_eth_init(NULL, rb750_port_names);+	platform_device_register(&rb750_leds_device);+	platform_device_register(&rb750_nand_device);+}++MIPS_MACHINE(AR71XX_MACH_RB_750, "750i", "MikroTik RouterBOARD 750",+	     rb750_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-tew-632brp.c linux-2.6.37/arch/mips/ar71xx/mach-tew-632brp.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-tew-632brp.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-tew-632brp.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,149 @@+/*+ *  TrendNET TEW-632BRP board support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-ar913x-wmac.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"+#include "nvram.h"++#define TEW_632BRP_GPIO_LED_STATUS	1+#define TEW_632BRP_GPIO_LED_WPS		3+#define TEW_632BRP_GPIO_LED_WLAN	6+#define TEW_632BRP_GPIO_BTN_WPS		12+#define TEW_632BRP_GPIO_BTN_RESET	21++#define TEW_632BRP_BUTTONS_POLL_INTERVAL	20++#define TEW_632BRP_CONFIG_ADDR	0x1f020000+#define TEW_632BRP_CONFIG_SIZE	0x10000++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition tew_632brp_partitions[] = {+	{+		.name		= "u-boot",+		.offset		= 0,+		.size		= 0x020000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "config",+		.offset		= 0x020000,+		.size		= 0x010000,+	} , {+		.name		= "kernel",+		.offset		= 0x030000,+		.size		= 0x0d0000,+	} , {+		.name		= "rootfs",+		.offset		= 0x100000,+		.size		= 0x2f0000,+	} , {+		.name		= "art",+		.offset		= 0x3f0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "firmware",+		.offset		= 0x030000,+		.size		= 0x3c0000,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data tew_632brp_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = tew_632brp_partitions,+        .nr_parts       = ARRAY_SIZE(tew_632brp_partitions),+#endif+};++static struct gpio_led tew_632brp_leds_gpio[] __initdata = {+	{+		.name		= "tew-632brp:green:status",+		.gpio		= TEW_632BRP_GPIO_LED_STATUS,+		.active_low	= 1,+	}, {+		.name		= "tew-632brp:blue:wps",+		.gpio		= TEW_632BRP_GPIO_LED_WPS,+		.active_low	= 1,+	}, {+		.name		= "tew-632brp:green:wlan",+		.gpio		= TEW_632BRP_GPIO_LED_WLAN,+		.active_low	= 1,+	}+};++static struct gpio_button tew_632brp_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= TEW_632BRP_GPIO_BTN_RESET,+	}, {+		.desc		= "wps",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= TEW_632BRP_GPIO_BTN_WPS,+	}+};++#define TEW_632BRP_LAN_PHYMASK	BIT(0)+#define TEW_632BRP_WAN_PHYMASK	BIT(4)+#define TEW_632BRP_MDIO_MASK	(~(TEW_632BRP_LAN_PHYMASK | \+				   TEW_632BRP_WAN_PHYMASK))++static void __init tew_632brp_setup(void)+{+	const char *config = (char *) KSEG1ADDR(TEW_632BRP_CONFIG_ADDR);+	u8 *eeprom = (u8 *) KSEG1ADDR(0x1fff1000);+	u8 mac[6];+	u8 *wlan_mac = NULL;++	if (nvram_parse_mac_addr(config, TEW_632BRP_CONFIG_SIZE,+			         "lan_mac=", mac) == 0) {+		ar71xx_set_mac_base(mac);+		wlan_mac = mac;+	}++	ar71xx_add_device_mdio(TEW_632BRP_MDIO_MASK);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth0_data.phy_mask = TEW_632BRP_LAN_PHYMASK;++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.phy_mask = TEW_632BRP_WAN_PHYMASK;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_add_device_m25p80(&tew_632brp_flash_data);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(tew_632brp_leds_gpio),+					tew_632brp_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, TEW_632BRP_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(tew_632brp_gpio_buttons),+					tew_632brp_gpio_buttons);++	ar913x_add_device_wmac(eeprom, wlan_mac);+}++MIPS_MACHINE(AR71XX_MACH_TEW_632BRP, "TEW-632BRP", "TRENDnet TEW-632BRP",+	     tew_632brp_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-tl-wr1043nd.c linux-2.6.37/arch/mips/ar71xx/mach-tl-wr1043nd.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-tl-wr1043nd.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-tl-wr1043nd.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,156 @@+/*+ *  TP-LINK TL-WR1043ND board support+ *+ *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>+#include <linux/platform_device.h>+#include <linux/rtl8366rb.h>+#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-ar913x-wmac.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"+#include "dev-usb.h"++#define TL_WR1043ND_GPIO_LED_USB        1+#define TL_WR1043ND_GPIO_LED_SYSTEM     2+#define TL_WR1043ND_GPIO_LED_QSS        5+#define TL_WR1043ND_GPIO_LED_WLAN       9++#define TL_WR1043ND_GPIO_BTN_RESET      3+#define TL_WR1043ND_GPIO_BTN_QSS        7++#define TL_WR1043ND_GPIO_RTL8366_SDA	18+#define TL_WR1043ND_GPIO_RTL8366_SCK	19++#define TL_WR1043ND_BUTTONS_POLL_INTERVAL     20++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition tl_wr1043nd_partitions[] = {+	{+		.name		= "u-boot",+		.offset		= 0,+		.size		= 0x020000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "kernel",+		.offset		= 0x020000,+		.size		= 0x140000,+	} , {+		.name		= "rootfs",+		.offset		= 0x160000,+		.size		= 0x690000,+	} , {+		.name		= "art",+		.offset		= 0x7f0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "firmware",+		.offset		= 0x020000,+		.size		= 0x7d0000,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data tl_wr1043nd_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+	.parts		= tl_wr1043nd_partitions,+	.nr_parts	= ARRAY_SIZE(tl_wr1043nd_partitions),+#endif+};++static struct gpio_led tl_wr1043nd_leds_gpio[] __initdata = {+	{+		.name		= "tl-wr1043nd:green:usb",+		.gpio		= TL_WR1043ND_GPIO_LED_USB,+		.active_low	= 1,+	}, {+		.name		= "tl-wr1043nd:green:system",+		.gpio		= TL_WR1043ND_GPIO_LED_SYSTEM,+		.active_low	= 1,+	}, {+		.name		= "tl-wr1043nd:green:qss",+		.gpio		= TL_WR1043ND_GPIO_LED_QSS,+		.active_low	= 0,+	}, {+		.name		= "tl-wr1043nd:green:wlan",+		.gpio		= TL_WR1043ND_GPIO_LED_WLAN,+		.active_low	= 1,+	}+};++static struct gpio_button tl_wr1043nd_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= TL_WR1043ND_GPIO_BTN_RESET,+		.active_low	= 1,+	}, {+		.desc		= "qss",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= TL_WR1043ND_GPIO_BTN_QSS,+		.active_low	= 1,+	}+};++static struct rtl8366rb_platform_data tl_wr1043nd_rtl8366rb_data = {+	.gpio_sda        = TL_WR1043ND_GPIO_RTL8366_SDA,+	.gpio_sck        = TL_WR1043ND_GPIO_RTL8366_SCK,+};++static struct platform_device tl_wr1043nd_rtl8366rb_device = {+	.name		= RTL8366RB_DRIVER_NAME,+	.id		= -1,+	.dev = {+		.platform_data	= &tl_wr1043nd_rtl8366rb_data,+	}+};++static void __init tl_wr1043nd_setup(void)+{+	u8 *mac = (u8 *) KSEG1ADDR(0x1f01fc00);+	u8 *eeprom = (u8 *) KSEG1ADDR(0x1fff1000);++	ar71xx_set_mac_base(mac);++	ar71xx_eth0_data.mii_bus_dev = &tl_wr1043nd_rtl8366rb_device.dev;+	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;+	ar71xx_eth0_data.speed = SPEED_1000;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;+	ar71xx_eth0_pll_data.pll_1000 = 0x1a000000;++	ar71xx_add_device_eth(0);++	ar71xx_add_device_usb();++	ar71xx_add_device_m25p80(&tl_wr1043nd_flash_data);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(tl_wr1043nd_leds_gpio),+					tl_wr1043nd_leds_gpio);++	platform_device_register(&tl_wr1043nd_rtl8366rb_device);++	ar71xx_add_device_gpio_buttons(-1, TL_WR1043ND_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(tl_wr1043nd_gpio_buttons),+					tl_wr1043nd_gpio_buttons);++	ar913x_add_device_wmac(eeprom, mac);+}++MIPS_MACHINE(AR71XX_MACH_TL_WR1043ND, "TL-WR1043ND", "TP-LINK TL-WR1043ND",+	     tl_wr1043nd_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-tl-wr741nd.c linux-2.6.37/arch/mips/ar71xx/mach-tl-wr741nd.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-tl-wr741nd.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-tl-wr741nd.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,115 @@+/*+ *  TP-LINK TL-WR741ND board support+ *+ *  Copyright (C) 2009-2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-ap91-eth.h"+#include "dev-ap91-pci.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"++#define TL_WR741ND_GPIO_LED_QSS		0+#define TL_WR741ND_GPIO_LED_SYSTEM	1++#define TL_WR741ND_GPIO_BTN_RESET	11+#define TL_WR741ND_GPIO_BTN_QSS		12++#define TL_WR741ND_BUTTONS_POLL_INTERVAL	20++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition tl_wr741nd_partitions[] = {+	{+		.name		= "u-boot",+		.offset		= 0,+		.size		= 0x020000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "kernel",+		.offset		= 0x020000,+		.size		= 0x140000,+	} , {+		.name		= "rootfs",+		.offset		= 0x160000,+		.size		= 0x290000,+	} , {+		.name		= "art",+		.offset		= 0x3f0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "firmware",+		.offset		= 0x020000,+		.size		= 0x3d0000,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data tl_wr741nd_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = tl_wr741nd_partitions,+        .nr_parts       = ARRAY_SIZE(tl_wr741nd_partitions),+#endif+};++static struct gpio_led tl_wr741nd_leds_gpio[] __initdata = {+	{+		.name		= "tl-wr741nd:green:system",+		.gpio		= TL_WR741ND_GPIO_LED_SYSTEM,+		.active_low	= 1,+	}, {+		.name		= "tl-wr741nd:green:qss",+		.gpio		= TL_WR741ND_GPIO_LED_QSS,+		.active_low	= 1,+	}+};++static struct gpio_button tl_wr741nd_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= TL_WR741ND_GPIO_BTN_RESET,+		.active_low	= 1,+	}, {+		.desc		= "qss",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= TL_WR741ND_GPIO_BTN_QSS,+		.active_low	= 1,+	}+};++static void __init tl_wr741nd_setup(void)+{+	u8 *mac = (u8 *) KSEG1ADDR(0x1f01fc00);+	u8 *ee = (u8 *) KSEG1ADDR(0x1fff1000);++	ar71xx_add_device_m25p80(&tl_wr741nd_flash_data);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(tl_wr741nd_leds_gpio),+					tl_wr741nd_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, TL_WR741ND_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(tl_wr741nd_gpio_buttons),+					tl_wr741nd_gpio_buttons);++	ap91_eth_init(mac, NULL);+	ap91_pci_init(ee, mac);+}+MIPS_MACHINE(AR71XX_MACH_TL_WR741ND, "TL-WR741ND", "TP-LINK TL-WR741ND",+	     tl_wr741nd_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-tl-wr841n.c linux-2.6.37/arch/mips/ar71xx/mach-tl-wr841n.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-tl-wr841n.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-tl-wr841n.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,143 @@+/*+ *  TP-LINK TL-WR841N board support+ *+ *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-dsa.h"+#include "dev-m25p80.h"+#include "dev-gpio-buttons.h"+#include "dev-pb42-pci.h"+#include "dev-leds-gpio.h"++#define TL_WR841ND_V1_GPIO_LED_SYSTEM		2+#define TL_WR841ND_V1_GPIO_LED_QSS_GREEN	4+#define TL_WR841ND_V1_GPIO_LED_QSS_RED		5++#define TL_WR841ND_V1_GPIO_BTN_RESET	3+#define TL_WR841ND_V1_GPIO_BTN_QSS	7++#define TL_WR841ND_V1_BUTTONS_POLL_INTERVAL	20++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition tl_wr841n_v1_partitions[] = {+	{+		.name		= "redboot",+		.offset		= 0,+		.size		= 0x020000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "kernel",+		.offset		= 0x020000,+		.size		= 0x140000,+	} , {+		.name		= "rootfs",+		.offset		= 0x160000,+		.size		= 0x280000,+	} , {+		.name		= "config",+		.offset		= 0x3e0000,+		.size		= 0x020000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "firmware",+		.offset		= 0x020000,+		.size		= 0x3c0000,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data tl_wr841n_v1_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = tl_wr841n_v1_partitions,+        .nr_parts       = ARRAY_SIZE(tl_wr841n_v1_partitions),+#endif+};++static struct gpio_led tl_wr841n_v1_leds_gpio[] __initdata = {+	{+		.name		= "tl-wr841n:green:system",+		.gpio		= TL_WR841ND_V1_GPIO_LED_SYSTEM,+		.active_low	= 1,+	}, {+		.name		= "tl-wr841n:red:qss",+		.gpio		= TL_WR841ND_V1_GPIO_LED_QSS_RED,+	}, {+		.name		= "tl-wr841n:green:qss",+		.gpio		= TL_WR841ND_V1_GPIO_LED_QSS_GREEN,+	}+};++static struct gpio_button tl_wr841n_v1_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= TL_WR841ND_V1_GPIO_BTN_RESET,+		.active_low	= 1,+	}, {+		.desc		= "qss",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= TL_WR841ND_V1_GPIO_BTN_QSS,+		.active_low	= 1,+	}+};++static struct dsa_chip_data tl_wr841n_v1_dsa_chip = {+	.port_names[0]  = "wan",+	.port_names[1]  = "lan1",+	.port_names[2]  = "lan2",+	.port_names[3]  = "lan3",+	.port_names[4]  = "lan4",+	.port_names[5]  = "cpu",+};++static struct dsa_platform_data tl_wr841n_v1_dsa_data = {+	.nr_chips	= 1,+	.chip		= &tl_wr841n_v1_dsa_chip,+};++static void __init tl_wr841n_v1_setup(void)+{+	u8 *mac = (u8 *) KSEG1ADDR(0x1f01fc00);++	ar71xx_set_mac_base(mac);++	ar71xx_add_device_mdio(0x0);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth0_data.speed = SPEED_100;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;++	ar71xx_add_device_eth(0);++	ar71xx_add_device_dsa(0, &tl_wr841n_v1_dsa_data);++	ar71xx_add_device_m25p80(&tl_wr841n_v1_flash_data);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(tl_wr841n_v1_leds_gpio),+					tl_wr841n_v1_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, TL_WR841ND_V1_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(tl_wr841n_v1_gpio_buttons),+					tl_wr841n_v1_gpio_buttons);++	pb42_pci_init();+}++MIPS_MACHINE(AR71XX_MACH_TL_WR841N_V1, "TL-WR841N-v1.5", "TP-LINK TL-WR841N v1",+	     tl_wr841n_v1_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-tl-wr941nd.c linux-2.6.37/arch/mips/ar71xx/mach-tl-wr941nd.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-tl-wr941nd.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-tl-wr941nd.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,142 @@+/*+ *  TP-LINK TL-WR941ND board support+ *+ *  Copyright (C) 2009-2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-dsa.h"+#include "dev-m25p80.h"+#include "dev-ar913x-wmac.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"++#define TL_WR941ND_GPIO_LED_SYSTEM	2+#define TL_WR941ND_GPIO_LED_QSS_RED	4+#define TL_WR941ND_GPIO_LED_QSS_GREEN	5++#define TL_WR941ND_GPIO_BTN_RESET	3+#define TL_WR941ND_GPIO_BTN_QSS		7++#define TL_WR941ND_BUTTONS_POLL_INTERVAL	20++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition tl_wr941nd_partitions[] = {+	{+		.name		= "u-boot",+		.offset		= 0,+		.size		= 0x020000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "kernel",+		.offset		= 0x020000,+		.size		= 0x140000,+	} , {+		.name		= "rootfs",+		.offset		= 0x160000,+		.size		= 0x290000,+	} , {+		.name		= "art",+		.offset		= 0x3f0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "firmware",+		.offset		= 0x020000,+		.size		= 0x3d0000,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data tl_wr941nd_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = tl_wr941nd_partitions,+        .nr_parts       = ARRAY_SIZE(tl_wr941nd_partitions),+#endif+};++static struct gpio_led tl_wr941nd_leds_gpio[] __initdata = {+	{+		.name		= "tl-wr941nd:green:system",+		.gpio		= TL_WR941ND_GPIO_LED_SYSTEM,+		.active_low	= 1,+	}, {+		.name		= "tl-wr941nd:red:qss",+		.gpio		= TL_WR941ND_GPIO_LED_QSS_RED,+	}, {+		.name		= "tl-wr941nd:green:qss",+		.gpio		= TL_WR941ND_GPIO_LED_QSS_GREEN,+	}+};++static struct gpio_button tl_wr941nd_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= TL_WR941ND_GPIO_BTN_RESET,+		.active_low	= 1,+	}, {+		.desc		= "qss",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= TL_WR941ND_GPIO_BTN_QSS,+		.active_low	= 1,+	}+};++static struct dsa_chip_data tl_wr941nd_dsa_chip = {+	.port_names[0]  = "wan",+	.port_names[1]  = "lan1",+	.port_names[2]  = "lan2",+	.port_names[3]  = "lan3",+	.port_names[4]  = "lan4",+	.port_names[5]  = "cpu",+};++static struct dsa_platform_data tl_wr941nd_dsa_data = {+	.nr_chips	= 1,+	.chip		= &tl_wr941nd_dsa_chip,+};++static void __init tl_wr941nd_setup(void)+{+	u8 *mac = (u8 *) KSEG1ADDR(0x1f01fc00);+	u8 *eeprom = (u8 *) KSEG1ADDR(0x1fff1000);++	ar71xx_set_mac_base(mac);++	ar71xx_add_device_mdio(0x0);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth0_data.speed = SPEED_100;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_dsa(0, &tl_wr941nd_dsa_data);++	ar71xx_add_device_m25p80(&tl_wr941nd_flash_data);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(tl_wr941nd_leds_gpio),+					tl_wr941nd_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, TL_WR941ND_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(tl_wr941nd_gpio_buttons),+					tl_wr941nd_gpio_buttons);+	ar913x_add_device_wmac(eeprom, mac);+}++MIPS_MACHINE(AR71XX_MACH_TL_WR941ND, "TL-WR941ND", "TP-LINK TL-WR941ND",+	     tl_wr941nd_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-ubnt.c linux-2.6.37/arch/mips/ar71xx/mach-ubnt.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-ubnt.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-ubnt.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,281 @@+/*+ *  Ubiquiti RouterStation support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *  Copyright (C) 2008 Ubiquiti <support@ubnt.com>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-ap91-pci.h"+#include "dev-gpio-buttons.h"+#include "dev-pb42-pci.h"+#include "dev-leds-gpio.h"+#include "dev-usb.h"++#define UBNT_RS_GPIO_LED_RF	2+#define UBNT_RS_GPIO_SW4	8++#define UBNT_LS_SR71_GPIO_LED_D25	0+#define UBNT_LS_SR71_GPIO_LED_D26	1+#define UBNT_LS_SR71_GPIO_LED_D24	2+#define UBNT_LS_SR71_GPIO_LED_D23	4+#define UBNT_LS_SR71_GPIO_LED_D22	5+#define UBNT_LS_SR71_GPIO_LED_D27	6+#define UBNT_LS_SR71_GPIO_LED_D28	7++#define UBNT_M_GPIO_LED_L1	0+#define UBNT_M_GPIO_LED_L2	1+#define UBNT_M_GPIO_LED_L3	11+#define UBNT_M_GPIO_LED_L4	7+#define UBNT_M_GPIO_BTN_RESET	12++#define UBNT_BUTTONS_POLL_INTERVAL	20++static struct gpio_led ubnt_rs_leds_gpio[] __initdata = {+	{+		.name		= "ubnt:green:rf",+		.gpio		= UBNT_RS_GPIO_LED_RF,+		.active_low	= 0,+	}+};++static struct gpio_led ubnt_ls_sr71_leds_gpio[] __initdata = {+	{+		.name		= "ubnt:green:d22",+		.gpio		= UBNT_LS_SR71_GPIO_LED_D22,+		.active_low	= 0,+	}, {+		.name		= "ubnt:green:d23",+		.gpio		= UBNT_LS_SR71_GPIO_LED_D23,+		.active_low	= 0,+	}, {+		.name		= "ubnt:green:d24",+		.gpio		= UBNT_LS_SR71_GPIO_LED_D24,+		.active_low	= 0,+	}, {+		.name		= "ubnt:red:d25",+		.gpio		= UBNT_LS_SR71_GPIO_LED_D25,+		.active_low	= 0,+	}, {+		.name		= "ubnt:red:d26",+		.gpio		= UBNT_LS_SR71_GPIO_LED_D26,+		.active_low	= 0,+	}, {+		.name		= "ubnt:green:d27",+		.gpio		= UBNT_LS_SR71_GPIO_LED_D27,+		.active_low	= 0,+	}, {+		.name		= "ubnt:green:d28",+		.gpio		= UBNT_LS_SR71_GPIO_LED_D28,+		.active_low	= 0,+	}+};++static struct gpio_led ubnt_m_leds_gpio[] __initdata = {+	{+		.name		= "ubnt:red:link1",+		.gpio		= UBNT_M_GPIO_LED_L1,+		.active_low	= 0,+	}, {+		.name		= "ubnt:orange:link2",+		.gpio		= UBNT_M_GPIO_LED_L2,+		.active_low	= 0,+	}, {+		.name		= "ubnt:green:link3",+		.gpio		= UBNT_M_GPIO_LED_L3,+		.active_low	= 0,+	}, {+		.name		= "ubnt:green:link4",+		.gpio		= UBNT_M_GPIO_LED_L4,+		.active_low	= 0,+	}+};++static struct gpio_button ubnt_gpio_buttons[] __initdata = {+	{+		.desc		= "sw4",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= UBNT_RS_GPIO_SW4,+		.active_low	= 1,+	}+};++static struct gpio_button ubnt_m_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= UBNT_M_GPIO_BTN_RESET,+		.active_low	= 1,+	}+};++static void __init ubnt_generic_setup(void)+{+	ar71xx_add_device_m25p80(NULL);++	ar71xx_add_device_gpio_buttons(-1, UBNT_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(ubnt_gpio_buttons),+					ubnt_gpio_buttons);++	pb42_pci_init();+}++#define UBNT_RS_WAN_PHYMASK	(1 << 20)+#define UBNT_RS_LAN_PHYMASK	((1 << 16) | (1 << 17) | (1 << 18) | (1 << 19))++static void __init ubnt_rs_setup(void)+{+	ubnt_generic_setup();++	ar71xx_add_device_mdio(~(UBNT_RS_WAN_PHYMASK | UBNT_RS_LAN_PHYMASK));++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_MII;+	ar71xx_eth0_data.phy_mask = UBNT_RS_WAN_PHYMASK;++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.speed = SPEED_100;+	ar71xx_eth1_data.duplex = DUPLEX_FULL;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_add_device_usb();++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(ubnt_rs_leds_gpio),+					ubnt_rs_leds_gpio);+}++MIPS_MACHINE(AR71XX_MACH_UBNT_RS, "UBNT-RS", "Ubiquiti RouterStation",+	     ubnt_rs_setup);++MIPS_MACHINE(AR71XX_MACH_UBNT_AR71XX, "Ubiquiti AR71xx-based board",+	     "Ubiquiti RouterStation", ubnt_rs_setup);++#define UBNT_RSPRO_WAN_PHYMASK	(1 << 4)+#define UBNT_RSPRO_LAN_PHYMASK	((1 << 0) | (1 << 1) | (1 << 2) | (1 << 3))++static void __init ubnt_rspro_setup(void)+{+	ubnt_generic_setup();++	ar71xx_add_device_mdio(~(UBNT_RSPRO_WAN_PHYMASK | UBNT_RSPRO_LAN_PHYMASK));++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;+	ar71xx_eth0_data.phy_mask = UBNT_RSPRO_WAN_PHYMASK;++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;+	ar71xx_eth1_data.phy_mask = UBNT_RSPRO_LAN_PHYMASK;+	ar71xx_eth1_data.speed = SPEED_1000;+	ar71xx_eth1_data.duplex = DUPLEX_FULL;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_add_device_usb();++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(ubnt_rs_leds_gpio),+					ubnt_rs_leds_gpio);+}++MIPS_MACHINE(AR71XX_MACH_UBNT_RSPRO, "UBNT-RSPRO", "Ubiquiti RouterStation Pro",+	     ubnt_rspro_setup);++static void __init ubnt_lsx_setup(void)+{+	ubnt_generic_setup();+}++MIPS_MACHINE(AR71XX_MACH_UBNT_LSX, "UBNT-LSX", "Ubiquiti LSX", ubnt_lsx_setup);++#define UBNT_LSSR71_PHY_MASK	(1 << 1)++static void __init ubnt_lssr71_setup(void)+{+	ubnt_generic_setup();++	ar71xx_add_device_mdio(~UBNT_LSSR71_PHY_MASK);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_MII;+	ar71xx_eth0_data.phy_mask = UBNT_LSSR71_PHY_MASK;++	ar71xx_add_device_eth(0);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(ubnt_ls_sr71_leds_gpio),+					ubnt_ls_sr71_leds_gpio);+}++MIPS_MACHINE(AR71XX_MACH_UBNT_LSSR71, "UBNT-LS-SR71", "Ubiquiti LS-SR71",+	     ubnt_lssr71_setup);++static void __init ubnt_m_setup(void)+{+	u8 *mac = (u8 *) KSEG1ADDR(0x1fff0000);+	u8 *ee = (u8 *) KSEG1ADDR(0x1fff1000);++	ar71xx_set_mac_base(mac);++	ar71xx_add_device_m25p80(NULL);++	ar71xx_add_device_mdio(~0);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_MII;+	ar71xx_eth0_data.speed = SPEED_100;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;+	ar71xx_eth0_data.fifo_cfg1 = 0x0010ffff;+	ar71xx_eth0_data.fifo_cfg2 = 0x015500aa;+	ar71xx_eth0_data.fifo_cfg3 = 0x01f00140;++	ar71xx_add_device_eth(0);++	ap91_pci_init(ee, NULL);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(ubnt_m_leds_gpio),+					ubnt_m_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, UBNT_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(ubnt_m_gpio_buttons),+					ubnt_m_gpio_buttons);+}++static void __init ubnt_rocket_m_setup(void)+{+	ubnt_m_setup();+	ar71xx_add_device_usb();+}++MIPS_MACHINE(AR71XX_MACH_UBNT_BULLET_M, "UBNT-BM", "Ubiquiti Bullet M",+	     ubnt_m_setup);+MIPS_MACHINE(AR71XX_MACH_UBNT_ROCKET_M, "UBNT-RM", "Ubiquiti Rocket M",+	     ubnt_rocket_m_setup);++/* TODO detect the second ethernet port and use one+   init function for all Ubiquiti MIMO series products */+static void __init ubnt_nano_m_setup(void)+{+	ubnt_m_setup();++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.speed = SPEED_1000;+	ar71xx_eth1_data.duplex = DUPLEX_FULL;+	ar71xx_eth1_data.fifo_cfg1 = 0x0010ffff;+	ar71xx_eth1_data.fifo_cfg2 = 0x015500aa;+	ar71xx_eth1_data.fifo_cfg3 = 0x01f00140;++	ar71xx_add_device_eth(1);+}++MIPS_MACHINE(AR71XX_MACH_UBNT_NANO_M, "UBNT-NM", "Ubiquiti Nanostation M",+	     ubnt_nano_m_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-wndr3700.c linux-2.6.37/arch/mips/ar71xx/mach-wndr3700.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-wndr3700.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-wndr3700.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,209 @@+/*+ *  Netgear WNDR3700 board support+ *+ *  Copyright (C) 2009 Marco Porsch+ *  Copyright (C) 2009-2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/platform_device.h>+#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>+#include <linux/delay.h>+#include <linux/rtl8366s.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-ap94-pci.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"+#include "dev-usb.h"++#define WNDR3700_GPIO_LED_WPS_ORANGE	0+#define WNDR3700_GPIO_LED_POWER_ORANGE	1+#define WNDR3700_GPIO_LED_POWER_GREEN	2+#define WNDR3700_GPIO_LED_WPS_GREEN	4+#define WNDR3700_GPIO_LED_WAN_GREEN	6++#define WNDR3700_GPIO_BTN_WPS		3+#define WNDR3700_GPIO_BTN_RESET		8+#define WNDR3700_GPIO_BTN_WIFI		11++#define WNDR3700_GPIO_RTL8366_SDA	5+#define WNDR3700_GPIO_RTL8366_SCK	7++#define WNDR3700_BUTTONS_POLL_INTERVAL    20++#define WNDR3700_WMAC0_MAC_OFFSET	0+#define WNDR3700_WMAC1_MAC_OFFSET	0xc+#define WNDR3700_CALDATA0_OFFSET	0x1000+#define WNDR3700_CALDATA1_OFFSET	0x5000++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition wndr3700_partitions[] = {+	{+		.name		= "uboot",+		.offset		= 0,+		.size		= 0x050000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "env",+		.offset		= 0x050000,+		.size		= 0x020000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "rootfs",+		.offset		= 0x070000,+		.size		= 0x720000,+	} , {+		.name		= "config",+		.offset		= 0x790000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "config_bak",+		.offset		= 0x7a0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "pot",+		.offset		= 0x7b0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "traffic_meter",+		.offset		= 0x7c0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "language",+		.offset		= 0x7d0000,+		.size		= 0x020000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "caldata",+		.offset		= 0x7f0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data wndr3700_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = wndr3700_partitions,+        .nr_parts       = ARRAY_SIZE(wndr3700_partitions),+#endif+};++static struct gpio_led wndr3700_leds_gpio[] __initdata = {+	{+		.name		= "wndr3700:green:power",+		.gpio		= WNDR3700_GPIO_LED_POWER_GREEN,+		.active_low	= 1,+	}, {+		.name		= "wndr3700:orange:power",+		.gpio		= WNDR3700_GPIO_LED_POWER_ORANGE,+		.active_low	= 1,+	}, {+		.name		= "wndr3700:green:wps",+		.gpio		= WNDR3700_GPIO_LED_WPS_GREEN,+		.active_low	= 1,+	}, {+		.name		= "wndr3700:orange:wps",+		.gpio		= WNDR3700_GPIO_LED_WPS_ORANGE,+		.active_low	= 1,+	}, {+		.name		= "wndr3700:green:wan",+		.gpio		= WNDR3700_GPIO_LED_WAN_GREEN,+		.active_low	= 1,+	}+};++static struct gpio_button wndr3700_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= WNDR3700_GPIO_BTN_RESET,+		.active_low	= 1,+	}, {+		.desc		= "wps",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= WNDR3700_GPIO_BTN_WPS,+		.active_low	= 1,+	} , {+		.desc		= "wifi",+		.type		= EV_KEY,+		.code		= BTN_2,+		.threshold	= 3,+		.gpio		= WNDR3700_GPIO_BTN_WIFI,+		.active_low	= 1,+	}+};++static struct rtl8366s_platform_data wndr3700_rtl8366s_data = {+	.gpio_sda        = WNDR3700_GPIO_RTL8366_SDA,+	.gpio_sck        = WNDR3700_GPIO_RTL8366_SCK,+};++static struct platform_device wndr3700_rtl8366s_device = {+	.name		= RTL8366S_DRIVER_NAME,+	.id		= -1,+	.dev = {+		.platform_data	= &wndr3700_rtl8366s_data,+	}+};++static void __init wndr3700_setup(void)+{+	u8 *art = (u8 *) KSEG1ADDR(0x1fff0000);++	ar71xx_set_mac_base(art);++	ar71xx_eth0_pll_data.pll_1000 = 0x11110000;+	ar71xx_eth0_data.mii_bus_dev = &wndr3700_rtl8366s_device.dev;+	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;+	ar71xx_eth0_data.speed = SPEED_1000;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;++	ar71xx_eth1_pll_data.pll_1000 = 0x11110000;+	ar71xx_eth1_data.mii_bus_dev = &wndr3700_rtl8366s_device.dev;+	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;+	ar71xx_eth1_data.phy_mask = 0x10;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_add_device_usb();++	ar71xx_add_device_m25p80(&wndr3700_flash_data);++        ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(wndr3700_leds_gpio),+				    wndr3700_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, WNDR3700_BUTTONS_POLL_INTERVAL,+				      ARRAY_SIZE(wndr3700_gpio_buttons),+				      wndr3700_gpio_buttons);++	platform_device_register(&wndr3700_rtl8366s_device);+	platform_device_register_simple("wndr3700-led-usb", -1, NULL, 0);++	ap94_pci_enable_quirk_wndr3700();+	ap94_pci_init(art + WNDR3700_CALDATA0_OFFSET,+		      art + WNDR3700_WMAC0_MAC_OFFSET,+		      art + WNDR3700_CALDATA1_OFFSET,+		      art + WNDR3700_WMAC1_MAC_OFFSET);+}++MIPS_MACHINE(AR71XX_MACH_WNDR3700, "WNDR3700", "NETGEAR WNDR3700",+	     wndr3700_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-wnr2000.c linux-2.6.37/arch/mips/ar71xx/mach-wnr2000.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-wnr2000.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-wnr2000.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,148 @@+/*+ *  NETGEAR WNR2000 board support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *  Copyright (C) 2008-2009 Andy Boyett <agb@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-ar913x-wmac.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"++#define WNR2000_GPIO_LED_PWR_GREEN	14+#define WNR2000_GPIO_LED_PWR_AMBER	7+#define WNR2000_GPIO_LED_WPS		4+#define WNR2000_GPIO_LED_WLAN		6+#define WNR2000_GPIO_BTN_RESET		21+#define WNR2000_GPIO_BTN_WPS		8++#define WNR2000_BUTTONS_POLL_INTERVAL	20++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition wnr2000_partitions[] = {+	{+		.name		= "u-boot",+		.offset		= 0,+		.size		= 0x040000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "u-boot-env",+		.offset		= 0x040000,+		.size		= 0x010000,+	} , {+		.name		= "rootfs",+		.offset		= 0x050000,+		.size		= 0x240000,+	} , {+		.name		= "user-config",+		.offset		= 0x290000,+		.size		= 0x010000,+	} , {+		.name		= "uImage",+		.offset		= 0x2a0000,+		.size		= 0x120000,+	} , {+		.name		= "language_table",+		.offset		= 0x3c0000,+		.size		= 0x020000,+	} , {+		.name		= "rootfs_checksum",+		.offset		= 0x3e0000,+		.size		= 0x010000,+	} , {+		.name		= "art",+		.offset		= 0x3f0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data wnr2000_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = wnr2000_partitions,+        .nr_parts       = ARRAY_SIZE(wnr2000_partitions),+#endif+};++static struct gpio_led wnr2000_leds_gpio[] __initdata = {+	{+		.name		= "wnr2000:green:power",+		.gpio		= WNR2000_GPIO_LED_PWR_GREEN,+		.active_low	= 1,+	}, {+		.name		= "wnr2000:amber:power",+		.gpio		= WNR2000_GPIO_LED_PWR_AMBER,+		.active_low	= 1,+	}, {+		.name		= "wnr2000:green:wps",+		.gpio		= WNR2000_GPIO_LED_WPS,+		.active_low	= 1,+	}, {+		.name		= "wnr2000:blue:wlan",+		.gpio		= WNR2000_GPIO_LED_WLAN,+		.active_low	= 1,+	}+};++static struct gpio_button wnr2000_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= WNR2000_GPIO_BTN_RESET,+	}, {+		.desc		= "wps",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= WNR2000_GPIO_BTN_WPS,+	}+};++static void __init wnr2000_setup(void)+{+	u8 *eeprom = (u8 *) KSEG1ADDR(0x1fff1000);++	ar71xx_set_mac_base(eeprom);+	ar71xx_add_device_mdio(0x0);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth0_data.speed = SPEED_100;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;+	ar71xx_eth0_data.has_ar8216 = 1;++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.phy_mask = 0x10;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_add_device_m25p80(&wnr2000_flash_data);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(wnr2000_leds_gpio),+					wnr2000_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, WNR2000_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(wnr2000_gpio_buttons),+					wnr2000_gpio_buttons);+++	ar913x_add_device_wmac(eeprom, NULL);+}++MIPS_MACHINE(AR71XX_MACH_WNR2000, "WNR2000", "NETGEAR WNR2000", wnr2000_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-wp543.c linux-2.6.37/arch/mips/ar71xx/mach-wp543.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-wp543.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-wp543.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,99 @@+/*+ *  Compex WP543/WPJ543 board support+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-pb42-pci.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"+#include "dev-usb.h"++#define WP543_GPIO_SW6		2+#define WP543_GPIO_LED_1	3+#define WP543_GPIO_LED_2	4+#define WP543_GPIO_LED_WLAN	5+#define WP543_GPIO_LED_CONN	6+#define WP543_GPIO_LED_DIAG	7+#define WP543_GPIO_SW4		8++#define WP543_BUTTONS_POLL_INTERVAL	20++static struct gpio_led wp543_leds_gpio[] __initdata = {+	{+		.name		= "wp543:green:led1",+		.gpio		= WP543_GPIO_LED_1,+		.active_low	= 1,+	}, {+		.name		= "wp543:green:led2",+		.gpio		= WP543_GPIO_LED_2,+		.active_low	= 1,+	}, {+		.name		= "wp543:green:wlan",+		.gpio		= WP543_GPIO_LED_WLAN,+		.active_low	= 1,+	}, {+		.name		= "wp543:green:conn",+		.gpio		= WP543_GPIO_LED_CONN,+		.active_low	= 1,+	}, {+		.name		= "wp543:green:diag",+		.gpio		= WP543_GPIO_LED_DIAG,+		.active_low	= 1,+	}+};++static struct gpio_button wp543_gpio_buttons[] __initdata = {+	{+		.desc		= "sw6",+		.type		= EV_KEY,+		.code		= BTN_0,+		.threshold	= 3,+		.gpio		= WP543_GPIO_SW6,+	}, {+		.desc		= "sw4",+		.type		= EV_KEY,+		.code		= BTN_1,+		.threshold	= 3,+		.gpio		= WP543_GPIO_SW4,+	}+};++static void __init wp543_setup(void)+{+	ar71xx_add_device_m25p80(NULL);++	ar71xx_add_device_mdio(0xfffffff7);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_MII;+	ar71xx_eth0_data.phy_mask = 0x08;+	ar71xx_eth0_data.reset_bit = RESET_MODULE_GE0_MAC |+				     RESET_MODULE_GE0_PHY;+	ar71xx_add_device_eth(0);++	ar71xx_add_device_usb();++	pb42_pci_init();++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(wp543_leds_gpio),+					wp543_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, WP543_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(wp543_gpio_buttons),+					wp543_gpio_buttons);+}++MIPS_MACHINE(AR71XX_MACH_WP543, "WP543", "Compex WP543", wp543_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-wrt160nl.c linux-2.6.37/arch/mips/ar71xx/mach-wrt160nl.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-wrt160nl.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-wrt160nl.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,158 @@+/*+ *  Linksys WRT160NL board support+ *+ *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-m25p80.h"+#include "dev-ar913x-wmac.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"+#include "dev-usb.h"+#include "nvram.h"++#define WRT160NL_GPIO_LED_POWER		14+#define WRT160NL_GPIO_LED_WPS_AMBER	9+#define WRT160NL_GPIO_LED_WPS_BLUE	8+#define WRT160NL_GPIO_LED_WLAN		6++#define WRT160NL_GPIO_BTN_WPS		7+#define WRT160NL_GPIO_BTN_RESET		21++#define WRT160NL_BUTTONS_POLL_INTERVAL	20++#define WRT160NL_NVRAM_ADDR	0x1f7e0000+#define WRT160NL_NVRAM_SIZE	0x10000++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition wrt160nl_partitions[] = {+	{+		.name		= "u-boot",+		.offset		= 0,+		.size		= 0x040000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "kernel",+		.offset		= 0x040000,+		.size		= 0x0e0000,+	} , {+		.name		= "filesytem",+		.offset		= 0x120000,+		.size		= 0x6c0000,+	} , {+		.name		= "nvram",+		.offset		= 0x7e0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "ART",+		.offset		= 0x7f0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "firmware",+		.offset		= 0x040000,+		.size		= 0x7a0000,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data wrt160nl_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = wrt160nl_partitions,+        .nr_parts       = ARRAY_SIZE(wrt160nl_partitions),+#endif+};++static struct gpio_led wrt160nl_leds_gpio[] __initdata = {+	{+		.name		= "wrt160nl:blue:power",+		.gpio		= WRT160NL_GPIO_LED_POWER,+		.active_low	= 1,+		.default_trigger = "default-on",+	}, {+		.name		= "wrt160nl:amber:wps",+		.gpio		= WRT160NL_GPIO_LED_WPS_AMBER,+		.active_low	= 1,+	}, {+		.name		= "wrt160nl:blue:wps",+		.gpio		= WRT160NL_GPIO_LED_WPS_BLUE,+		.active_low	= 1,+	}, {+		.name		= "wrt160nl:blue:wlan",+		.gpio		= WRT160NL_GPIO_LED_WLAN,+		.active_low	= 1,+	}+};++static struct gpio_button wrt160nl_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= WRT160NL_GPIO_BTN_RESET,+		.active_low	= 1,+	}, {+		.desc		= "wps",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= WRT160NL_GPIO_BTN_WPS,+		.active_low	= 1,+	}+};++static void __init wrt160nl_setup(void)+{+	const char *nvram = (char *) KSEG1ADDR(WRT160NL_NVRAM_ADDR);+	u8 *eeprom = (u8 *) KSEG1ADDR(0x1fff1000);+	u8 mac[6];++	if (nvram_parse_mac_addr(nvram, WRT160NL_NVRAM_SIZE,+			         "lan_hwaddr=", mac) == 0)+		ar71xx_set_mac_base(mac);++	ar71xx_add_device_mdio(0x0);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth0_data.phy_mask = 0x01;++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.phy_mask = 0x10;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_add_device_m25p80(&wrt160nl_flash_data);++	ar71xx_add_device_usb();++	if (nvram_parse_mac_addr(nvram, WRT160NL_NVRAM_SIZE,+			         "wl0_hwaddr=", mac) == 0)+		ar913x_add_device_wmac(eeprom, mac);+	else+		ar913x_add_device_wmac(eeprom, NULL);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(wrt160nl_leds_gpio),+					wrt160nl_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, WRT160NL_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(wrt160nl_gpio_buttons),+					wrt160nl_gpio_buttons);++}++MIPS_MACHINE(AR71XX_MACH_WRT160NL, "WRT160NL", "Linksys WRT160NL",+	     wrt160nl_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-wrt400n.c linux-2.6.37/arch/mips/ar71xx/mach-wrt400n.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-wrt400n.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-wrt400n.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,168 @@+/*+ *  Linksys WRT400N board support+ *+ *  Copyright (C) 2009-2010 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2009 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"+#include "dev-ap94-pci.h"+#include "dev-m25p80.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"++#define WRT400N_GPIO_LED_ORANGE	5+#define WRT400N_GPIO_LED_GREEN	4+#define WRT400N_GPIO_LED_POWER	1+#define WRT400N_GPIO_LED_WLAN	0++#define WRT400N_GPIO_BTN_RESET	8+#define WRT400N_GPIO_BTN_WLSEC	3++#define WRT400N_BUTTONS_POLL_INTERVAL	20++#define WRT400N_MAC_ADDR_OFFSET		0x120c+#define WRT400N_CALDATA0_OFFSET		0x1000+#define WRT400N_CALDATA1_OFFSET		0x5000++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition wrt400n_partitions[] = {+	{+		.name		= "uboot",+		.offset		= 0,+		.size		= 0x030000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "env",+		.offset		= 0x030000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "linux",+		.offset		= 0x040000,+		.size		= 0x140000,+	} , {+		.name		= "rootfs",+		.offset		= 0x180000,+		.size		= 0x630000,+	} , {+		.name		= "nvram",+		.offset		= 0x7b0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "factory",+		.offset		= 0x7c0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "language",+		.offset		= 0x7d0000,+		.size		= 0x020000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "caldata",+		.offset		= 0x7f0000,+		.size		= 0x010000,+		.mask_flags	= MTD_WRITEABLE,+	} , {+		.name		= "firmware",+		.offset		= 0x040000,+		.size		= 0x770000,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct flash_platform_data wrt400n_flash_data = {+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = wrt400n_partitions,+        .nr_parts       = ARRAY_SIZE(wrt400n_partitions),+#endif+};++static struct gpio_led wrt400n_leds_gpio[] __initdata = {+	{+		.name		= "wrt400n:green:status",+		.gpio		= WRT400N_GPIO_LED_GREEN,+		.active_low	= 1,+	}, {+		.name		= "wrt400n:amber:aoss",+		.gpio		= WRT400N_GPIO_LED_ORANGE,+		.active_low	= 1,+	}, {+		.name		= "wrt400n:green:wlan",+		.gpio		= WRT400N_GPIO_LED_WLAN,+		.active_low	= 1,+	}, {+		.name		= "wrt400n:green:power",+		.gpio		= WRT400N_GPIO_LED_POWER,+		.active_low	= 1,+	}+};++static struct gpio_button wrt400n_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= WRT400N_GPIO_BTN_RESET,+		.active_low	= 1,+	} , {+		.desc		= "wlsec",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= WRT400N_GPIO_BTN_WLSEC,+		.active_low	= 1,+	}+};++static void __init wrt400n_setup(void)+{+	u8 *art = (u8 *) KSEG1ADDR(0x1fff0000);+	u8 mac[6];+	int i;++	memcpy(mac, art + WRT400N_MAC_ADDR_OFFSET, 6);+	for (i = 5; i >= 3; i--)+		if (++mac[i] != 0x00) break;++	ar71xx_set_mac_base(mac);++	ar71xx_add_device_mdio(0x0);++	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth0_data.speed = SPEED_100;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;++	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RMII;+	ar71xx_eth1_data.phy_mask = 0x10;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_add_device_m25p80(&wrt400n_flash_data);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(wrt400n_leds_gpio),+					wrt400n_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, WRT400N_BUTTONS_POLL_INTERVAL,+					ARRAY_SIZE(wrt400n_gpio_buttons),+					wrt400n_gpio_buttons);++	ap94_pci_init(art + WRT400N_CALDATA0_OFFSET, NULL,+		      art + WRT400N_CALDATA1_OFFSET, NULL);+}++MIPS_MACHINE(AR71XX_MACH_WRT400N, "WRT400N", "Linksys WRT400N", wrt400n_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/mach-wzr-hp-g300nh.c linux-2.6.37/arch/mips/ar71xx/mach-wzr-hp-g300nh.c--- linux-2.6.37.orig/arch/mips/ar71xx/mach-wzr-hp-g300nh.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/mach-wzr-hp-g300nh.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,265 @@+/*+ *  Buffalo WZR-HP-G300NH board support+ *+ *  Copyright (C) 2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/platform_device.h>+#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>+#include <linux/nxp_74hc153.h>+#include <linux/rtl8366s.h>++#include <asm/mips_machine.h>+#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/ar91xx_flash.h>++#include "machtype.h"+#include "devices.h"+#include "dev-ar913x-wmac.h"+#include "dev-gpio-buttons.h"+#include "dev-leds-gpio.h"+#include "dev-usb.h"++#define WZRHPG300NH_GPIO_LED_USB	0+#define WZRHPG300NH_GPIO_LED_DIAG	1+#define WZRHPG300NH_GPIO_LED_WIRELESS	6+#define WZRHPG300NH_GPIO_LED_SECURITY	17+#define WZRHPG300NH_GPIO_LED_ROUTER	18++#define WZRHPG300NH_GPIO_RTL8366_SDA	19+#define WZRHPG300NH_GPIO_RTL8366_SCK	20++#define WZRHPG300NH_GPIO_74HC153_S0	9+#define WZRHPG300NH_GPIO_74HC153_S1	11+#define WZRHPG300NH_GPIO_74HC153_1Y	12+#define WZRHPG300NH_GPIO_74HC153_2Y	14++#define WZRHPG300NH_GPIO_EXP_BASE	32+#define WZRHPG300NH_GPIO_BTN_AOSS	(WZRHPG300NH_GPIO_EXP_BASE + 0)+#define WZRHPG300NH_GPIO_BTN_RESET	(WZRHPG300NH_GPIO_EXP_BASE + 1)+#define WZRHPG300NH_GPIO_BTN_ROUTER_ON	(WZRHPG300NH_GPIO_EXP_BASE + 2)+#define WZRHPG300NH_GPIO_BTN_QOS_ON	(WZRHPG300NH_GPIO_EXP_BASE + 3)+#define WZRHPG300NH_GPIO_BTN_USB	(WZRHPG300NH_GPIO_EXP_BASE + 5)+#define WZRHPG300NH_GPIO_BTN_ROUTER_AUTO (WZRHPG300NH_GPIO_EXP_BASE + 6)+#define WZRHPG300NH_GPIO_BTN_QOS_OFF	(WZRHPG300NH_GPIO_EXP_BASE + 7)++#define WZRHPG300NH_BUTTONS_POLL_INTERVAL	20++#define WZRHPG300NH_MAC_OFFSET		0x20c++#ifdef CONFIG_MTD_PARTITIONS+static struct mtd_partition wzrhpg300nh_flash_partitions[] = {+	{+		.name		= "u-boot",+		.offset		= 0,+		.size		= 0x0040000,+		.mask_flags	= MTD_WRITEABLE,+	}, {+		.name		= "u-boot-env",+		.offset		= 0x0040000,+		.size		= 0x0020000,+		.mask_flags	= MTD_WRITEABLE,+	}, {+		.name		= "kernel",+		.offset		= 0x0060000,+		.size		= 0x0100000,+	}, {+		.name		= "rootfs",+		.offset		= 0x0160000,+		.size		= 0x1e60000,+	}, {+		.name		= "user_property",+		.offset		= 0x1fc0000,+		.size		= 0x0020000,+		.mask_flags	= MTD_WRITEABLE,+	}, {+		.name		= "art",+		.offset		= 0x1fe0000,+		.size		= 0x0020000,+		.mask_flags	= MTD_WRITEABLE,+	}, {+		.name		= "firmware",+		.offset		= 0x0060000,+		.size		= 0x1f60000,+	}+};+#endif /* CONFIG_MTD_PARTITIONS */++static struct ar91xx_flash_platform_data wzrhpg300nh_flash_data = {+	.width		= 2,+#ifdef CONFIG_MTD_PARTITIONS+        .parts          = wzrhpg300nh_flash_partitions,+        .nr_parts       = ARRAY_SIZE(wzrhpg300nh_flash_partitions),+#endif+};++#define WZRHPG300NH_FLASH_BASE	0x1e000000+#define WZRHPG300NH_FLASH_SIZE	(32 * 1024 * 1024)++static struct resource wzrhpg300nh_flash_resources[] = {+	[0] = {+		.start	= WZRHPG300NH_FLASH_BASE,+		.end	= WZRHPG300NH_FLASH_BASE + WZRHPG300NH_FLASH_SIZE - 1,+		.flags	= IORESOURCE_MEM,+	},+};++static struct platform_device wzrhpg300nh_flash_device = {+	.name		= "ar91xx-flash",+	.id		= -1,+	.resource	= wzrhpg300nh_flash_resources,+	.num_resources	= ARRAY_SIZE(wzrhpg300nh_flash_resources),+	.dev		= {+		.platform_data = &wzrhpg300nh_flash_data,+	}+};++static struct gpio_led wzrhpg300nh_leds_gpio[] __initdata = {+	{+		.name		= "wzr-hp-g300nh:orange:security",+		.gpio		= WZRHPG300NH_GPIO_LED_SECURITY,+		.active_low	= 1,+	}, {+		.name		= "wzr-hp-g300nh:green:wireless",+		.gpio		= WZRHPG300NH_GPIO_LED_WIRELESS,+		.active_low	= 1,+	}, {+		.name		= "wzr-hp-g300nh:green:router",+		.gpio		= WZRHPG300NH_GPIO_LED_ROUTER,+		.active_low	= 1,+	}, {+		.name		= "wzr-hp-g300nh:red:diag",+		.gpio		= WZRHPG300NH_GPIO_LED_DIAG,+		.active_low	= 1,+	}, {+		.name		= "wzr-hp-g300nh:blue:usb",+		.gpio		= WZRHPG300NH_GPIO_LED_USB,+		.active_low	= 1,+	}+};++static struct gpio_button wzrhpg300nh_gpio_buttons[] __initdata = {+	{+		.desc		= "reset",+		.type		= EV_KEY,+		.code		= KEY_RESTART,+		.threshold	= 3,+		.gpio		= WZRHPG300NH_GPIO_BTN_RESET,+		.active_low	= 1,+	}, {+		.desc		= "aoss",+		.type		= EV_KEY,+		.code		= KEY_WPS_BUTTON,+		.threshold	= 3,+		.gpio		= WZRHPG300NH_GPIO_BTN_AOSS,+		.active_low	= 1,+	}, {+		.desc		= "usb",+		.type		= EV_KEY,+		.code		= BTN_2,+		.threshold	= 3,+		.gpio		= WZRHPG300NH_GPIO_BTN_USB,+		.active_low	= 1,+	}, {+		.desc		= "qos_on",+		.type		= EV_KEY,+		.code		= BTN_3,+		.threshold	= 3,+		.gpio		= WZRHPG300NH_GPIO_BTN_QOS_ON,+		.active_low	= 0,+	}, {+		.desc		= "qos_off",+		.type		= EV_KEY,+		.code		= BTN_4,+		.threshold	= 3,+		.gpio		= WZRHPG300NH_GPIO_BTN_QOS_OFF,+		.active_low	= 0,+	}, {+		.desc		= "router_on",+		.type		= EV_KEY,+		.code		= BTN_5,+		.threshold	= 3,+		.gpio		= WZRHPG300NH_GPIO_BTN_ROUTER_ON,+		.active_low	= 0,+	}, {+		.desc		= "router_auto",+		.type		= EV_KEY,+		.code		= BTN_6,+		.threshold	= 3,+		.gpio		= WZRHPG300NH_GPIO_BTN_ROUTER_AUTO,+		.active_low	= 0,+	}+};++static struct nxp_74hc153_platform_data wzrhpg300nh_74hc153_data = {+	.gpio_base	= WZRHPG300NH_GPIO_EXP_BASE,+	.gpio_pin_s0	= WZRHPG300NH_GPIO_74HC153_S0,+	.gpio_pin_s1	= WZRHPG300NH_GPIO_74HC153_S1,+	.gpio_pin_1y	= WZRHPG300NH_GPIO_74HC153_1Y,+	.gpio_pin_2y	= WZRHPG300NH_GPIO_74HC153_2Y,+};++static struct platform_device wzrhpg300nh_74hc153_device = {+	.name		= NXP_74HC153_DRIVER_NAME,+	.id		= -1,+	.dev = {+		.platform_data	= &wzrhpg300nh_74hc153_data,+	}+};++static struct rtl8366s_platform_data wzrhpg300nh_rtl8366s_data = {+	.gpio_sda        = WZRHPG300NH_GPIO_RTL8366_SDA,+	.gpio_sck        = WZRHPG300NH_GPIO_RTL8366_SCK,+};++static struct platform_device wzrhpg300nh_rtl8366s_device = {+	.name		= RTL8366S_DRIVER_NAME,+	.id		= -1,+	.dev = {+		.platform_data	= &wzrhpg300nh_rtl8366s_data,+	}+};++static void __init wzrhpg300nh_setup(void)+{+	u8 *eeprom = (u8 *) KSEG1ADDR(0x1fff1000);++	ar71xx_set_mac_base(eeprom + WZRHPG300NH_MAC_OFFSET);++	ar71xx_eth0_pll_data.pll_1000 = 0x1e000100;+	ar71xx_eth0_data.mii_bus_dev = &wzrhpg300nh_rtl8366s_device.dev;+	ar71xx_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;+	ar71xx_eth0_data.speed = SPEED_1000;+	ar71xx_eth0_data.duplex = DUPLEX_FULL;++	ar71xx_eth1_pll_data.pll_1000 = 0x1e000100;+	ar71xx_eth1_data.mii_bus_dev = &wzrhpg300nh_rtl8366s_device.dev;+	ar71xx_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;+	ar71xx_eth1_data.phy_mask = 0x10;++	ar71xx_add_device_eth(0);+	ar71xx_add_device_eth(1);++	ar71xx_add_device_usb();+	ar913x_add_device_wmac(eeprom, NULL);++	platform_device_register(&wzrhpg300nh_74hc153_device);+	platform_device_register(&wzrhpg300nh_flash_device);+	platform_device_register(&wzrhpg300nh_rtl8366s_device);++	ar71xx_add_device_leds_gpio(-1, ARRAY_SIZE(wzrhpg300nh_leds_gpio),+				    wzrhpg300nh_leds_gpio);++	ar71xx_add_device_gpio_buttons(-1, WZRHPG300NH_BUTTONS_POLL_INTERVAL,+				       ARRAY_SIZE(wzrhpg300nh_gpio_buttons),+				       wzrhpg300nh_gpio_buttons);++}++MIPS_MACHINE(AR71XX_MACH_WZR_HP_G300NH, "WZR-HP-G300NH",+	     "Buffalo WZR-HP-G300NH", wzrhpg300nh_setup);diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/machtype.h linux-2.6.37/arch/mips/ar71xx/machtype.h--- linux-2.6.37.orig/arch/mips/ar71xx/machtype.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/machtype.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,60 @@+/*+ *  Atheros AR71xx machine type definitions+ *+ *  Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef _AR71XX_MACHTYPE_H+#define _AR71XX_MACHTYPE_H++#include <asm/mips_machine.h>++enum ar71xx_mach_type {+	AR71XX_MACH_GENERIC = 0,+	AR71XX_MACH_AP81,	/* Atheros AP81 */+	AR71XX_MACH_AP83,	/* Atheros AP83 */+	AR71XX_MACH_AW_NR580,	/* AzureWave AW-NR580 */+	AR71XX_MACH_DIR_600_A1,	/* D-Link DIR-600 rev. A1 */+	AR71XX_MACH_DIR_615_C1,	/* D-Link DIR-615 rev. C1 */+	AR71XX_MACH_DIR_825_B1,	/* D-Link DIR-825 rev. B1 */+	AR71XX_MACH_RB_411,	/* MikroTik RouterBOARD 411/411A/411AH */+	AR71XX_MACH_RB_411U,	/* MikroTik RouterBOARD 411U */+	AR71XX_MACH_RB_433,	/* MikroTik RouterBOARD 433/433AH */+	AR71XX_MACH_RB_433U,	/* MikroTik RouterBOARD 433UAH */+	AR71XX_MACH_RB_450,	/* MikroTik RouterBOARD 450 */+	AR71XX_MACH_RB_450G,	/* MikroTik RouterBOARD 450G */+	AR71XX_MACH_RB_493,	/* Mikrotik RouterBOARD 493/493AH */+	AR71XX_MACH_RB_750,	/* MikroTik RouterBOARD 750 */+	AR71XX_MACH_PB42,	/* Atheros PB42 */+	AR71XX_MACH_PB44,	/* Atheros PB44 */+	AR71XX_MACH_PB92,	/* Atheros PB92 */+	AR71XX_MACH_MZK_W04NU,	/* Planex MZK-W04NU */+	AR71XX_MACH_MZK_W300NH,	/* Planex MZK-W300NH */+	AR71XX_MACH_NBG460N,	/* Zyxel NBG460N/550N/550NH */+	AR71XX_MACH_TEW_632BRP,	/* TRENDnet TEW-632BRP */+	AR71XX_MACH_TL_WR741ND,	/* TP-LINK TL-WR741ND */+	AR71XX_MACH_TL_WR841N_V1, /* TP-LINK TL-WR841N v1 */+	AR71XX_MACH_TL_WR941ND,	/* TP-LINK TL-WR941ND */+	AR71XX_MACH_TL_WR1043ND, /* TP-LINK TL-WR1041ND */+	AR71XX_MACH_UBNT_LSSR71, /* Ubiquiti LS-SR71 */+	AR71XX_MACH_UBNT_LSX,	/* Ubiquiti LSX */+	AR71XX_MACH_UBNT_RS,	/* Ubiquiti RouterStation */+	AR71XX_MACH_UBNT_AR71XX, /* Ubiquiti AR71xx-based board */+	AR71XX_MACH_UBNT_RSPRO,	/* Ubiquiti RouterStation Pro */+	AR71XX_MACH_UBNT_BULLET_M, /* Ubiquiti Bullet M */+	AR71XX_MACH_UBNT_ROCKET_M, /* Ubiquiti Rocket M */+	AR71XX_MACH_UBNT_NANO_M, /* Ubiquiti NanoStation M */+	AR71XX_MACH_WNDR3700,	/* NETGEAR WNDR3700 */+	AR71XX_MACH_WNR2000,	/* NETGEAR WNR2000 */+	AR71XX_MACH_WP543,	/* Compex WP543 */+	AR71XX_MACH_WRT160NL,	/* Linksys WRT160NL */+	AR71XX_MACH_WRT400N,	/* Linksys WRT400N */+	AR71XX_MACH_WZR_HP_G300NH, /* Buffalo WZR-HP-G300NH */+};++#endif /* _AR71XX_MACHTYPE_H */diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/nvram.c linux-2.6.37/arch/mips/ar71xx/nvram.c--- linux-2.6.37.orig/arch/mips/ar71xx/nvram.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/nvram.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,75 @@+/*+ *  Atheros AR71xx minimal nvram support+ *+ *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/kernel.h>+#include <linux/vmalloc.h>+#include <linux/errno.h>+#include <linux/init.h>+#include <linux/string.h>++#include "nvram.h"++char *nvram_find_var(const char *name, const char *buf, unsigned buf_len)+{+	unsigned len = strlen(name);+	char *cur, *last;++	if (buf_len == 0 || len == 0)+		return NULL;++	if (buf_len < len)+		return NULL;++	if (len == 1)+		return memchr(buf, (int) *name, buf_len);++	last = (char *) buf + buf_len - len;+	for (cur = (char *) buf; cur <= last; cur++)+		if (cur[0] == name[0] && memcmp(cur, name, len) == 0)+			return cur + len;++	return NULL;+}++int nvram_parse_mac_addr(const char *nvram, unsigned nvram_len,+			 const char *name, char *mac)+{+	char *buf;+	char *mac_str;+	int ret;+	int t;++	buf = vmalloc(nvram_len);+	if (!buf)+		return -ENOMEM;++	memcpy(buf, nvram, nvram_len);+	buf[nvram_len - 1] = '\0';++	mac_str = nvram_find_var(name, buf, nvram_len);+	if (!mac_str) {+		ret = -EINVAL;+		goto free;+	}++	t = sscanf(mac_str, "%02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx",+		   &mac[0], &mac[1], &mac[2], &mac[3], &mac[4], &mac[5]);++	if (t != 6) {+		ret = -EINVAL;+		goto free;+	}++	ret = 0;++ free:+	vfree(buf);+	return ret;+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/nvram.h linux-2.6.37/arch/mips/ar71xx/nvram.h--- linux-2.6.37.orig/arch/mips/ar71xx/nvram.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/nvram.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,19 @@+/*+ *  Atheros AR71xx minimal nvram support+ *+ *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef _AR71XX_NVRAM_H+#define _AR71XX_NVRAM_H++char *nvram_find_var(const char *name, const char *buf,+		     unsigned buf_len) __init;+int nvram_parse_mac_addr(const char *nvram, unsigned nvram_len,+			 const char *name, char *mac) __init;++#endif /* _AR71XX_NVRAM_H */diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/pci.c linux-2.6.37/arch/mips/ar71xx/pci.c--- linux-2.6.37.orig/arch/mips/ar71xx/pci.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/pci.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,93 @@+/*+ *  Atheros AR71xx PCI setup code+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Parts of this file are based on Atheros' 2.6.15 BSP+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/kernel.h>++#include <asm/traps.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/pci.h>++unsigned ar71xx_pci_nr_irqs __initdata;+struct ar71xx_pci_irq *ar71xx_pci_irq_map __initdata;++int (*ar71xx_pci_plat_dev_init)(struct pci_dev *dev);++static int ar71xx_be_handler(struct pt_regs *regs, int is_fixup)+{+	int err = 0;++	err = ar71xx_pci_be_handler(is_fixup);++	return (is_fixup && !err) ? MIPS_BE_FIXUP : MIPS_BE_FATAL;+}++int pcibios_plat_dev_init(struct pci_dev *dev)+{+	if (ar71xx_pci_plat_dev_init)+		return ar71xx_pci_plat_dev_init(dev);++	return 0;+}++int __init pcibios_map_irq(const struct pci_dev *dev, uint8_t slot, uint8_t pin)+{+	int ret = 0;++	switch (ar71xx_soc) {+	case AR71XX_SOC_AR7130:+	case AR71XX_SOC_AR7141:+	case AR71XX_SOC_AR7161:+		ret = ar71xx_pcibios_map_irq(dev, slot, pin);+		break;++	case AR71XX_SOC_AR7240:+	case AR71XX_SOC_AR7241:+	case AR71XX_SOC_AR7242:+		ret = ar724x_pcibios_map_irq(dev, slot, pin);+		break;++	default:+		break;+	}++	return ret;+}++int __init ar71xx_pci_init(unsigned nr_irqs, struct ar71xx_pci_irq *map)+{+	int ret = 0;++	switch (ar71xx_soc) {+	case AR71XX_SOC_AR7130:+	case AR71XX_SOC_AR7141:+	case AR71XX_SOC_AR7161:+		board_be_handler = ar71xx_be_handler;+		ret = ar71xx_pcibios_init();+		break;++	case AR71XX_SOC_AR7240:+	case AR71XX_SOC_AR7241:+	case AR71XX_SOC_AR7242:+		ret = ar724x_pcibios_init();+		break;++	default:+		return 0;+	}++	ar71xx_pci_nr_irqs = nr_irqs;+	ar71xx_pci_irq_map = map;++	return ret;+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/prom.c linux-2.6.37/arch/mips/ar71xx/prom.c--- linux-2.6.37.orig/arch/mips/ar71xx/prom.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/prom.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,105 @@+/*+ *  Atheros AR71xx SoC specific prom routines+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/kernel.h>+#include <linux/init.h>+#include <linux/io.h>+#include <linux/string.h>++#include <asm/bootinfo.h>+#include <asm/addrspace.h>++#include <asm/mach-ar71xx/ar71xx.h>++static inline int is_valid_ram_addr(void *addr)+{+	if (((u32) addr > KSEG0) &&+	    ((u32) addr < (KSEG0 + AR71XX_MEM_SIZE_MAX)))+		return 1;++	if (((u32) addr > KSEG1) &&+	    ((u32) addr < (KSEG1 + AR71XX_MEM_SIZE_MAX)))+		return 1;++	return 0;+}++static void __init ar71xx_prom_append_cmdline(const char *name,+					      const char *value)+{+	char buf[COMMAND_LINE_SIZE];++	snprintf(buf, sizeof(buf), " %s=%s", name, value);+	strlcat(arcs_cmdline, buf, sizeof(arcs_cmdline));+}++static void __init ar71xx_prom_find_env(char **envp, const char *name)+{+	int len = strlen(name);+	char **p;++	if (!is_valid_ram_addr(envp))+		return;++	for (p = envp; is_valid_ram_addr(*p); p++) {+		if (strncmp(name, *p, len) == 0 && (*p)[len] == '=') {+			ar71xx_prom_append_cmdline(name, *p + len + 1);+			break;+		}++		/* RedBoot env comes in pointer pairs - key, value */+		if (strncmp(name, *p, len) == 0 && (*p)[len] == 0)+			if (is_valid_ram_addr(*(++p))) {+				ar71xx_prom_append_cmdline(name, *p);+				break;+			}+	}+}++static int inline ar71xx_use__image_cmdline(void) { return 0; }++static __init void ar71xx_prom_init_cmdline(int argc, char **argv)+{+	int i;++	if (ar71xx_use__image_cmdline())+		return;++	if (!is_valid_ram_addr(argv))+		return;++	for (i = 0; i < argc; i++)+		if (is_valid_ram_addr(argv[i])) {+			strlcat(arcs_cmdline, " ", sizeof(arcs_cmdline));+			strlcat(arcs_cmdline, argv[i], sizeof(arcs_cmdline));+		}+}++void __init prom_init(void)+{+	char **envp;++	printk(KERN_DEBUG "prom: fw_arg0=%08x, fw_arg1=%08x, "+			"fw_arg2=%08x, fw_arg3=%08x\n",+			(unsigned int)fw_arg0, (unsigned int)fw_arg1,+			(unsigned int)fw_arg2, (unsigned int)fw_arg3);+++	ar71xx_prom_init_cmdline(fw_arg0, (char **)fw_arg1);++	envp = (char **)fw_arg2;+	ar71xx_prom_find_env(envp, "board");+}++void __init prom_free_prom_memory(void)+{+	/* We do not have to prom memory to free */+}diff -Nur linux-2.6.37.orig/arch/mips/ar71xx/setup.c linux-2.6.37/arch/mips/ar71xx/setup.c--- linux-2.6.37.orig/arch/mips/ar71xx/setup.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/ar71xx/setup.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,310 @@+/*+ *  Atheros AR71xx SoC specific setup+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Parts of this file are based on Atheros' 2.6.15 BSP+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/kernel.h>+#include <linux/init.h>+#include <linux/bootmem.h>++#include <asm/bootinfo.h>+#include <asm/time.h>		/* for mips_hpt_frequency */+#include <asm/reboot.h>		/* for _machine_{restart,halt} */+#include <asm/mips_machine.h>++#include <asm/mach-ar71xx/ar71xx.h>++#include "machtype.h"+#include "devices.h"++#define AR71XX_SYS_TYPE_LEN	64+#define AR71XX_BASE_FREQ	40000000+#define AR91XX_BASE_FREQ	5000000+#define AR724X_BASE_FREQ	5000000++u32 ar71xx_cpu_freq;+EXPORT_SYMBOL_GPL(ar71xx_cpu_freq);++u32 ar71xx_ahb_freq;+EXPORT_SYMBOL_GPL(ar71xx_ahb_freq);++u32 ar71xx_ddr_freq;+EXPORT_SYMBOL_GPL(ar71xx_ddr_freq);++enum ar71xx_soc_type ar71xx_soc;+EXPORT_SYMBOL_GPL(ar71xx_soc);++static char ar71xx_sys_type[AR71XX_SYS_TYPE_LEN];++static void ar71xx_restart(char *command)+{+	ar71xx_device_stop(RESET_MODULE_FULL_CHIP);+	for (;;)+		if (cpu_wait)+			cpu_wait();+}++static void ar71xx_halt(void)+{+	while (1)+		cpu_wait();+}++static void __init ar71xx_detect_mem_size(void)+{+	unsigned long size;++	for (size = AR71XX_MEM_SIZE_MIN; size < AR71XX_MEM_SIZE_MAX;+	     size <<= 1 ) {+		if (!memcmp(ar71xx_detect_mem_size,+			    ar71xx_detect_mem_size + size, 1024))+			break;+	}++	add_memory_region(0, size, BOOT_MEM_RAM);+}++static void __init ar71xx_detect_sys_type(void)+{+	char *chip = "????";+	u32 id;+	u32 major;+	u32 minor;+	u32 rev = 0;++	id = ar71xx_reset_rr(AR71XX_RESET_REG_REV_ID);+	major = id & REV_ID_MAJOR_MASK;++	switch (major) {+	case REV_ID_MAJOR_AR71XX:+		minor = id & AR71XX_REV_ID_MINOR_MASK;+		rev = id >> AR71XX_REV_ID_REVISION_SHIFT;+		rev &= AR71XX_REV_ID_REVISION_MASK;+		switch (minor) {+		case AR71XX_REV_ID_MINOR_AR7130:+			ar71xx_soc = AR71XX_SOC_AR7130;+			chip = "7130";+			break;++		case AR71XX_REV_ID_MINOR_AR7141:+			ar71xx_soc = AR71XX_SOC_AR7141;+			chip = "7141";+			break;++		case AR71XX_REV_ID_MINOR_AR7161:+			ar71xx_soc = AR71XX_SOC_AR7161;+			chip = "7161";+			break;+		}+		break;++	case REV_ID_MAJOR_AR7240:+		ar71xx_soc = AR71XX_SOC_AR7240;+		chip = "7240";+		rev = (id & AR724X_REV_ID_REVISION_MASK);+		break;++	case REV_ID_MAJOR_AR7241:+		ar71xx_soc = AR71XX_SOC_AR7241;+		chip = "7241";+		rev = (id & AR724X_REV_ID_REVISION_MASK);+		break;++	case REV_ID_MAJOR_AR7242:+		ar71xx_soc = AR71XX_SOC_AR7242;+		chip = "7242";+		rev = (id & AR724X_REV_ID_REVISION_MASK);+		break;++	case REV_ID_MAJOR_AR913X:+		minor = id & AR91XX_REV_ID_MINOR_MASK;+		rev = id >> AR91XX_REV_ID_REVISION_SHIFT;+		rev &= AR91XX_REV_ID_REVISION_MASK;+		switch (minor) {+		case AR91XX_REV_ID_MINOR_AR9130:+			ar71xx_soc = AR71XX_SOC_AR9130;+			chip = "9130";+			break;++		case AR91XX_REV_ID_MINOR_AR9132:+			ar71xx_soc = AR71XX_SOC_AR9132;+			chip = "9132";+			break;+		}+		break;++	default:+		panic("ar71xx: unknown chip id:0x%08x\n", id);+	}++	sprintf(ar71xx_sys_type, "Atheros AR%s rev %u", chip, rev);+}++static void __init ar91xx_detect_sys_frequency(void)+{+	u32 pll;+	u32 freq;+	u32 div;++	pll = ar71xx_pll_rr(AR91XX_PLL_REG_CPU_CONFIG);++	div = ((pll >> AR91XX_PLL_DIV_SHIFT) & AR91XX_PLL_DIV_MASK);+	freq = div * AR91XX_BASE_FREQ;++	ar71xx_cpu_freq = freq;++	div = ((pll >> AR91XX_DDR_DIV_SHIFT) & AR91XX_DDR_DIV_MASK) + 1;+	ar71xx_ddr_freq = freq / div;++	div = (((pll >> AR91XX_AHB_DIV_SHIFT) & AR91XX_AHB_DIV_MASK) + 1) * 2;+	ar71xx_ahb_freq = ar71xx_cpu_freq / div;+}++static void __init ar71xx_detect_sys_frequency(void)+{+	u32 pll;+	u32 freq;+	u32 div;++	pll = ar71xx_pll_rr(AR71XX_PLL_REG_CPU_CONFIG);++	div = ((pll >> AR71XX_PLL_DIV_SHIFT) & AR71XX_PLL_DIV_MASK) + 1;+	freq = div * AR71XX_BASE_FREQ;++	div = ((pll >> AR71XX_CPU_DIV_SHIFT) & AR71XX_CPU_DIV_MASK) + 1;+	ar71xx_cpu_freq = freq / div;++	div = ((pll >> AR71XX_DDR_DIV_SHIFT) & AR71XX_DDR_DIV_MASK) + 1;+	ar71xx_ddr_freq = freq / div;++	div = (((pll >> AR71XX_AHB_DIV_SHIFT) & AR71XX_AHB_DIV_MASK) + 1) * 2;+	ar71xx_ahb_freq = ar71xx_cpu_freq / div;+}++static void __init ar724x_detect_sys_frequency(void)+{+	u32 pll;+	u32 freq;+	u32 div;++	pll = ar71xx_pll_rr(AR724X_PLL_REG_CPU_CONFIG);++	div = ((pll >> AR724X_PLL_DIV_SHIFT) & AR724X_PLL_DIV_MASK);+	freq = div * AR724X_BASE_FREQ;++	div = ((pll >> AR724X_PLL_REF_DIV_SHIFT) & AR724X_PLL_REF_DIV_MASK);+	freq *= div;++	ar71xx_cpu_freq = freq;++	div = ((pll >> AR724X_DDR_DIV_SHIFT) & AR724X_DDR_DIV_MASK) + 1;+	ar71xx_ddr_freq = freq / div;++	div = (((pll >> AR724X_AHB_DIV_SHIFT) & AR724X_AHB_DIV_MASK) + 1) * 2;+	ar71xx_ahb_freq = ar71xx_cpu_freq / div;+}++static void __init detect_sys_frequency(void)+{+	switch (ar71xx_soc) {+	case AR71XX_SOC_AR7130:+	case AR71XX_SOC_AR7141:+	case AR71XX_SOC_AR7161:+		ar71xx_detect_sys_frequency();+		break;++	case AR71XX_SOC_AR7240:+	case AR71XX_SOC_AR7241:+	case AR71XX_SOC_AR7242:+		ar724x_detect_sys_frequency();+		break;++	case AR71XX_SOC_AR9130:+	case AR71XX_SOC_AR9132:+		ar91xx_detect_sys_frequency();+		break;++	default:+		BUG();+	}+}++const char *get_system_type(void)+{+	return ar71xx_sys_type;+}++unsigned int __cpuinit get_c0_compare_irq(void)+{+	return CP0_LEGACY_COMPARE_IRQ;+}++void __init plat_mem_setup(void)+{+	set_io_port_base(KSEG1);++	ar71xx_ddr_base = ioremap_nocache(AR71XX_DDR_CTRL_BASE,+						AR71XX_DDR_CTRL_SIZE);++	ar71xx_pll_base = ioremap_nocache(AR71XX_PLL_BASE,+						AR71XX_PLL_SIZE);++	ar71xx_reset_base = ioremap_nocache(AR71XX_RESET_BASE,+						AR71XX_RESET_SIZE);++	ar71xx_gpio_base = ioremap_nocache(AR71XX_GPIO_BASE, AR71XX_GPIO_SIZE);++	ar71xx_usb_ctrl_base = ioremap_nocache(AR71XX_USB_CTRL_BASE,+						AR71XX_USB_CTRL_SIZE);++	ar71xx_detect_mem_size();+	ar71xx_detect_sys_type();+	detect_sys_frequency();++	printk(KERN_INFO+		"%s, CPU:%u.%03u MHz, AHB:%u.%03u MHz, DDR:%u.%03u MHz\n",+		ar71xx_sys_type,+		ar71xx_cpu_freq / 1000000, (ar71xx_cpu_freq / 1000) % 1000,+		ar71xx_ahb_freq / 1000000, (ar71xx_ahb_freq / 1000) % 1000,+		ar71xx_ddr_freq / 1000000, (ar71xx_ddr_freq / 1000) % 1000);++	_machine_restart = ar71xx_restart;+	_machine_halt = ar71xx_halt;+	pm_power_off = ar71xx_halt;+}++void __init plat_time_init(void)+{+	mips_hpt_frequency = ar71xx_cpu_freq / 2;+}++__setup("board=", mips_machtype_setup);++static int __init ar71xx_machine_setup(void)+{+	ar71xx_gpio_init();++	ar71xx_add_device_uart();+	ar71xx_add_device_wdt();++	mips_machine_setup();+	return 0;+}++arch_initcall(ar71xx_machine_setup);++static void __init ar71xx_generic_init(void)+{+	/* Nothing to do */+}++MIPS_MACHINE(AR71XX_MACH_GENERIC, "Generic", "Generic AR71xx board",+	     ar71xx_generic_init);diff -Nur linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/ar71xx.h linux-2.6.37/arch/mips/include/asm/mach-ar71xx/ar71xx.h--- linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/ar71xx.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/include/asm/mach-ar71xx/ar71xx.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,514 @@+/*+ *  Atheros AR71xx SoC specific definitions+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Parts of this file are based on Atheros' 2.6.15 BSP+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef __ASM_MACH_AR71XX_H+#define __ASM_MACH_AR71XX_H++#include <linux/types.h>+#include <linux/init.h>+#include <linux/io.h>+#include <linux/bitops.h>++#ifndef __ASSEMBLER__++#define AR71XX_PCI_MEM_BASE	0x10000000+#define AR71XX_PCI_MEM_SIZE	0x08000000+#define AR71XX_APB_BASE		0x18000000+#define AR71XX_GE0_BASE		0x19000000+#define AR71XX_GE0_SIZE		0x01000000+#define AR71XX_GE1_BASE		0x1a000000+#define AR71XX_GE1_SIZE		0x01000000+#define AR71XX_EHCI_BASE	0x1b000000+#define AR71XX_EHCI_SIZE	0x01000000+#define AR71XX_OHCI_BASE	0x1c000000+#define AR71XX_OHCI_SIZE	0x01000000+#define AR7240_OHCI_BASE	0x1b000000+#define AR7240_OHCI_SIZE	0x01000000+#define AR71XX_SPI_BASE		0x1f000000+#define AR71XX_SPI_SIZE		0x01000000++#define AR71XX_DDR_CTRL_BASE	(AR71XX_APB_BASE + 0x00000000)+#define AR71XX_DDR_CTRL_SIZE	0x10000+#define AR71XX_CPU_BASE		(AR71XX_APB_BASE + 0x00010000)+#define AR71XX_UART_BASE	(AR71XX_APB_BASE + 0x00020000)+#define AR71XX_UART_SIZE	0x10000+#define AR71XX_USB_CTRL_BASE	(AR71XX_APB_BASE + 0x00030000)+#define AR71XX_USB_CTRL_SIZE	0x10000+#define AR71XX_GPIO_BASE	(AR71XX_APB_BASE + 0x00040000)+#define AR71XX_GPIO_SIZE	0x10000+#define AR71XX_PLL_BASE		(AR71XX_APB_BASE + 0x00050000)+#define AR71XX_PLL_SIZE		0x10000+#define AR71XX_RESET_BASE	(AR71XX_APB_BASE + 0x00060000)+#define AR71XX_RESET_SIZE	0x10000+#define AR71XX_MII_BASE		(AR71XX_APB_BASE + 0x00070000)+#define AR71XX_MII_SIZE		0x10000+#define AR71XX_SLIC_BASE	(AR71XX_APB_BASE + 0x00090000)+#define AR71XX_SLIC_SIZE	0x10000+#define AR71XX_DMA_BASE		(AR71XX_APB_BASE + 0x000A0000)+#define AR71XX_DMA_SIZE		0x10000+#define AR71XX_STEREO_BASE	(AR71XX_APB_BASE + 0x000B0000)+#define AR71XX_STEREO_SIZE	0x10000++#define AR724X_PCI_CRP_BASE	(AR71XX_APB_BASE + 0x000C0000)+#define AR724X_PCI_CRP_SIZE	0x100++#define AR724X_PCI_CTRL_BASE	(AR71XX_APB_BASE + 0x000F0000)+#define AR724X_PCI_CTRL_SIZE	0x100++#define AR91XX_WMAC_BASE	(AR71XX_APB_BASE + 0x000C0000)+#define AR91XX_WMAC_SIZE	0x30000++#define AR71XX_MEM_SIZE_MIN	0x0200000+#define AR71XX_MEM_SIZE_MAX	0x10000000++#define AR71XX_CPU_IRQ_BASE	0+#define AR71XX_MISC_IRQ_BASE	8+#define AR71XX_MISC_IRQ_COUNT	8+#define AR71XX_GPIO_IRQ_BASE	16+#define AR71XX_GPIO_IRQ_COUNT	32+#define AR71XX_PCI_IRQ_BASE     48+#define AR71XX_PCI_IRQ_COUNT	8++#define AR71XX_CPU_IRQ_IP2	(AR71XX_CPU_IRQ_BASE + 2)+#define AR71XX_CPU_IRQ_USB	(AR71XX_CPU_IRQ_BASE + 3)+#define AR71XX_CPU_IRQ_GE0	(AR71XX_CPU_IRQ_BASE + 4)+#define AR71XX_CPU_IRQ_GE1	(AR71XX_CPU_IRQ_BASE + 5)+#define AR71XX_CPU_IRQ_MISC	(AR71XX_CPU_IRQ_BASE + 6)+#define AR71XX_CPU_IRQ_TIMER	(AR71XX_CPU_IRQ_BASE + 7)++#define AR71XX_MISC_IRQ_TIMER	(AR71XX_MISC_IRQ_BASE + 0)+#define AR71XX_MISC_IRQ_ERROR	(AR71XX_MISC_IRQ_BASE + 1)+#define AR71XX_MISC_IRQ_GPIO	(AR71XX_MISC_IRQ_BASE + 2)+#define AR71XX_MISC_IRQ_UART	(AR71XX_MISC_IRQ_BASE + 3)+#define AR71XX_MISC_IRQ_WDOG	(AR71XX_MISC_IRQ_BASE + 4)+#define AR71XX_MISC_IRQ_PERFC	(AR71XX_MISC_IRQ_BASE + 5)+#define AR71XX_MISC_IRQ_OHCI	(AR71XX_MISC_IRQ_BASE + 6)+#define AR71XX_MISC_IRQ_DMA	(AR71XX_MISC_IRQ_BASE + 7)++#define AR71XX_GPIO_IRQ(_x)	(AR71XX_GPIO_IRQ_BASE + (_x))++#define AR71XX_PCI_IRQ_DEV0	(AR71XX_PCI_IRQ_BASE + 0)+#define AR71XX_PCI_IRQ_DEV1	(AR71XX_PCI_IRQ_BASE + 1)+#define AR71XX_PCI_IRQ_DEV2	(AR71XX_PCI_IRQ_BASE + 2)+#define AR71XX_PCI_IRQ_CORE	(AR71XX_PCI_IRQ_BASE + 4)++extern u32 ar71xx_ahb_freq;+extern u32 ar71xx_cpu_freq;+extern u32 ar71xx_ddr_freq;++enum ar71xx_soc_type {+	AR71XX_SOC_UNKNOWN,+	AR71XX_SOC_AR7130,+	AR71XX_SOC_AR7141,+	AR71XX_SOC_AR7161,+	AR71XX_SOC_AR7240,+	AR71XX_SOC_AR7241,+	AR71XX_SOC_AR7242,+	AR71XX_SOC_AR9130,+	AR71XX_SOC_AR9132+};++extern enum ar71xx_soc_type ar71xx_soc;++/*+ * PLL block+ */+#define AR71XX_PLL_REG_CPU_CONFIG	0x00+#define AR71XX_PLL_REG_SEC_CONFIG	0x04+#define AR71XX_PLL_REG_ETH0_INT_CLOCK	0x10+#define AR71XX_PLL_REG_ETH1_INT_CLOCK	0x14++#define AR71XX_PLL_DIV_SHIFT		3+#define AR71XX_PLL_DIV_MASK		0x1f+#define AR71XX_CPU_DIV_SHIFT		16+#define AR71XX_CPU_DIV_MASK		0x3+#define AR71XX_DDR_DIV_SHIFT		18+#define AR71XX_DDR_DIV_MASK		0x3+#define AR71XX_AHB_DIV_SHIFT		20+#define AR71XX_AHB_DIV_MASK		0x7++#define AR71XX_ETH0_PLL_SHIFT		17+#define AR71XX_ETH1_PLL_SHIFT		19++#define AR724X_PLL_REG_CPU_CONFIG	0x00+#define AR724X_PLL_REG_PCIE_CONFIG	0x18++#define AR724X_PLL_DIV_SHIFT		0+#define AR724X_PLL_DIV_MASK		0x3ff+#define AR724X_PLL_REF_DIV_SHIFT	10+#define AR724X_PLL_REF_DIV_MASK		0xf+#define AR724X_AHB_DIV_SHIFT		19+#define AR724X_AHB_DIV_MASK		0x1+#define AR724X_DDR_DIV_SHIFT		22+#define AR724X_DDR_DIV_MASK		0x3++#define AR91XX_PLL_REG_CPU_CONFIG	0x00+#define AR91XX_PLL_REG_ETH_CONFIG	0x04+#define AR91XX_PLL_REG_ETH0_INT_CLOCK	0x14+#define AR91XX_PLL_REG_ETH1_INT_CLOCK	0x18++#define AR91XX_PLL_DIV_SHIFT		0+#define AR91XX_PLL_DIV_MASK		0x3ff+#define AR91XX_DDR_DIV_SHIFT		22+#define AR91XX_DDR_DIV_MASK		0x3+#define AR91XX_AHB_DIV_SHIFT		19+#define AR91XX_AHB_DIV_MASK		0x1++#define AR91XX_ETH0_PLL_SHIFT		20+#define AR91XX_ETH1_PLL_SHIFT		22++extern void __iomem *ar71xx_pll_base;++static inline void ar71xx_pll_wr(unsigned reg, u32 val)+{+	__raw_writel(val, ar71xx_pll_base + reg);+}++static inline u32 ar71xx_pll_rr(unsigned reg)+{+	return __raw_readl(ar71xx_pll_base + reg);+}++/*+ * USB_CONFIG block+ */+#define USB_CTRL_REG_FLADJ	0x00+#define USB_CTRL_REG_CONFIG	0x04++extern void __iomem *ar71xx_usb_ctrl_base;++static inline void ar71xx_usb_ctrl_wr(unsigned reg, u32 val)+{+	__raw_writel(val, ar71xx_usb_ctrl_base + reg);+}++static inline u32 ar71xx_usb_ctrl_rr(unsigned reg)+{+	return __raw_readl(ar71xx_usb_ctrl_base + reg);+}++/*+ * GPIO block+ */+#define GPIO_REG_OE		0x00+#define GPIO_REG_IN		0x04+#define GPIO_REG_OUT		0x08+#define GPIO_REG_SET		0x0c+#define GPIO_REG_CLEAR		0x10+#define GPIO_REG_INT_MODE	0x14+#define GPIO_REG_INT_TYPE	0x18+#define GPIO_REG_INT_POLARITY	0x1c+#define GPIO_REG_INT_PENDING	0x20+#define GPIO_REG_INT_ENABLE	0x24+#define GPIO_REG_FUNC		0x28++#define AR71XX_GPIO_FUNC_STEREO_EN	BIT(17)+#define AR71XX_GPIO_FUNC_SLIC_EN	BIT(16)+#define AR71XX_GPIO_FUNC_SPI_CS2_EN	BIT(13)+#define AR71XX_GPIO_FUNC_SPI_CS1_EN	BIT(12)+#define AR71XX_GPIO_FUNC_UART_EN	BIT(8)+#define AR71XX_GPIO_FUNC_USB_OC_EN	BIT(4)+#define AR71XX_GPIO_FUNC_USB_CLK_EN	BIT(0)++#define AR71XX_GPIO_COUNT	16++#define AR724X_GPIO_FUNC_GE0_MII_CLK_EN		BIT(19)+#define AR724X_GPIO_FUNC_SPI_EN			BIT(18)+#define AR724X_GPIO_FUNC_SPI_CS_EN2		BIT(14)+#define AR724X_GPIO_FUNC_SPI_CS_EN1		BIT(13)+#define AR724X_GPIO_FUNC_CLK_OBS5_EN		BIT(12)+#define AR724X_GPIO_FUNC_CLK_OBS4_EN		BIT(11)+#define AR724X_GPIO_FUNC_CLK_OBS3_EN		BIT(10)+#define AR724X_GPIO_FUNC_CLK_OBS2_EN		BIT(9)+#define AR724X_GPIO_FUNC_CLK_OBS1_EN		BIT(8)+#define AR724X_GPIO_FUNC_ETH_SWITCH_LED4_EN	BIT(7)+#define AR724X_GPIO_FUNC_ETH_SWITCH_LED3_EN	BIT(6)+#define AR724X_GPIO_FUNC_ETH_SWITCH_LED2_EN	BIT(5)+#define AR724X_GPIO_FUNC_ETH_SWITCH_LED1_EN	BIT(4)+#define AR724X_GPIO_FUNC_ETH_SWITCH_LED0_EN	BIT(3)+#define AR724X_GPIO_FUNC_UART_RTS_CTS_EN	BIT(2)+#define AR724X_GPIO_FUNC_UART_EN		BIT(1)+#define AR724X_GPIO_FUNC_JTAG_DISABLE		BIT(0)++#define AR724X_GPIO_COUNT	18++#define AR91XX_GPIO_FUNC_WMAC_LED_EN	BIT(22)+#define AR91XX_GPIO_FUNC_EXP_PORT_CS_EN	BIT(21)+#define AR91XX_GPIO_FUNC_I2S_REFCLKEN	BIT(20)+#define AR91XX_GPIO_FUNC_I2S_MCKEN	BIT(19)+#define AR91XX_GPIO_FUNC_I2S1_EN	BIT(18)+#define AR91XX_GPIO_FUNC_I2S0_EN	BIT(17)+#define AR91XX_GPIO_FUNC_SLIC_EN	BIT(16)+#define AR91XX_GPIO_FUNC_UART_RTSCTS_EN	BIT(9)+#define AR91XX_GPIO_FUNC_UART_EN	BIT(8)+#define AR91XX_GPIO_FUNC_USB_CLK_EN	BIT(4)++#define AR91XX_GPIO_COUNT	22++extern void __iomem *ar71xx_gpio_base;++static inline void ar71xx_gpio_wr(unsigned reg, u32 value)+{+	__raw_writel(value, ar71xx_gpio_base + reg);+}++static inline u32 ar71xx_gpio_rr(unsigned reg)+{+	return __raw_readl(ar71xx_gpio_base + reg);+}++void ar71xx_gpio_init(void) __init;+void ar71xx_gpio_function_enable(u32 mask);+void ar71xx_gpio_function_disable(u32 mask);+void ar71xx_gpio_function_setup(u32 set, u32 clear);++/*+ * DDR_CTRL block+ */+#define AR71XX_DDR_REG_PCI_WIN0		0x7c+#define AR71XX_DDR_REG_PCI_WIN1		0x80+#define AR71XX_DDR_REG_PCI_WIN2		0x84+#define AR71XX_DDR_REG_PCI_WIN3		0x88+#define AR71XX_DDR_REG_PCI_WIN4		0x8c+#define AR71XX_DDR_REG_PCI_WIN5		0x90+#define AR71XX_DDR_REG_PCI_WIN6		0x94+#define AR71XX_DDR_REG_PCI_WIN7		0x98+#define AR71XX_DDR_REG_FLUSH_GE0	0x9c+#define AR71XX_DDR_REG_FLUSH_GE1	0xa0+#define AR71XX_DDR_REG_FLUSH_USB	0xa4+#define AR71XX_DDR_REG_FLUSH_PCI	0xa8++#define AR724X_DDR_REG_FLUSH_GE0	0x7c+#define AR724X_DDR_REG_FLUSH_GE1	0x80+#define AR724X_DDR_REG_FLUSH_USB	0x84+#define AR724X_DDR_REG_FLUSH_PCIE	0x88++#define AR91XX_DDR_REG_FLUSH_GE0	0x7c+#define AR91XX_DDR_REG_FLUSH_GE1	0x80+#define AR91XX_DDR_REG_FLUSH_USB	0x84+#define AR91XX_DDR_REG_FLUSH_WMAC	0x88++#define PCI_WIN0_OFFS	0x10000000+#define PCI_WIN1_OFFS	0x11000000+#define PCI_WIN2_OFFS	0x12000000+#define PCI_WIN3_OFFS	0x13000000+#define PCI_WIN4_OFFS	0x14000000+#define PCI_WIN5_OFFS	0x15000000+#define PCI_WIN6_OFFS	0x16000000+#define PCI_WIN7_OFFS	0x07000000++extern void __iomem *ar71xx_ddr_base;++static inline void ar71xx_ddr_wr(unsigned reg, u32 val)+{+	__raw_writel(val, ar71xx_ddr_base + reg);+}++static inline u32 ar71xx_ddr_rr(unsigned reg)+{+	return __raw_readl(ar71xx_ddr_base + reg);+}++void ar71xx_ddr_flush(u32 reg);++/*+ * PCI block+ */+#define AR71XX_PCI_CFG_BASE	(AR71XX_PCI_MEM_BASE + PCI_WIN7_OFFS + 0x10000)+#define AR71XX_PCI_CFG_SIZE	0x100++#define PCI_REG_CRP_AD_CBE	0x00+#define PCI_REG_CRP_WRDATA	0x04+#define PCI_REG_CRP_RDDATA	0x08+#define PCI_REG_CFG_AD		0x0c+#define PCI_REG_CFG_CBE		0x10+#define PCI_REG_CFG_WRDATA	0x14+#define PCI_REG_CFG_RDDATA	0x18+#define PCI_REG_PCI_ERR		0x1c+#define PCI_REG_PCI_ERR_ADDR	0x20+#define PCI_REG_AHB_ERR		0x24+#define PCI_REG_AHB_ERR_ADDR	0x28++#define PCI_CRP_CMD_WRITE	0x00010000+#define PCI_CRP_CMD_READ	0x00000000+#define PCI_CFG_CMD_READ	0x0000000a+#define PCI_CFG_CMD_WRITE	0x0000000b++#define PCI_IDSEL_ADL_START	17++#define AR724X_PCI_CFG_BASE	(AR71XX_PCI_MEM_BASE + 0x4000000)+#define AR724X_PCI_CFG_SIZE	0x1000++#define AR724X_PCI_REG_APP		0x00+#define AR724X_PCI_REG_RESET		0x18+#define AR724X_PCI_REG_INT_STATUS	0x4c+#define AR724X_PCI_REG_INT_MASK		0x50++#define AR724X_PCI_APP_LTSSM_ENABLE	BIT(0)+#define AR724X_PCI_RESET_LINK_UP	BIT(0)++#define AR724X_PCI_INT_DEV0		BIT(14)++/*+ * RESET block+ */+#define AR71XX_RESET_REG_TIMER			0x00+#define AR71XX_RESET_REG_TIMER_RELOAD		0x04+#define AR71XX_RESET_REG_WDOG_CTRL		0x08+#define AR71XX_RESET_REG_WDOG			0x0c+#define AR71XX_RESET_REG_MISC_INT_STATUS	0x10+#define AR71XX_RESET_REG_MISC_INT_ENABLE	0x14+#define AR71XX_RESET_REG_PCI_INT_STATUS		0x18+#define AR71XX_RESET_REG_PCI_INT_ENABLE		0x1c+#define AR71XX_RESET_REG_GLOBAL_INT_STATUS	0x20+#define AR71XX_RESET_REG_RESET_MODULE		0x24+#define AR71XX_RESET_REG_PERFC_CTRL		0x2c+#define AR71XX_RESET_REG_PERFC0			0x30+#define AR71XX_RESET_REG_PERFC1			0x34+#define AR71XX_RESET_REG_REV_ID			0x90++#define AR91XX_RESET_REG_GLOBAL_INT_STATUS	0x18+#define AR91XX_RESET_REG_RESET_MODULE		0x1c+#define AR91XX_RESET_REG_PERF_CTRL		0x20+#define AR91XX_RESET_REG_PERFC0			0x24+#define AR91XX_RESET_REG_PERFC1			0x28++#define AR724X_RESET_REG_RESET_MODULE		0x1c++#define WDOG_CTRL_LAST_RESET		BIT(31)+#define WDOG_CTRL_ACTION_MASK		3+#define WDOG_CTRL_ACTION_NONE		0	/* no action */+#define WDOG_CTRL_ACTION_GPI		1	/* general purpose interrupt */+#define WDOG_CTRL_ACTION_NMI		2	/* NMI */+#define WDOG_CTRL_ACTION_FCR		3	/* full chip reset */++#define MISC_INT_DMA			BIT(7)+#define MISC_INT_OHCI			BIT(6)+#define MISC_INT_PERFC			BIT(5)+#define MISC_INT_WDOG			BIT(4)+#define MISC_INT_UART			BIT(3)+#define MISC_INT_GPIO			BIT(2)+#define MISC_INT_ERROR			BIT(1)+#define MISC_INT_TIMER			BIT(0)++#define PCI_INT_CORE			BIT(4)+#define PCI_INT_DEV2			BIT(2)+#define PCI_INT_DEV1			BIT(1)+#define PCI_INT_DEV0			BIT(0)++#define RESET_MODULE_EXTERNAL		BIT(28)+#define RESET_MODULE_FULL_CHIP		BIT(24)+#define RESET_MODULE_AMBA2WMAC		BIT(22)+#define RESET_MODULE_CPU_NMI		BIT(21)+#define RESET_MODULE_CPU_COLD		BIT(20)+#define RESET_MODULE_DMA		BIT(19)+#define RESET_MODULE_SLIC		BIT(18)+#define RESET_MODULE_STEREO		BIT(17)+#define RESET_MODULE_DDR		BIT(16)+#define RESET_MODULE_GE1_MAC		BIT(13)+#define RESET_MODULE_GE1_PHY		BIT(12)+#define RESET_MODULE_USBSUS_OVERRIDE	BIT(10)+#define RESET_MODULE_GE0_MAC		BIT(9)+#define RESET_MODULE_GE0_PHY		BIT(8)+#define RESET_MODULE_USB_OHCI_DLL	BIT(6)+#define RESET_MODULE_USB_HOST		BIT(5)+#define RESET_MODULE_USB_PHY		BIT(4)+#define RESET_MODULE_USB_OHCI_DLL_7240	BIT(3)+#define RESET_MODULE_PCI_BUS		BIT(1)+#define RESET_MODULE_PCI_CORE		BIT(0)++#define AR724X_RESET_GE1_MDIO		BIT(23)+#define AR724X_RESET_GE0_MDIO		BIT(22)+#define AR724X_RESET_PCIE_PHY_SERIAL	BIT(10)+#define AR724X_RESET_PCIE_PHY		BIT(7)+#define AR724X_RESET_PCIE		BIT(6)++#define REV_ID_MAJOR_MASK	0xfff0+#define REV_ID_MAJOR_AR71XX	0x00a0+#define REV_ID_MAJOR_AR913X	0x00b0+#define REV_ID_MAJOR_AR7240	0x00c0+#define REV_ID_MAJOR_AR7241	0x0100+#define REV_ID_MAJOR_AR7242	0x1100++#define AR71XX_REV_ID_MINOR_MASK	0x3+#define AR71XX_REV_ID_MINOR_AR7130	0x0+#define AR71XX_REV_ID_MINOR_AR7141	0x1+#define AR71XX_REV_ID_MINOR_AR7161	0x2+#define AR71XX_REV_ID_REVISION_MASK	0x3+#define AR71XX_REV_ID_REVISION_SHIFT	2++#define AR91XX_REV_ID_MINOR_MASK	0x3+#define AR91XX_REV_ID_MINOR_AR9130	0x0+#define AR91XX_REV_ID_MINOR_AR9132	0x1+#define AR91XX_REV_ID_REVISION_MASK	0x3+#define AR91XX_REV_ID_REVISION_SHIFT	2++#define AR724X_REV_ID_REVISION_MASK	0x3++extern void __iomem *ar71xx_reset_base;++static inline void ar71xx_reset_wr(unsigned reg, u32 val)+{+	__raw_writel(val, ar71xx_reset_base + reg);+}++static inline u32 ar71xx_reset_rr(unsigned reg)+{+	return __raw_readl(ar71xx_reset_base + reg);+}++void ar71xx_device_stop(u32 mask);+void ar71xx_device_start(u32 mask);+int ar71xx_device_stopped(u32 mask);++/*+ * SPI block+ */+#define SPI_REG_FS		0x00	/* Function Select */+#define SPI_REG_CTRL		0x04	/* SPI Control */+#define SPI_REG_IOC		0x08	/* SPI I/O Control */+#define SPI_REG_RDS		0x0c	/* Read Data Shift */++#define SPI_FS_GPIO		BIT(0)	/* Enable GPIO mode */++#define SPI_CTRL_RD		BIT(6)	/* Remap Disable */+#define SPI_CTRL_DIV_MASK	0x3f++#define SPI_IOC_DO		BIT(0)	/* Data Out pin */+#define SPI_IOC_CLK		BIT(8)	/* CLK pin */+#define SPI_IOC_CS(n)		BIT(16 + (n))+#define SPI_IOC_CS0		SPI_IOC_CS(0)+#define SPI_IOC_CS1		SPI_IOC_CS(1)+#define SPI_IOC_CS2		SPI_IOC_CS(2)+#define SPI_IOC_CS_ALL		(SPI_IOC_CS0 | SPI_IOC_CS1 | SPI_IOC_CS2)++void ar71xx_flash_acquire(void);+void ar71xx_flash_release(void);++/*+ * MII_CTRL block+ */+#define MII_REG_MII0_CTRL	0x00+#define MII_REG_MII1_CTRL	0x04++#define MII0_CTRL_IF_GMII	0+#define MII0_CTRL_IF_MII	1+#define MII0_CTRL_IF_RGMII	2+#define MII0_CTRL_IF_RMII	3++#define MII1_CTRL_IF_RGMII	0+#define MII1_CTRL_IF_RMII	1++#endif /* __ASSEMBLER__ */++#endif /* __ASM_MACH_AR71XX_H */diff -Nur linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/ar91xx_flash.h linux-2.6.37/arch/mips/include/asm/mach-ar71xx/ar91xx_flash.h--- linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/ar91xx_flash.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/include/asm/mach-ar71xx/ar91xx_flash.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,26 @@+/*+ *  AR91xx parallel flash driver platform data definitions+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef __AR91XX_FLASH_H+#define __AR91XX_FLASH_H++struct mtd_partition;++struct ar91xx_flash_platform_data {+	unsigned int		width;+	u8			is_shared:1;+#ifdef CONFIG_MTD_PARTITIONS+	unsigned int		nr_parts;+	struct mtd_partition	*parts;+#endif+};++#endif /* __AR91XX_FLASH_H */diff -Nur linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/cpu-feature-overrides.h linux-2.6.37/arch/mips/include/asm/mach-ar71xx/cpu-feature-overrides.h--- linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/cpu-feature-overrides.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/include/asm/mach-ar71xx/cpu-feature-overrides.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,56 @@+/*+ *  Atheros AR71xx specific CPU feature overrides+ *+ *  Copyright (C) 2008 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This file was derived from: include/asm-mips/cpu-features.h+ *	Copyright (C) 2003, 2004 Ralf Baechle+ *	Copyright (C) 2004 Maciej W. Rozycki+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ *+ */+#ifndef __ASM_MACH_AR71XX_CPU_FEATURE_OVERRIDES_H+#define __ASM_MACH_AR71XX_CPU_FEATURE_OVERRIDES_H++#define cpu_has_tlb		1+#define cpu_has_4kex		1+#define cpu_has_3k_cache	0+#define cpu_has_4k_cache	1+#define cpu_has_tx39_cache	0+#define cpu_has_sb1_cache	0+#define cpu_has_fpu		0+#define cpu_has_32fpr		0+#define cpu_has_counter		1+#define cpu_has_watch		1+#define cpu_has_divec		1++#define cpu_has_prefetch	1+#define cpu_has_ejtag		1+#define cpu_has_llsc		1++#define cpu_has_mips16		1+#define cpu_has_mdmx		0+#define cpu_has_mips3d		0+#define cpu_has_smartmips	0++#define cpu_has_mips32r1	1+#define cpu_has_mips32r2	1+#define cpu_has_mips64r1	0+#define cpu_has_mips64r2	0++#define cpu_has_dsp		0+#define cpu_has_mipsmt		0++#define cpu_has_64bits		0+#define cpu_has_64bit_zero_reg	0+#define cpu_has_64bit_gp_regs	0+#define cpu_has_64bit_addresses	0++#define cpu_dcache_line_size()	32+#define cpu_icache_line_size()	32++#endif /* __ASM_MACH_AR71XX_CPU_FEATURE_OVERRIDES_H */diff -Nur linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/gpio.h linux-2.6.37/arch/mips/include/asm/mach-ar71xx/gpio.h--- linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/gpio.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/include/asm/mach-ar71xx/gpio.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,53 @@+/*+ *  Atheros AR71xx GPIO API definitions+ *+ *  Copyright (C) 2008 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ *+ */++#ifndef __ASM_MACH_AR71XX_GPIO_H+#define __ASM_MACH_AR71XX_GPIO_H++#define ARCH_NR_GPIOS	64+#include <asm-generic/gpio.h>++#include <asm/mach-ar71xx/ar71xx.h>++extern unsigned long ar71xx_gpio_count;+extern void __ar71xx_gpio_set_value(unsigned gpio, int value);+extern int __ar71xx_gpio_get_value(unsigned gpio);++static inline int gpio_to_irq(unsigned gpio)+{+	return AR71XX_GPIO_IRQ(gpio);+}++static inline int irq_to_gpio(unsigned irq)+{+	return irq - AR71XX_GPIO_IRQ_BASE;+}++static inline int gpio_get_value(unsigned gpio)+{+	if (gpio < ar71xx_gpio_count)+		return __ar71xx_gpio_get_value(gpio);++	return __gpio_get_value(gpio);+}++static inline void gpio_set_value(unsigned gpio, int value)+{+	if (gpio < ar71xx_gpio_count)+		__ar71xx_gpio_set_value(gpio, value);+	else+		__gpio_set_value(gpio, value);+}++#define gpio_cansleep	__gpio_cansleep++#endif /* __ASM_MACH_AR71XX_GPIO_H */diff -Nur linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/irq.h linux-2.6.37/arch/mips/include/asm/mach-ar71xx/irq.h--- linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/irq.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/include/asm/mach-ar71xx/irq.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,17 @@+/*+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */+#ifndef __ASM_MACH_AR71XX_IRQ_H+#define __ASM_MACH_AR71XX_IRQ_H++#define MIPS_CPU_IRQ_BASE	0+#define NR_IRQS			56++#include_next <irq.h>++#endif /* __ASM_MACH_AR71XX_IRQ_H */diff -Nur linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/kernel-entry-init.h linux-2.6.37/arch/mips/include/asm/mach-ar71xx/kernel-entry-init.h--- linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/kernel-entry-init.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/include/asm/mach-ar71xx/kernel-entry-init.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,32 @@+/*+ *  Atheros AR71xx specific kernel entry setup+ *+ *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ *+ */+#ifndef __ASM_MACH_AR71XX_KERNEL_ENTRY_H+#define __ASM_MACH_AR71XX_KERNEL_ENTRY_H++	/*+	 * Some bootloaders set the 'Kseg0 coherency algorithm' to+	 * 'Cacheable, noncoherent, write-through, no write allocate'+	 * and this cause performance issues. Let's go and change it to+	 * 'Cacheable, noncoherent, write-back, write allocate'+	 */+	.macro	kernel_entry_setup+	mfc0	t0, CP0_CONFIG+	li	t1, ~CONF_CM_CMASK+	and	t0, t1+	ori	t0, CONF_CM_CACHABLE_NONCOHERENT+	mtc0	t0, CP0_CONFIG+	nop+	.endm++	.macro	smp_slave_setup+	.endm++#endif /* __ASM_MACH_AR71XX_KERNEL_ENTRY_H */diff -Nur linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/mach-rb750.h linux-2.6.37/arch/mips/include/asm/mach-ar71xx/mach-rb750.h--- linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/mach-rb750.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/include/asm/mach-ar71xx/mach-rb750.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,66 @@+/*+ *  MikroTik RouterBOARD 750 definitions+ *+ *  Copyright (C) 2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */+#ifndef _MACH_RB750_H+#define _MACH_RB750_H++#include <linux/bitops.h>++#define RB750_GPIO_LVC573_LE	0	/* Latch enable on LVC573 */+#define RB750_GPIO_NAND_IO0	1	/* NAND I/O 0 */+#define RB750_GPIO_NAND_IO1	2	/* NAND I/O 1 */+#define RB750_GPIO_NAND_IO2	3	/* NAND I/O 2 */+#define RB750_GPIO_NAND_IO3	4	/* NAND I/O 3 */+#define RB750_GPIO_NAND_IO4	5	/* NAND I/O 4 */+#define RB750_GPIO_NAND_IO5	6	/* NAND I/O 5 */+#define RB750_GPIO_NAND_IO6	7	/* NAND I/O 6 */+#define RB750_GPIO_NAND_IO7	8	/* NAND I/O 7 */+#define RB750_GPIO_NAND_NCE	11	/* NAND Chip Enable (active low) */+#define RB750_GPIO_NAND_RDY	12	/* NAND Ready */+#define RB750_GPIO_NAND_CLE	14	/* NAND Command Latch Enable */+#define RB750_GPIO_NAND_ALE	15	/* NAND Address Latch Enable */+#define RB750_GPIO_NAND_NRE	16	/* NAND Read Enable (active low) */+#define RB750_GPIO_NAND_NWE	17	/* NAND Write Enable (active low) */++#define RB750_GPIO_BTN_RESET	1+#define RB750_GPIO_SPI_CS0	2+#define RB750_GPIO_LED_ACT	12+#define RB750_GPIO_LED_PORT1	13+#define RB750_GPIO_LED_PORT2	14+#define RB750_GPIO_LED_PORT3	15+#define RB750_GPIO_LED_PORT4	16+#define RB750_GPIO_LED_PORT5	17++#define RB750_LED_ACT		BIT(RB750_GPIO_LED_ACT)+#define RB750_LED_PORT1		BIT(RB750_GPIO_LED_PORT1)+#define RB750_LED_PORT2		BIT(RB750_GPIO_LED_PORT2)+#define RB750_LED_PORT3		BIT(RB750_GPIO_LED_PORT3)+#define RB750_LED_PORT4		BIT(RB750_GPIO_LED_PORT4)+#define RB750_LED_PORT5		BIT(RB750_GPIO_LED_PORT5)++#define RB750_LVC573_LE		BIT(RB750_GPIO_LVC573_LE)++#define RB750_LED_BITS	(RB750_LED_PORT1 | RB750_LED_PORT2 | RB750_LED_PORT3 | \+			 RB750_LED_PORT4 | RB750_LED_PORT5 | RB750_LED_ACT)++struct rb750_led_data {+	char	*name;+	char	*default_trigger;+	u32	mask;+	int	active_low;+};++struct rb750_led_platform_data {+	int			num_leds;+	struct rb750_led_data	*leds;+};++int rb750_latch_change(u32 mask_clr, u32 mask_set);++#endif /* _MACH_RB750_H */\ No newline at end of filediff -Nur linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/mangle-port.h linux-2.6.37/arch/mips/include/asm/mach-ar71xx/mangle-port.h--- linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/mangle-port.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/include/asm/mach-ar71xx/mangle-port.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,45 @@+/*+ *  Copyright (C) 2008 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This file was derived from: inlude/asm-mips/mach-generic/mangle-port.h+ * 	Copyright (C) 2003, 2004 Ralf Baechle+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef __ASM_MACH_AR71XX_MANGLE_PORT_H+#define __ASM_MACH_AR71XX_MANGLE_PORT_H++#define __swizzle_addr_b(port)	((port) ^ 3)+#define __swizzle_addr_w(port)	((port) ^ 2)+#define __swizzle_addr_l(port)	(port)+#define __swizzle_addr_q(port)	(port)++#if defined(CONFIG_SWAP_IO_SPACE)++# define ioswabb(a, x)           (x)+# define __mem_ioswabb(a, x)     (x)+# define ioswabw(a, x)           le16_to_cpu(x)+# define __mem_ioswabw(a, x)     (x)+# define ioswabl(a, x)           le32_to_cpu(x)+# define __mem_ioswabl(a, x)     (x)+# define ioswabq(a, x)           le64_to_cpu(x)+# define __mem_ioswabq(a, x)     (x)++#else++# define ioswabb(a, x)           (x)+# define __mem_ioswabb(a, x)     (x)+# define ioswabw(a, x)           (x)+# define __mem_ioswabw(a, x)     cpu_to_le16(x)+# define ioswabl(a, x)           (x)+# define __mem_ioswabl(a, x)     cpu_to_le32(x)+# define ioswabq(a, x)           (x)+# define __mem_ioswabq(a, x)     cpu_to_le64(x)++#endif++#endif /* __ASM_MACH_AR71XX_MANGLE_PORT_H */diff -Nur linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/pci.h linux-2.6.37/arch/mips/include/asm/mach-ar71xx/pci.h--- linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/pci.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/include/asm/mach-ar71xx/pci.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,39 @@+/*+ *  Atheros AR71xx SoC specific PCI definitions+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef __ASM_MACH_AR71XX_PCI_H+#define __ASM_MACH_AR71XX_PCI_H++struct pci_dev;++struct ar71xx_pci_irq {+	int	irq;+	u8	slot;+	u8	pin;+};++extern int (*ar71xx_pci_plat_dev_init)(struct pci_dev *dev);+extern unsigned ar71xx_pci_nr_irqs __initdata;+extern struct ar71xx_pci_irq *ar71xx_pci_irq_map __initdata;++int ar71xx_pcibios_map_irq(const struct pci_dev *dev,+			   uint8_t slot, uint8_t pin) __init;+int ar71xx_pcibios_init(void) __init;++int ar71xx_pci_be_handler(int is_fixup);++int ar724x_pcibios_map_irq(const struct pci_dev *dev,+			   uint8_t slot, uint8_t pin) __init;+int ar724x_pcibios_init(void) __init;++int ar71xx_pci_init(unsigned nr_irqs, struct ar71xx_pci_irq *map) __init;++#endif /* __ASM_MACH_AR71XX_PCI_H */diff -Nur linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/platform.h linux-2.6.37/arch/mips/include/asm/mach-ar71xx/platform.h--- linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/platform.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/include/asm/mach-ar71xx/platform.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,61 @@+/*+ *  Atheros AR71xx SoC specific platform data definitions+ *+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef __ASM_MACH_AR71XX_PLATFORM_H+#define __ASM_MACH_AR71XX_PLATFORM_H++#include <linux/if_ether.h>+#include <linux/skbuff.h>+#include <linux/phy.h>+#include <linux/spi/spi.h>++struct ag71xx_platform_data {+	phy_interface_t	phy_if_mode;+	u32		phy_mask;+	int		speed;+	int		duplex;+	u32		reset_bit;+	u32		mii_if;+	u8		mac_addr[ETH_ALEN];+	struct device	*mii_bus_dev;++	u8		has_gbit:1;+	u8		is_ar91xx:1;+	u8		is_ar724x:1;+	u8		has_ar8216:1;++	void		(* ddr_flush)(void);+	void		(* set_pll)(int speed);++	u32		fifo_cfg1;+	u32		fifo_cfg2;+	u32		fifo_cfg3;+};++struct ag71xx_mdio_platform_data {+	u32		phy_mask;+	int		is_ar7240;+};++struct ar71xx_ehci_platform_data {+	u8		is_ar91xx;+};++struct ar71xx_spi_platform_data {+	unsigned	bus_num;+	unsigned	num_chipselect;+	u32		(*get_ioc_base)(u8 chip_select, int cs_high, int is_on);+};++#define AR71XX_SPI_CS_INACTIVE	0+#define AR71XX_SPI_CS_ACTIVE	1++#endif /* __ASM_MACH_AR71XX_PLATFORM_H */diff -Nur linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/war.h linux-2.6.37/arch/mips/include/asm/mach-ar71xx/war.h--- linux-2.6.37.orig/arch/mips/include/asm/mach-ar71xx/war.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/include/asm/mach-ar71xx/war.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,25 @@+/*+ * This file is subject to the terms and conditions of the GNU General Public+ * License.  See the file "COPYING" in the main directory of this archive+ * for more details.+ *+ * Copyright (C) 2002, 2004, 2007 by Ralf Baechle <ralf@linux-mips.org>+ */+#ifndef __ASM_MACH_AR71XX_WAR_H+#define __ASM_MACH_AR71XX_WAR_H++#define R4600_V1_INDEX_ICACHEOP_WAR	0+#define R4600_V1_HIT_CACHEOP_WAR	0+#define R4600_V2_HIT_CACHEOP_WAR	0+#define R5432_CP0_INTERRUPT_WAR		0+#define BCM1250_M3_WAR			0+#define SIBYTE_1956_WAR			0+#define MIPS4K_ICACHE_REFILL_WAR	0+#define MIPS_CACHE_SYNC_WAR		0+#define TX49XX_ICACHE_INDEX_INV_WAR	0+#define RM9000_CDEX_SMP_WAR		0+#define ICACHE_REFILLS_WORKAROUND_WAR	0+#define R10000_LLSC_WAR			0+#define MIPS34K_MISSED_ITLB_WAR		0++#endif /* __ASM_MACH_AR71XX_WAR_H */diff -Nur linux-2.6.37.orig/arch/mips/include/asm/mips_machine.h linux-2.6.37/arch/mips/include/asm/mips_machine.h--- linux-2.6.37.orig/arch/mips/include/asm/mips_machine.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/include/asm/mips_machine.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,54 @@+/*+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ *+ */++#ifndef __ASM_MIPS_MACHINE_H+#define __ASM_MIPS_MACHINE_H++#include <linux/init.h>+#include <linux/list.h>++#include <asm/bootinfo.h>++struct mips_machine {+	unsigned long		mach_type;+	char			*mach_id;+	char			*mach_name;+	void			(*mach_setup)(void);+	struct list_head	list;+};++void mips_machine_register(struct mips_machine *) __init;+void mips_machine_setup(void) __init;+int  mips_machtype_setup(char *id) __init;+void mips_machine_set_name(char *name) __init;++extern char *mips_machine_name;++#define MIPS_MACHINE(_type, _id, _name, _setup) 		\+static const char machine_name_##_type[] __initconst		\+			__aligned(1) = _name;			\+static const char machine_id_##_type[] __initconst		\+			__aligned(1) = _id;			\+static struct mips_machine machine_##_type __initdata =		\+{								\+	.mach_type	= _type,				\+	.mach_id	= (char *) machine_id_##_type,		\+	.mach_name	= (char *) machine_name_##_type,	\+	.mach_setup	= _setup,				\+};								\+								\+static int __init register_machine_##_type(void)		\+{								\+	mips_machine_register(&machine_##_type);		\+	return 0;						\+}								\+								\+pure_initcall(register_machine_##_type)++#endif /* __ASM_MIPS_MACHINE_H */diff -Nur linux-2.6.37.orig/arch/mips/include/asm/time.h linux-2.6.37/arch/mips/include/asm/time.h--- linux-2.6.37.orig/arch/mips/include/asm/time.h	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/arch/mips/include/asm/time.h	2011-01-11 20:25:48.000000000 +0100@@ -52,6 +52,7 @@  */ #ifdef CONFIG_CEVT_R4K_LIB extern unsigned int __weak get_c0_compare_int(void);+extern unsigned int __weak get_c0_compare_irq(void); extern int r4k_clockevent_init(void); #endif diff -Nur linux-2.6.37.orig/arch/mips/kernel/Makefile linux-2.6.37/arch/mips/kernel/Makefile--- linux-2.6.37.orig/arch/mips/kernel/Makefile	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/arch/mips/kernel/Makefile	2011-01-11 20:25:48.000000000 +0100@@ -94,6 +94,7 @@  obj-$(CONFIG_KEXEC)		+= machine_kexec.o relocate_kernel.o obj-$(CONFIG_EARLY_PRINTK)	+= early_printk.o+obj-$(CONFIG_MIPS_MACHINE)	+= mips_machine.o obj-$(CONFIG_SPINLOCK_TEST)	+= spinlock_test.o  obj-$(CONFIG_OF)		+= prom.odiff -Nur linux-2.6.37.orig/arch/mips/kernel/mips_machine.c linux-2.6.37/arch/mips/kernel/mips_machine.c--- linux-2.6.37.orig/arch/mips/kernel/mips_machine.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/kernel/mips_machine.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,121 @@+/*+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ *+ */+#include <linux/mm.h>+#include <linux/slab.h>+#include <linux/string.h>++#include <asm/mips_machine.h>++static struct list_head mips_machines __initdata =+		LIST_HEAD_INIT(mips_machines);+static char *mips_machid __initdata;++char *mips_machine_name = "Unknown";++static struct mips_machine * __init mips_machine_find(unsigned long machtype)+{+	struct list_head *this;++	list_for_each(this, &mips_machines) {+		struct mips_machine *mach;++		mach = list_entry(this, struct mips_machine, list);+		if (mach->mach_type == machtype)+			return mach;+	}++	return NULL;+}++void __init mips_machine_register(struct mips_machine *mach)+{+	list_add_tail(&mach->list, &mips_machines);+}++void __init mips_machine_set_name(char *name)+{+	unsigned int len;+	char *p;++	if (name == NULL)+		return;++	len = strlen(name);+	p = kmalloc(len + 1, GFP_KERNEL);+	if (p) {+		strncpy(p, name, len);+		p[len] = '\0';+		mips_machine_name = p;+	} else {+		printk(KERN_WARNING "MIPS: no memory for machine_name\n");+	}+}++void __init mips_machine_setup(void)+{+	struct mips_machine *mach;++	mach = mips_machine_find(mips_machtype);+	if (!mach) {+		printk(KERN_WARNING "MIPS: no machine registered for "+			"machtype %lu\n", mips_machtype);+		return;+	}++	mips_machine_set_name(mach->mach_name);+	printk(KERN_NOTICE "MIPS: machine is %s\n", mips_machine_name);++	if (mach->mach_setup)+		mach->mach_setup();+}++int __init mips_machtype_setup(char *id)+{+	if (mips_machid == NULL)+		mips_machid = id;++	return 1;+}++__setup("machtype=", mips_machtype_setup);++static int __init mips_machtype_init(void)+{+	struct list_head *this;+	struct mips_machine *mach;++	if (mips_machid == NULL)+		return 0;++	list_for_each(this, &mips_machines) {+		mach = list_entry(this, struct mips_machine, list);+		if (mach->mach_id == NULL)+			continue;++		if (strcmp(mach->mach_id, mips_machid) == 0) {+			mips_machtype = mach->mach_type;+			return 0;+		}+	}++	printk(KERN_WARNING+	       "MIPS: no machine found for id: '%s', registered machines:\n",+	       mips_machid);+	printk(KERN_WARNING "%32s %s\n", "id", "name");++	list_for_each(this, &mips_machines) {+		mach = list_entry(this, struct mips_machine, list);+		printk(KERN_WARNING "%32s %s\n",+		       mach->mach_id ? mach->mach_id : "", mach->mach_name);+	}++	return 0;+}++core_initcall(mips_machtype_init);diff -Nur linux-2.6.37.orig/arch/mips/kernel/proc.c linux-2.6.37/arch/mips/kernel/proc.c--- linux-2.6.37.orig/arch/mips/kernel/proc.c	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/arch/mips/kernel/proc.c	2011-01-11 20:25:48.000000000 +0100@@ -12,6 +12,7 @@ #include <asm/cpu-features.h> #include <asm/mipsregs.h> #include <asm/processor.h>+#include <asm/mips_machine.h>  unsigned int vced_count, vcei_count; @@ -31,8 +32,12 @@ 	/* 	 * For the first processor also print the system type 	 */-	if (n == 0)+	if (n == 0) { 		seq_printf(m, "system type\t\t: %s\n", get_system_type());+#ifdef CONFIG_MIPS_MACHINE+		seq_printf(m, "machine\t\t\t: %s\n", mips_machine_name);+#endif+	}  	seq_printf(m, "processor\t\t: %ld\n", n); 	sprintf(fmt, "cpu model\t\t: %%s V%%d.%%d%s\n",diff -Nur linux-2.6.37.orig/arch/mips/kernel/traps.c linux-2.6.37/arch/mips/kernel/traps.c--- linux-2.6.37.orig/arch/mips/kernel/traps.c	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/arch/mips/kernel/traps.c	2011-01-11 20:26:51.000000000 +0100@@ -46,6 +46,7 @@ #include <asm/ptrace.h> #include <asm/sections.h> #include <asm/system.h>+#include <asm/time.h> #include <asm/tlbdebug.h> #include <asm/traps.h> #include <asm/uaccess.h>@@ -1578,6 +1579,8 @@ 	if (cpu_has_mips_r2) { 		cp0_compare_irq_shift = CAUSEB_TI - CAUSEB_IP; 		cp0_compare_irq = (read_c0_intctl() >> INTCTLB_IPTI) & 7;+		if (get_c0_compare_irq)+			cp0_compare_irq = get_c0_compare_irq(); 		cp0_perfcount_irq = (read_c0_intctl() >> INTCTLB_IPPCI) & 7; 		if (cp0_perfcount_irq == cp0_compare_irq) 			cp0_perfcount_irq = -1;diff -Nur linux-2.6.37.orig/arch/mips/pci/Makefile linux-2.6.37/arch/mips/pci/Makefile--- linux-2.6.37.orig/arch/mips/pci/Makefile	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/arch/mips/pci/Makefile	2011-01-11 20:25:48.000000000 +0100@@ -18,6 +18,7 @@ obj-$(CONFIG_BCM47XX)		+= pci-bcm47xx.o obj-$(CONFIG_BCM63XX)		+= pci-bcm63xx.o fixup-bcm63xx.o \ 					ops-bcm63xx.o+obj-$(CONFIG_ATHEROS_AR71XX)	+= pci-ar71xx.o pci-ar724x.o  # # These are still pretty much in the old state, watch, go blind.diff -Nur linux-2.6.37.orig/arch/mips/pci/pci-ar71xx.c linux-2.6.37/arch/mips/pci/pci-ar71xx.c--- linux-2.6.37.orig/arch/mips/pci/pci-ar71xx.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/pci/pci-ar71xx.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,409 @@+/*+ *  Atheros AR71xx PCI host controller driver+ *+ *  Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Parts of this file are based on Atheros' 2.6.15 BSP+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/resource.h>+#include <linux/types.h>+#include <linux/delay.h>+#include <linux/bitops.h>+#include <linux/pci.h>+#include <linux/pci_regs.h>+#include <linux/interrupt.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/pci.h>++#undef DEBUG+#ifdef DEBUG+#define DBG(fmt, args...)	printk(KERN_DEBUG fmt, ## args)+#else+#define DBG(fmt, args...)+#endif++#define AR71XX_PCI_DELAY	100 /* msecs */++#if 0+#define PCI_IDSEL_BASE	PCI_IDSEL_ADL_START+#else+#define PCI_IDSEL_BASE	0+#endif++static void __iomem *ar71xx_pcicfg_base;+static DEFINE_SPINLOCK(ar71xx_pci_lock);+static int ar71xx_pci_fixup_enable;++static inline void ar71xx_pci_delay(void)+{+	mdelay(AR71XX_PCI_DELAY);+}++/* Byte lane enable bits */+static u8 ble_table[4][4] = {+	{0x0, 0xf, 0xf, 0xf},+	{0xe, 0xd, 0xb, 0x7},+	{0xc, 0xf, 0x3, 0xf},+	{0xf, 0xf, 0xf, 0xf},+};++static inline u32 ar71xx_pci_get_ble(int where, int size, int local)+{+	u32 t;++	t = ble_table[size & 3][where & 3];+	BUG_ON(t == 0xf);+	t <<= (local) ? 20 : 4;+	return t;+}++static inline u32 ar71xx_pci_bus_addr(struct pci_bus *bus, unsigned int devfn,+					int where)+{+	u32 ret;++	if (!bus->number) {+		/* type 0 */+		ret = (1 << (PCI_IDSEL_BASE + PCI_SLOT(devfn)))+		    | (PCI_FUNC(devfn) << 8) | (where & ~3);+	} else {+		/* type 1 */+		ret = (bus->number << 16) | (PCI_SLOT(devfn) << 11)+		    | (PCI_FUNC(devfn) << 8) | (where & ~3) | 1;+	}++	return ret;+}++int ar71xx_pci_be_handler(int is_fixup)+{+	void __iomem *base = ar71xx_pcicfg_base;+	u32 pci_err;+	u32 ahb_err;++	pci_err = __raw_readl(base + PCI_REG_PCI_ERR) & 3;+	if (pci_err) {+		if (!is_fixup)+			printk(KERN_ALERT "PCI error %d at PCI addr 0x%x\n",+				pci_err,+				__raw_readl(base + PCI_REG_PCI_ERR_ADDR));++		__raw_writel(pci_err, base + PCI_REG_PCI_ERR);+	}++	ahb_err = __raw_readl(base + PCI_REG_AHB_ERR) & 1;+	if (ahb_err) {+		if (!is_fixup)+			printk(KERN_ALERT "AHB error at AHB address 0x%x\n",+				__raw_readl(base + PCI_REG_AHB_ERR_ADDR));++		__raw_writel(ahb_err, base + PCI_REG_AHB_ERR);+	}++	return ((ahb_err | pci_err) ? 1 : 0);+}++static inline int ar71xx_pci_set_cfgaddr(struct pci_bus *bus,+			unsigned int devfn, int where, int size, u32 cmd)+{+	void __iomem *base = ar71xx_pcicfg_base;+	u32 addr;++	addr = ar71xx_pci_bus_addr(bus, devfn, where);++	DBG("PCI: set cfgaddr: %02x:%02x.%01x/%02x:%01d, addr=%08x\n",+		bus->number, PCI_SLOT(devfn), PCI_FUNC(devfn),+		where, size, addr);++	__raw_writel(addr, base + PCI_REG_CFG_AD);+	__raw_writel(cmd | ar71xx_pci_get_ble(where, size, 0),+		     base + PCI_REG_CFG_CBE);++	return ar71xx_pci_be_handler(1);+}++static int ar71xx_pci_read_config(struct pci_bus *bus, unsigned int devfn,+				  int where, int size, u32 *value)+{+	void __iomem *base = ar71xx_pcicfg_base;+	static u32 mask[8] = {0, 0xff, 0xffff, 0, 0xffffffff, 0, 0, 0};+	unsigned long flags;+	u32 data;+	int ret;++	ret = PCIBIOS_SUCCESSFUL;++	DBG("PCI: read config: %02x:%02x.%01x/%02x:%01d\n", bus->number,+			PCI_SLOT(devfn), PCI_FUNC(devfn), where, size);++	spin_lock_irqsave(&ar71xx_pci_lock, flags);++	if (bus->number == 0 && devfn == 0) {+		u32 t;++		t = PCI_CRP_CMD_READ | (where & ~3);++		__raw_writel(t, base + PCI_REG_CRP_AD_CBE);+		data = __raw_readl(base + PCI_REG_CRP_RDDATA);++		DBG("PCI: rd local cfg, ad_cbe:%08x, data:%08x\n", t, data);++	} else {+		int err;++		err = ar71xx_pci_set_cfgaddr(bus, devfn, where, size,+						PCI_CFG_CMD_READ);++		if (err == 0) {+			data = __raw_readl(base + PCI_REG_CFG_RDDATA);+		} else {+			ret = PCIBIOS_DEVICE_NOT_FOUND;+			data = ~0;+		}+	}++	spin_unlock_irqrestore(&ar71xx_pci_lock, flags);++	DBG("PCI: read config: data=%08x raw=%08x\n",+		(data >> (8 * (where & 3))) & mask[size & 7], data);++	*value = (data >> (8 * (where & 3))) & mask[size & 7];++	return ret;+}++static int ar71xx_pci_write_config(struct pci_bus *bus, unsigned int devfn,+				   int where, int size, u32 value)+{+	void __iomem *base = ar71xx_pcicfg_base;+	unsigned long flags;+	int ret;++	DBG("PCI: write config: %02x:%02x.%01x/%02x:%01d value=%08x\n",+		bus->number, PCI_SLOT(devfn), PCI_FUNC(devfn),+		where, size, value);++	value = value << (8 * (where & 3));+	ret = PCIBIOS_SUCCESSFUL;++	spin_lock_irqsave(&ar71xx_pci_lock, flags);+	if (bus->number == 0 && devfn == 0) {+		u32 t;++		t = PCI_CRP_CMD_WRITE | (where & ~3);+		t |= ar71xx_pci_get_ble(where, size, 1);++		DBG("PCI: wr local cfg, ad_cbe:%08x, value:%08x\n", t, value);++		__raw_writel(t, base + PCI_REG_CRP_AD_CBE);+		__raw_writel(value, base + PCI_REG_CRP_WRDATA);+	} else {+		int err;++		err = ar71xx_pci_set_cfgaddr(bus, devfn, where, size,+						PCI_CFG_CMD_WRITE);++		if (err == 0)+			__raw_writel(value, base + PCI_REG_CFG_WRDATA);+		else+			ret = PCIBIOS_DEVICE_NOT_FOUND;+	}+	spin_unlock_irqrestore(&ar71xx_pci_lock, flags);++	return ret;+}++static void ar71xx_pci_fixup(struct pci_dev *dev)+{+	u32 t;++	if (!ar71xx_pci_fixup_enable)+		return;++	if (dev->bus->number != 0 || dev->devfn != 0)+		return;++	DBG("PCI: fixup host controller %s (%04x:%04x)\n", pci_name(dev),+		dev->vendor, dev->device);++	/* setup COMMAND register */+	t = PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER | PCI_COMMAND_INVALIDATE+	  | PCI_COMMAND_PARITY | PCI_COMMAND_SERR | PCI_COMMAND_FAST_BACK;++	pci_write_config_word(dev, PCI_COMMAND, t);+}+DECLARE_PCI_FIXUP_EARLY(PCI_ANY_ID, PCI_ANY_ID, ar71xx_pci_fixup);++int __init ar71xx_pcibios_map_irq(const struct pci_dev *dev, uint8_t slot,+				  uint8_t pin)+{+	int irq = -1;+	int i;++	slot -= PCI_IDSEL_ADL_START - PCI_IDSEL_BASE;++	for (i = 0; i < ar71xx_pci_nr_irqs; i++) {+		struct ar71xx_pci_irq *entry;++		entry = &ar71xx_pci_irq_map[i];+		if (entry->slot == slot && entry->pin == pin) {+			irq = entry->irq;+			break;+		}+	}++	if (irq < 0) {+		printk(KERN_ALERT "PCI: no irq found for pin%u@%s\n",+				pin, pci_name((struct pci_dev *)dev));+	} else {+		printk(KERN_INFO "PCI: mapping irq %d to pin%u@%s\n",+				irq, pin, pci_name((struct pci_dev *)dev));+	}++	return irq;+}++static struct pci_ops ar71xx_pci_ops = {+	.read	= ar71xx_pci_read_config,+	.write	= ar71xx_pci_write_config,+};++static struct resource ar71xx_pci_io_resource = {+	.name		= "PCI IO space",+	.start		= 0,+	.end		= 0,+	.flags		= IORESOURCE_IO,+};++static struct resource ar71xx_pci_mem_resource = {+	.name		= "PCI memory space",+	.start		= AR71XX_PCI_MEM_BASE,+	.end		= AR71XX_PCI_MEM_BASE + AR71XX_PCI_MEM_SIZE - 1,+	.flags		= IORESOURCE_MEM+};++static struct pci_controller ar71xx_pci_controller = {+	.pci_ops	= &ar71xx_pci_ops,+	.mem_resource	= &ar71xx_pci_mem_resource,+	.io_resource	= &ar71xx_pci_io_resource,+};++static void ar71xx_pci_irq_handler(unsigned int irq, struct irq_desc *desc)+{+	void __iomem *base = ar71xx_reset_base;+	u32 pending;++	pending = __raw_readl(base + AR71XX_RESET_REG_PCI_INT_STATUS) &+		  __raw_readl(base + AR71XX_RESET_REG_PCI_INT_ENABLE);++	if (pending & PCI_INT_DEV0)+		generic_handle_irq(AR71XX_PCI_IRQ_DEV0);++	else if (pending & PCI_INT_DEV1)+		generic_handle_irq(AR71XX_PCI_IRQ_DEV1);++	else if (pending & PCI_INT_DEV2)+		generic_handle_irq(AR71XX_PCI_IRQ_DEV2);++	else if (pending & PCI_INT_CORE)+		generic_handle_irq(AR71XX_PCI_IRQ_CORE);++	else+		spurious_interrupt();+}++static void ar71xx_pci_irq_unmask(unsigned int irq)+{+	void __iomem *base = ar71xx_reset_base;+	u32 t;++	irq -= AR71XX_PCI_IRQ_BASE;++	t = __raw_readl(base + AR71XX_RESET_REG_PCI_INT_ENABLE);+	__raw_writel(t | (1 << irq), base + AR71XX_RESET_REG_PCI_INT_ENABLE);++	/* flush write */+	(void) __raw_readl(base + AR71XX_RESET_REG_PCI_INT_ENABLE);+}++static void ar71xx_pci_irq_mask(unsigned int irq)+{+	void __iomem *base = ar71xx_reset_base;+	u32 t;++	irq -= AR71XX_PCI_IRQ_BASE;++	t = __raw_readl(base + AR71XX_RESET_REG_PCI_INT_ENABLE);+	__raw_writel(t & ~(1 << irq), base + AR71XX_RESET_REG_PCI_INT_ENABLE);++	/* flush write */+	(void) __raw_readl(base + AR71XX_RESET_REG_PCI_INT_ENABLE);+}++static struct irq_chip ar71xx_pci_irq_chip = {+	.name		= "AR71XX PCI ",+	.mask		= ar71xx_pci_irq_mask,+	.unmask		= ar71xx_pci_irq_unmask,+	.mask_ack	= ar71xx_pci_irq_mask,+};++static void __init ar71xx_pci_irq_init(void)+{+	void __iomem *base = ar71xx_reset_base;+	int i;++	__raw_writel(0, base + AR71XX_RESET_REG_PCI_INT_ENABLE);+	__raw_writel(0, base + AR71XX_RESET_REG_PCI_INT_STATUS);++	for (i = AR71XX_PCI_IRQ_BASE;+	     i < AR71XX_PCI_IRQ_BASE + AR71XX_PCI_IRQ_COUNT; i++) {+		irq_desc[i].status = IRQ_DISABLED;+		set_irq_chip_and_handler(i, &ar71xx_pci_irq_chip,+					 handle_level_irq);+	}++	set_irq_chained_handler(AR71XX_CPU_IRQ_IP2, ar71xx_pci_irq_handler);+}++int __init ar71xx_pcibios_init(void)+{+	void __iomem *ddr_base = ar71xx_ddr_base;++	ar71xx_device_stop(RESET_MODULE_PCI_BUS | RESET_MODULE_PCI_CORE);+	ar71xx_pci_delay();++	ar71xx_device_start(RESET_MODULE_PCI_BUS | RESET_MODULE_PCI_CORE);+	ar71xx_pci_delay();++	ar71xx_pcicfg_base = ioremap_nocache(AR71XX_PCI_CFG_BASE,+						AR71XX_PCI_CFG_SIZE);+	if (ar71xx_pcicfg_base == NULL)+		return -ENOMEM;++	__raw_writel(PCI_WIN0_OFFS, ddr_base + AR71XX_DDR_REG_PCI_WIN0);+	__raw_writel(PCI_WIN1_OFFS, ddr_base + AR71XX_DDR_REG_PCI_WIN1);+	__raw_writel(PCI_WIN2_OFFS, ddr_base + AR71XX_DDR_REG_PCI_WIN2);+	__raw_writel(PCI_WIN3_OFFS, ddr_base + AR71XX_DDR_REG_PCI_WIN3);+	__raw_writel(PCI_WIN4_OFFS, ddr_base + AR71XX_DDR_REG_PCI_WIN4);+	__raw_writel(PCI_WIN5_OFFS, ddr_base + AR71XX_DDR_REG_PCI_WIN5);+	__raw_writel(PCI_WIN6_OFFS, ddr_base + AR71XX_DDR_REG_PCI_WIN6);+	__raw_writel(PCI_WIN7_OFFS, ddr_base + AR71XX_DDR_REG_PCI_WIN7);++	ar71xx_pci_delay();++	/* clear bus errors */+	(void)ar71xx_pci_be_handler(1);++	ar71xx_pci_fixup_enable = 1;+	ar71xx_pci_irq_init();+	register_pci_controller(&ar71xx_pci_controller);++	return 0;+}diff -Nur linux-2.6.37.orig/arch/mips/pci/pci-ar724x.c linux-2.6.37/arch/mips/pci/pci-ar724x.c--- linux-2.6.37.orig/arch/mips/pci/pci-ar724x.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/arch/mips/pci/pci-ar724x.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,395 @@+/*+ *  Atheros AR724x PCI host controller driver+ *+ *  Copyright (C) 2009-2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  Parts of this file are based on Atheros' 2.6.15 BSP+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/resource.h>+#include <linux/types.h>+#include <linux/delay.h>+#include <linux/bitops.h>+#include <linux/pci.h>+#include <linux/pci_regs.h>+#include <linux/interrupt.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/pci.h>++#undef DEBUG+#ifdef DEBUG+#define DBG(fmt, args...)	printk(KERN_INFO fmt, ## args)+#else+#define DBG(fmt, args...)+#endif++static void __iomem *ar724x_pci_localcfg_base;+static void __iomem *ar724x_pci_devcfg_base;+static void __iomem *ar724x_pci_ctrl_base;+static int ar724x_pci_fixup_enable;++static DEFINE_SPINLOCK(ar724x_pci_lock);++static void ar724x_pci_read(void __iomem *base, int where, int size, u32 *value)+{+	unsigned long flags;+	u32 data;++	spin_lock_irqsave(&ar724x_pci_lock, flags);+	data = __raw_readl(base + (where & ~3));++	switch (size) {+	case 1:+		if (where & 1)+			data >>= 8;+		if (where & 2)+			data >>= 16;+		data &= 0xFF;+		break;+	case 2:+		if (where & 2)+			data >>= 16;+		data &= 0xFFFF;+		break;+	}++	*value = data;+	spin_unlock_irqrestore(&ar724x_pci_lock, flags);+}++static void ar724x_pci_write(void __iomem *base, int where, int size, u32 value)+{+	unsigned long flags;+	u32 data;+	int s;++	spin_lock_irqsave(&ar724x_pci_lock, flags);+	data = __raw_readl(base + (where & ~3));++	switch (size) {+	case 1:+		s = ((where & 3) << 3);+		data &= ~(0xFF << s);+		data |= ((value & 0xFF) << s);+		break;+	case 2:+		s = ((where & 2) << 3);+		data &= ~(0xFFFF << s);+		data |= ((value & 0xFFFF) << s);+		break;+	case 4:+		data = value;+		break;+	}++	__raw_writel(data, base + (where & ~3));+	/* flush write */+	(void)__raw_readl(base + (where & ~3));+	spin_unlock_irqrestore(&ar724x_pci_lock, flags);+}++static int ar724x_pci_read_config(struct pci_bus *bus, unsigned int devfn,+				  int where, int size, u32 *value)+{++	if (bus->number != 0 || devfn != 0)+		return PCIBIOS_DEVICE_NOT_FOUND;++	ar724x_pci_read(ar724x_pci_devcfg_base, where, size, value);++	DBG("PCI: read config: %02x:%02x.%01x/%02x:%01d, value=%08x\n",+			bus->number, PCI_SLOT(devfn), PCI_FUNC(devfn),+			where, size, *value);++	/*+	 * WAR for BAR issue - We are unable to access the PCI device space+	 * if we set the BAR with proper base address+	 */+	if ((where == 0x10) && (size == 4)) {+		if (ar71xx_soc == AR71XX_SOC_AR7240)+			ar724x_pci_write(ar724x_pci_devcfg_base, where, size, 0xffff);+		else+			ar724x_pci_write(ar724x_pci_devcfg_base, where, size, 0x1000ffff);+	}++	return PCIBIOS_SUCCESSFUL;+}++static int ar724x_pci_write_config(struct pci_bus *bus, unsigned int devfn,+				   int where, int size, u32 value)+{+	if (bus->number != 0 || devfn != 0)+		return PCIBIOS_DEVICE_NOT_FOUND;++	DBG("PCI: write config: %02x:%02x.%01x/%02x:%01d, value=%08x\n",+		bus->number, PCI_SLOT(devfn), PCI_FUNC(devfn),+		where, size, value);++	ar724x_pci_write(ar724x_pci_devcfg_base, where, size, value);++	return PCIBIOS_SUCCESSFUL;+}++static void ar724x_pci_fixup(struct pci_dev *dev)+{+	u16 cmd;++	if (!ar724x_pci_fixup_enable)+		return;++	if (dev->bus->number != 0 || dev->devfn != 0)+		return;++	/* setup COMMAND register */+	pci_read_config_word(dev, PCI_COMMAND, &cmd);+	cmd |= PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER |+	       PCI_COMMAND_INVALIDATE | PCI_COMMAND_PARITY | PCI_COMMAND_SERR |+	       PCI_COMMAND_FAST_BACK;++	pci_write_config_word(dev, PCI_COMMAND, cmd);+}+DECLARE_PCI_FIXUP_EARLY(PCI_ANY_ID, PCI_ANY_ID, ar724x_pci_fixup);++int __init ar724x_pcibios_map_irq(const struct pci_dev *dev, uint8_t slot,+				  uint8_t pin)+{+	int irq = -1;+	int i;++	for (i = 0; i < ar71xx_pci_nr_irqs; i++) {+		struct ar71xx_pci_irq *entry;+		entry = &ar71xx_pci_irq_map[i];++		if (entry->slot == slot && entry->pin == pin) {+			irq = entry->irq;+			break;+		}+	}++	if (irq < 0)+		printk(KERN_ALERT "PCI: no irq found for pin%u@%s\n",+				pin, pci_name((struct pci_dev *)dev));+	else+		printk(KERN_INFO "PCI: mapping irq %d to pin%u@%s\n",+				irq, pin, pci_name((struct pci_dev *)dev));++	return irq;+}++static struct pci_ops ar724x_pci_ops = {+	.read	= ar724x_pci_read_config,+	.write	= ar724x_pci_write_config,+};++static struct resource ar724x_pci_io_resource = {+	.name		= "PCI IO space",+	.start		= 0,+	.end		= 0,+	.flags		= IORESOURCE_IO,+};++static struct resource ar724x_pci_mem_resource = {+	.name		= "PCI memory space",+	.start		= AR71XX_PCI_MEM_BASE,+	.end		= AR71XX_PCI_MEM_BASE + AR71XX_PCI_MEM_SIZE - 1,+	.flags		= IORESOURCE_MEM+};++static struct pci_controller ar724x_pci_controller = {+	.pci_ops	= &ar724x_pci_ops,+	.mem_resource	= &ar724x_pci_mem_resource,+	.io_resource	= &ar724x_pci_io_resource,+};++static void __init ar724x_pci_reset(void)+{+	ar71xx_device_stop(AR724X_RESET_PCIE);+	ar71xx_device_stop(AR724X_RESET_PCIE_PHY);+	ar71xx_device_stop(AR724X_RESET_PCIE_PHY_SERIAL);+	udelay(100);++	ar71xx_device_start(AR724X_RESET_PCIE_PHY_SERIAL);+	udelay(100);+	ar71xx_device_start(AR724X_RESET_PCIE_PHY);+	ar71xx_device_start(AR724X_RESET_PCIE);+}++static int __init ar724x_pci_setup(void)+{+	void __iomem *base = ar724x_pci_ctrl_base;+	u32 t;++	/* setup COMMAND register */+	t = PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER | PCI_COMMAND_INVALIDATE |+	    PCI_COMMAND_PARITY|PCI_COMMAND_SERR|PCI_COMMAND_FAST_BACK;++	ar724x_pci_write(ar724x_pci_localcfg_base, PCI_COMMAND, 4, t);+	ar724x_pci_write(ar724x_pci_localcfg_base, 0x20, 4, 0x1ff01000);+	ar724x_pci_write(ar724x_pci_localcfg_base, 0x24, 4, 0x1ff01000);++	t = __raw_readl(base + AR724X_PCI_REG_RESET);+	if (t != 0x7) {+		udelay(100000);+		__raw_writel(0, base + AR724X_PCI_REG_RESET);+		udelay(100);+		__raw_writel(4, base + AR724X_PCI_REG_RESET);+		udelay(100000);+	}++	if (ar71xx_soc == AR71XX_SOC_AR7240)+		t = AR724X_PCI_APP_LTSSM_ENABLE;+	else+		t = 0x1ffc1;+	__raw_writel(t, base + AR724X_PCI_REG_APP);+	/* flush write */+	(void) __raw_readl(base + AR724X_PCI_REG_APP);+	udelay(1000);++	t = __raw_readl(base + AR724X_PCI_REG_RESET);+	if ((t & AR724X_PCI_RESET_LINK_UP) == 0x0) {+		printk(KERN_WARNING "PCI: no PCIe module found\n");+		return -ENODEV;+	}++	if (ar71xx_soc == AR71XX_SOC_AR7241 || ar71xx_soc == AR71XX_SOC_AR7242) {+		t = __raw_readl(base + AR724X_PCI_REG_APP);+		t |= BIT(16);+		__raw_writel(t, base + AR724X_PCI_REG_APP);+	}++	return 0;+}++static void ar724x_pci_irq_handler(unsigned int irq, struct irq_desc *desc)+{+	void __iomem *base = ar724x_pci_ctrl_base;+	u32 pending;++	pending = __raw_readl(base + AR724X_PCI_REG_INT_STATUS) &+		  __raw_readl(base + AR724X_PCI_REG_INT_MASK);++	if (pending & AR724X_PCI_INT_DEV0)+		generic_handle_irq(AR71XX_PCI_IRQ_DEV0);++	else+		spurious_interrupt();+}++static void ar724x_pci_irq_unmask(unsigned int irq)+{+	void __iomem *base = ar724x_pci_ctrl_base;+	u32 t;++	switch (irq) {+	case AR71XX_PCI_IRQ_DEV0:+		irq -= AR71XX_PCI_IRQ_BASE;++		t = __raw_readl(base + AR724X_PCI_REG_INT_MASK);+		__raw_writel(t | AR724X_PCI_INT_DEV0,+			     base + AR724X_PCI_REG_INT_MASK);+		/* flush write */+		(void) __raw_readl(base + AR724X_PCI_REG_INT_MASK);+	}+}++static void ar724x_pci_irq_mask(unsigned int irq)+{+	void __iomem *base = ar724x_pci_ctrl_base;+	u32 t;++	switch (irq) {+	case AR71XX_PCI_IRQ_DEV0:+		irq -= AR71XX_PCI_IRQ_BASE;++		t = __raw_readl(base + AR724X_PCI_REG_INT_MASK);+		__raw_writel(t & ~AR724X_PCI_INT_DEV0,+			     base + AR724X_PCI_REG_INT_MASK);++		/* flush write */+		(void) __raw_readl(base + AR724X_PCI_REG_INT_MASK);++		t = __raw_readl(base + AR724X_PCI_REG_INT_STATUS);+		__raw_writel(t | AR724X_PCI_INT_DEV0,+			     base + AR724X_PCI_REG_INT_STATUS);++		/* flush write */+		(void) __raw_readl(base + AR724X_PCI_REG_INT_STATUS);+	}+}++static struct irq_chip ar724x_pci_irq_chip = {+	.name		= "AR724X PCI ",+	.mask		= ar724x_pci_irq_mask,+	.unmask		= ar724x_pci_irq_unmask,+	.mask_ack	= ar724x_pci_irq_mask,+};++static void __init ar724x_pci_irq_init(void)+{+	void __iomem *base = ar724x_pci_ctrl_base;+	u32 t;+	int i;++	t = ar71xx_reset_rr(AR724X_RESET_REG_RESET_MODULE);+	if (t & (AR724X_RESET_PCIE | AR724X_RESET_PCIE_PHY |+		 AR724X_RESET_PCIE_PHY_SERIAL)) {+		return;+	}++	__raw_writel(0, base + AR724X_PCI_REG_INT_MASK);+	__raw_writel(0, base + AR724X_PCI_REG_INT_STATUS);++	for (i = AR71XX_PCI_IRQ_BASE;+	     i < AR71XX_PCI_IRQ_BASE + AR71XX_PCI_IRQ_COUNT; i++) {+		irq_desc[i].status = IRQ_DISABLED;+		set_irq_chip_and_handler(i, &ar724x_pci_irq_chip,+					 handle_level_irq);+	}++	set_irq_chained_handler(AR71XX_CPU_IRQ_IP2, ar724x_pci_irq_handler);+}++int __init ar724x_pcibios_init(void)+{+	int ret = -ENOMEM;++	ar724x_pci_localcfg_base = ioremap_nocache(AR724X_PCI_CRP_BASE,+						   AR724X_PCI_CRP_SIZE);+	if (ar724x_pci_localcfg_base == NULL)+		goto err;++	ar724x_pci_devcfg_base = ioremap_nocache(AR724X_PCI_CFG_BASE,+						 AR724X_PCI_CFG_SIZE);+	if (ar724x_pci_devcfg_base == NULL)+		goto err_unmap_localcfg;++	ar724x_pci_ctrl_base = ioremap_nocache(AR724X_PCI_CTRL_BASE,+					       AR724X_PCI_CTRL_SIZE);+	if (ar724x_pci_ctrl_base == NULL)+		goto err_unmap_devcfg;++	ar724x_pci_reset();+	ret = ar724x_pci_setup();+	if (ret)+		goto err_unmap_ctrl;++	ar724x_pci_fixup_enable = 1;+	ar724x_pci_irq_init();+	register_pci_controller(&ar724x_pci_controller);++	return 0;++ err_unmap_ctrl:+	iounmap(ar724x_pci_ctrl_base);+  err_unmap_devcfg:+	iounmap(ar724x_pci_devcfg_base);+ err_unmap_localcfg:+	iounmap(ar724x_pci_localcfg_base);+ err:+	return ret;+}diff -Nur linux-2.6.37.orig/drivers/char/Kconfig linux-2.6.37/drivers/char/Kconfig--- linux-2.6.37.orig/drivers/char/Kconfig	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/char/Kconfig	2011-01-11 20:25:48.000000000 +0100@@ -1047,6 +1047,14 @@  	  If compiled as a module, it will be called cs5535_gpio. +config GPIO_DEVICE+	tristate "GPIO device support"+	depends on GENERIC_GPIO+	help+	  Say Y to enable Linux GPIO device support.  This allows control of+	  GPIO pins using a character device++ config RAW_DRIVER 	tristate "RAW driver (/dev/raw/rawN)" 	depends on BLOCKdiff -Nur linux-2.6.37.orig/drivers/char/Makefile linux-2.6.37/drivers/char/Makefile--- linux-2.6.37.orig/drivers/char/Makefile	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/char/Makefile	2011-01-11 20:25:48.000000000 +0100@@ -82,6 +82,7 @@ obj-$(CONFIG_PC8736x_GPIO)	+= pc8736x_gpio.o obj-$(CONFIG_NSC_GPIO)		+= nsc_gpio.o obj-$(CONFIG_CS5535_GPIO)	+= cs5535_gpio.o+obj-$(CONFIG_GPIO_DEVICE)	+= gpio_dev.o obj-$(CONFIG_GPIO_TB0219)	+= tb0219.o obj-$(CONFIG_TELCLOCK)		+= tlclk.o diff -Nur linux-2.6.37.orig/drivers/gpio/nxp_74hc153.c linux-2.6.37/drivers/gpio/nxp_74hc153.c--- linux-2.6.37.orig/drivers/gpio/nxp_74hc153.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/gpio/nxp_74hc153.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,246 @@+/*+ *  NXP 74HC153 - Dual 4-input multiplexer GPIO driver+ *+ *  Copyright (C) 2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify+ *  it under the terms of the GNU General Public License version 2 as+ *  published by the Free Software Foundation.+ */++#include <linux/module.h>+#include <linux/init.h>+#include <linux/gpio.h>+#include <linux/platform_device.h>+#include <linux/nxp_74hc153.h>++#define NXP_74HC153_NUM_GPIOS	8+#define NXP_74HC153_S0_MASK	0x1+#define NXP_74HC153_S1_MASK	0x2+#define NXP_74HC153_BANK_MASK	0x4++struct nxp_74hc153_chip {+	struct device		*parent;+	struct gpio_chip	gpio_chip;+	struct mutex		lock;+};++static struct nxp_74hc153_chip *gpio_to_nxp(struct gpio_chip *gc)+{+	return container_of(gc, struct nxp_74hc153_chip, gpio_chip);+}++static int nxp_74hc153_direction_input(struct gpio_chip *gc, unsigned offset)+{+	return 0;+}++static int nxp_74hc153_direction_output(struct gpio_chip *gc,+					unsigned offset, int val)+{+	return -EINVAL;+}++static int nxp_74hc153_get_value(struct gpio_chip *gc, unsigned offset)+{+	struct nxp_74hc153_chip *nxp;+	struct nxp_74hc153_platform_data *pdata;+	unsigned s0;+	unsigned s1;+	unsigned pin;+	int ret;++	nxp = gpio_to_nxp(gc);+	pdata = nxp->parent->platform_data;++	s0 = !!(offset & NXP_74HC153_S0_MASK);+	s1 = !!(offset & NXP_74HC153_S1_MASK);+	pin = (offset & NXP_74HC153_BANK_MASK) ? pdata->gpio_pin_2y+					       : pdata->gpio_pin_1y;++	mutex_lock(&nxp->lock);+	gpio_set_value(pdata->gpio_pin_s0, s0);+	gpio_set_value(pdata->gpio_pin_s1, s1);+	ret = gpio_get_value(pin);+	mutex_unlock(&nxp->lock);++	return ret;+}++static void nxp_74hc153_set_value(struct gpio_chip *gc,+				  unsigned offset, int val)+{+	/* not supported */+}++static int __devinit nxp_74hc153_probe(struct platform_device *pdev)+{+	struct nxp_74hc153_platform_data *pdata;+	struct nxp_74hc153_chip *nxp;+	struct gpio_chip *gc;+	int err;++	pdata = pdev->dev.platform_data;+	if (pdata == NULL) {+		dev_dbg(&pdev->dev, "no platform data specified\n");+		return -EINVAL;+	}++	nxp = kzalloc(sizeof(struct nxp_74hc153_chip), GFP_KERNEL);+	if (nxp == NULL) {+		dev_err(&pdev->dev, "no memory for private data\n");+		return -ENOMEM;+	}++	err = gpio_request(pdata->gpio_pin_s0, dev_name(&pdev->dev));+	if (err) {+		dev_err(&pdev->dev, "unable to claim gpio %u, err=%d\n",+			pdata->gpio_pin_s0, err);+		goto err_free_nxp;+	}++	err = gpio_request(pdata->gpio_pin_s1, dev_name(&pdev->dev));+	if (err) {+		dev_err(&pdev->dev, "unable to claim gpio %u, err=%d\n",+			pdata->gpio_pin_s1, err);+		goto err_free_s0;+	}++	err = gpio_request(pdata->gpio_pin_1y, dev_name(&pdev->dev));+	if (err) {+		dev_err(&pdev->dev, "unable to claim gpio %u, err=%d\n",+			pdata->gpio_pin_1y, err);+		goto err_free_s1;+	}++	err = gpio_request(pdata->gpio_pin_2y, dev_name(&pdev->dev));+	if (err) {+		dev_err(&pdev->dev, "unable to claim gpio %u, err=%d\n",+			pdata->gpio_pin_2y, err);+		goto err_free_1y;+	}++	err = gpio_direction_output(pdata->gpio_pin_s0, 0);+	if (err) {+		dev_err(&pdev->dev,+			"unable to set direction of gpio %u, err=%d\n",+			pdata->gpio_pin_s0, err);+		goto err_free_2y;+	}++	err = gpio_direction_output(pdata->gpio_pin_s1, 0);+	if (err) {+		dev_err(&pdev->dev,+			"unable to set direction of gpio %u, err=%d\n",+			pdata->gpio_pin_s1, err);+		goto err_free_2y;+	}++	err = gpio_direction_input(pdata->gpio_pin_1y);+	if (err) {+		dev_err(&pdev->dev,+			"unable to set direction of gpio %u, err=%d\n",+			pdata->gpio_pin_1y, err);+		goto err_free_2y;+	}++	err = gpio_direction_input(pdata->gpio_pin_2y);+	if (err) {+		dev_err(&pdev->dev,+			"unable to set direction of gpio %u, err=%d\n",+			pdata->gpio_pin_2y, err);+		goto err_free_2y;+	}++	nxp->parent = &pdev->dev;+	mutex_init(&nxp->lock);++	gc = &nxp->gpio_chip;++	gc->direction_input  = nxp_74hc153_direction_input;+	gc->direction_output = nxp_74hc153_direction_output;+	gc->get = nxp_74hc153_get_value;+	gc->set = nxp_74hc153_set_value;+	gc->can_sleep = 1;++	gc->base = pdata->gpio_base;+	gc->ngpio = NXP_74HC153_NUM_GPIOS;+	gc->label = dev_name(nxp->parent);+	gc->dev = nxp->parent;+	gc->owner = THIS_MODULE;++	err = gpiochip_add(&nxp->gpio_chip);+	if (err) {+		dev_err(&pdev->dev, "unable to add gpio chip, err=%d\n", err);+		goto err_free_2y;+	}++	platform_set_drvdata(pdev, nxp);+	return 0;++ err_free_2y:+	gpio_free(pdata->gpio_pin_2y);+ err_free_1y:+	gpio_free(pdata->gpio_pin_1y);+ err_free_s1:+	gpio_free(pdata->gpio_pin_s1);+ err_free_s0:+	gpio_free(pdata->gpio_pin_s0);+ err_free_nxp:+	kfree(nxp);+	return err;+}++static int nxp_74hc153_remove(struct platform_device *pdev)+{+	struct nxp_74hc153_chip *nxp = platform_get_drvdata(pdev);+	struct nxp_74hc153_platform_data *pdata = pdev->dev.platform_data;++	if (nxp) {+		int err;++		err = gpiochip_remove(&nxp->gpio_chip);+		if (err) {+			dev_err(&pdev->dev,+				"unable to remove gpio chip, err=%d\n",+				err);+			return err;+		}++		gpio_free(pdata->gpio_pin_2y);+		gpio_free(pdata->gpio_pin_1y);+		gpio_free(pdata->gpio_pin_s1);+		gpio_free(pdata->gpio_pin_s0);++		kfree(nxp);+		platform_set_drvdata(pdev, NULL);+	}++	return 0;+}++static struct platform_driver nxp_74hc153_driver = {+	.probe		= nxp_74hc153_probe,+	.remove		= __devexit_p(nxp_74hc153_remove),+	.driver = {+		.name	= NXP_74HC153_DRIVER_NAME,+		.owner	= THIS_MODULE,+	},+};++static int __init nxp_74hc153_init(void)+{+	return platform_driver_register(&nxp_74hc153_driver);+}+subsys_initcall(nxp_74hc153_init);++static void __exit nxp_74hc153_exit(void)+{+	platform_driver_unregister(&nxp_74hc153_driver);+}+module_exit(nxp_74hc153_exit);++MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");+MODULE_DESCRIPTION("GPIO expander driver for NXP 74HC153");+MODULE_LICENSE("GPL v2");+MODULE_ALIAS("platform:" NXP_74HC153_DRIVER_NAME);diff -Nur linux-2.6.37.orig/drivers/input/misc/Kconfig linux-2.6.37/drivers/input/misc/Kconfig--- linux-2.6.37.orig/drivers/input/misc/Kconfig	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/input/misc/Kconfig	2011-01-11 20:25:48.000000000 +0100@@ -448,4 +448,20 @@ 	  To compile this driver as a module, choose M here: the 	  module will be called adxl34x-spi. +config INPUT_GPIO_BUTTONS+	tristate "Polled GPIO buttons interface"+	depends on GENERIC_GPIO+	select INPUT_POLLDEV+	help+	  This driver implements support for buttons connected+	  to GPIO pins of various CPUs (and some other chips).++	  Say Y here if your device has buttons connected+	  directly to such GPIO pins.  Your board-specific+	  setup logic must also provide a platform device,+	  with configuration data saying which GPIOs are used.++	  To compile this driver as a module, choose M here: the+	  module will be called gpio-buttons.+ endifdiff -Nur linux-2.6.37.orig/drivers/input/misc/Makefile linux-2.6.37/drivers/input/misc/Makefile--- linux-2.6.37.orig/drivers/input/misc/Makefile	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/input/misc/Makefile	2011-01-11 20:25:48.000000000 +0100@@ -42,4 +42,5 @@ obj-$(CONFIG_INPUT_WISTRON_BTNS)	+= wistron_btns.o obj-$(CONFIG_INPUT_WM831X_ON)		+= wm831x-on.o obj-$(CONFIG_INPUT_YEALINK)		+= yealink.o+obj-$(CONFIG_INPUT_GPIO_BUTTONS)	+= gpio_buttons.o diff -Nur linux-2.6.37.orig/drivers/input/misc/gpio_buttons.c linux-2.6.37/drivers/input/misc/gpio_buttons.c--- linux-2.6.37.orig/drivers/input/misc/gpio_buttons.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/input/misc/gpio_buttons.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,216 @@+/*+ *  Driver for buttons on GPIO lines not capable of generating interrupts+ *+ *  Copyright (C) 2007-2010 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2010 Nuno Goncalves <nunojpg@gmail.com>+ *+ *  This file was based on: /drivers/input/misc/cobalt_btns.c+ *	Copyright (C) 2007 Yoichi Yuasa <yoichi_yuasa@tripeaks.co.jp>+ *+ *  also was based on: /drivers/input/keyboard/gpio_keys.c+ *	Copyright 2005 Phil Blundell+ *+ *  This program is free software; you can redistribute it and/or modify+ *  it under the terms of the GNU General Public License version 2 as+ *  published by the Free Software Foundation.+ *+ */++#include <linux/kernel.h>+#include <linux/module.h>+#include <linux/init.h>+#include <linux/slab.h>++#include <linux/input.h>+#include <linux/input-polldev.h>+#include <linux/ioport.h>+#include <linux/platform_device.h>++#include <linux/gpio_buttons.h>++#include <asm/gpio.h>++#define DRV_NAME	"gpio-buttons"+#define DRV_VERSION	"0.1.2"+#define PFX		DRV_NAME ": "++struct gpio_button_data {+	int last_state;+	int count;+};++struct gpio_buttons_dev {+	struct input_polled_dev *poll_dev;+	struct gpio_buttons_platform_data *pdata;+	struct gpio_button_data *data;+};++static void gpio_buttons_poll(struct input_polled_dev *dev)+{+	struct gpio_buttons_dev *bdev = dev->private;+	struct gpio_buttons_platform_data *pdata = bdev->pdata;+	struct input_dev *input = dev->input;+	int i;++	for (i = 0; i < bdev->pdata->nbuttons; i++) {+		struct gpio_button *button = &pdata->buttons[i];+		unsigned int type = button->type ?: EV_KEY;+		int state;++		if (bdev->data[i].count < button->threshold) {+			bdev->data[i].count++;+			continue;+		}++		state = gpio_get_value(button->gpio) ? 1 : 0;+		if (state != bdev->data[i].last_state) {+			input_event(input, type, button->code,+				    !!(state ^ button->active_low));+			input_sync(input);+			bdev->data[i].count = 0;+			bdev->data[i].last_state = state;+		}+	}+}++static int __devinit gpio_buttons_probe(struct platform_device *pdev)+{+	struct gpio_buttons_platform_data *pdata = pdev->dev.platform_data;+	struct gpio_buttons_dev *bdev;+	struct input_polled_dev *poll_dev;+	struct input_dev *input;+	int error, i;++	if (!pdata)+		return -ENXIO;++	bdev = kzalloc(sizeof(struct gpio_buttons_dev) ++		       sizeof(struct gpio_button_data) * pdata->nbuttons,+		       GFP_KERNEL);+	if (!bdev) {+		printk(KERN_ERR DRV_NAME "no memory for device\n");+		return -ENOMEM;+	}++	bdev->data = (struct gpio_button_data *) &bdev[1];++	poll_dev = input_allocate_polled_device();+	if (!poll_dev) {+		printk(KERN_ERR DRV_NAME "no memory for polled device\n");+		error = -ENOMEM;+		goto err_free_bdev;+	}++	poll_dev->private = bdev;+	poll_dev->poll = gpio_buttons_poll;+	poll_dev->poll_interval = pdata->poll_interval;++	input = poll_dev->input;++	input->evbit[0] = BIT(EV_KEY);+	input->name = pdev->name;+	input->phys = "gpio-buttons/input0";+	input->dev.parent = &pdev->dev;++	input->id.bustype = BUS_HOST;+	input->id.vendor = 0x0001;+	input->id.product = 0x0001;+	input->id.version = 0x0100;++	for (i = 0; i < pdata->nbuttons; i++) {+		struct gpio_button *button = &pdata->buttons[i];+		unsigned int gpio = button->gpio;+		unsigned int type = button->type ?: EV_KEY;++		error = gpio_request(gpio, button->desc ?+				button->desc : DRV_NAME);+		if (error) {+			printk(KERN_ERR PFX "unable to claim gpio %u, "+				"error %d\n", gpio, error);+			goto err_free_gpio;+		}++		error = gpio_direction_input(gpio);+		if (error) {+			printk(KERN_ERR PFX "unable to set direction on "+				"gpio %u, error %d\n", gpio, error);+			goto err_free_gpio;+		}++		input_set_capability(input, type, button->code);+		bdev->data[i].last_state = gpio_get_value(button->gpio) ? 1 : 0;+	}++	bdev->poll_dev = poll_dev;+	bdev->pdata = pdata;+	platform_set_drvdata(pdev, bdev);++	error = input_register_polled_device(poll_dev);+	if (error) {+		printk(KERN_ERR PFX "unable to register polled device, "+			"error %d\n", error);+		goto err_free_gpio;+	}++	return 0;++err_free_gpio:+	for (i = i - 1; i >= 0; i--)+		gpio_free(pdata->buttons[i].gpio);++	input_free_polled_device(poll_dev);++err_free_bdev:+	kfree(bdev);++	platform_set_drvdata(pdev, NULL);+	return error;+}++static int __devexit gpio_buttons_remove(struct platform_device *pdev)+{+	struct gpio_buttons_dev *bdev = platform_get_drvdata(pdev);+	struct gpio_buttons_platform_data *pdata = bdev->pdata;+	int i;++	input_unregister_polled_device(bdev->poll_dev);++	for (i = 0; i < pdata->nbuttons; i++)+		gpio_free(pdata->buttons[i].gpio);++	input_free_polled_device(bdev->poll_dev);++	kfree(bdev);+	platform_set_drvdata(pdev, NULL);++	return 0;+}++static struct platform_driver gpio_buttons_driver = {+	.probe	= gpio_buttons_probe,+	.remove	= __devexit_p(gpio_buttons_remove),+	.driver	= {+		.name	= DRV_NAME,+		.owner	= THIS_MODULE,+	},+};++static int __init gpio_buttons_init(void)+{+	printk(KERN_INFO DRV_NAME " driver version " DRV_VERSION "\n");+	return platform_driver_register(&gpio_buttons_driver);+}++static void __exit gpio_buttons_exit(void)+{+	platform_driver_unregister(&gpio_buttons_driver);+}++module_init(gpio_buttons_init);+module_exit(gpio_buttons_exit);++MODULE_LICENSE("GPL");+MODULE_AUTHOR("Gabor Juhos <juhosg at openwrt.org>");+MODULE_VERSION(DRV_VERSION);+MODULE_DESCRIPTION("Polled buttons driver for CPU GPIOs");+diff -Nur linux-2.6.37.orig/drivers/leds/leds-rb750.c linux-2.6.37/drivers/leds/leds-rb750.c--- linux-2.6.37.orig/drivers/leds/leds-rb750.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/leds/leds-rb750.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,140 @@+/*+ * LED driver for the RouterBOARD 750+ *+ * Copyright (C) 2010 Gabor Juhos <juhosg@openwrt.org>+ *+ * This program is free software; you can redistribute it and/or modify+ * it under the terms of the GNU General Public License version 2 as+ * published by the Free Software Foundation.+ *+ */+#include <linux/kernel.h>+#include <linux/init.h>+#include <linux/platform_device.h>+#include <linux/leds.h>++#include <asm/mach-ar71xx/mach-rb750.h>++#define DRV_NAME	"leds-rb750"++struct rb750_led_dev {+	struct led_classdev	cdev;+	u32			mask;+	int			active_low;+};++struct rb750_led_drvdata {+	struct rb750_led_dev	*led_devs;+	int			num_leds;+};++static inline struct rb750_led_dev *to_rbled(struct led_classdev *led_cdev)+{+	return (struct rb750_led_dev *)container_of(led_cdev,+		struct rb750_led_dev, cdev);+}++static void rb750_led_brightness_set(struct led_classdev *led_cdev,+				     enum led_brightness value)+{+	struct rb750_led_dev *rbled = to_rbled(led_cdev);+	int level;++	level = (value == LED_OFF) ? 0 : 1;+	level ^= rbled->active_low;++	if (level)+		rb750_latch_change(0, rbled->mask);+	else+		rb750_latch_change(rbled->mask, 0);+}++static int __devinit rb750_led_probe(struct platform_device *pdev)+{+	struct rb750_led_platform_data *pdata;+	struct rb750_led_drvdata *drvdata;+	int ret = 0;+	int i;++	pdata = pdev->dev.platform_data;+	if (!pdata)+		return -EINVAL;++	drvdata = kzalloc(sizeof(struct rb750_led_drvdata) ++			  sizeof(struct rb750_led_dev) * pdata->num_leds,+			  GFP_KERNEL);+	if (!drvdata)+		return -ENOMEM;++	drvdata->num_leds = pdata->num_leds;+	drvdata->led_devs = (struct rb750_led_dev *) &drvdata[1];++	for (i = 0; i < drvdata->num_leds; i++) {+		struct rb750_led_dev *rbled = &drvdata->led_devs[i];+		struct rb750_led_data *led_data = &pdata->leds[i];++		rbled->cdev.name = led_data->name;+		rbled->cdev.default_trigger = led_data->default_trigger;+		rbled->cdev.brightness_set = rb750_led_brightness_set;+		rbled->cdev.brightness = LED_OFF;++		rbled->mask = led_data->mask;+		rbled->active_low = !!led_data->active_low;++		ret = led_classdev_register(&pdev->dev, &rbled->cdev);+		if (ret)+			goto err;+	}++	platform_set_drvdata(pdev, drvdata);+	return 0;++ err:+	for (i = i - 1; i >= 0; i--)+		led_classdev_unregister(&drvdata->led_devs[i].cdev);++	kfree(drvdata);+	return ret;+}++static int __devexit rb750_led_remove(struct platform_device *pdev)+{+	struct rb750_led_drvdata *drvdata;+	int i;++	drvdata = platform_get_drvdata(pdev);+	for (i = 0; i < drvdata->num_leds; i++)+		led_classdev_unregister(&drvdata->led_devs[i].cdev);++	kfree(drvdata);+	return 0;+}++static struct platform_driver rb750_led_driver = {+	.probe		= rb750_led_probe,+	.remove		= __devexit_p(rb750_led_remove),+	.driver		= {+		.name	= DRV_NAME,+		.owner	= THIS_MODULE,+	},+};++MODULE_ALIAS("platform:leds-rb750");++static int __init rb750_led_init(void)+{+	return platform_driver_register(&rb750_led_driver);+}++static void __exit rb750_led_exit(void)+{+	platform_driver_unregister(&rb750_led_driver);+}++module_init(rb750_led_init);+module_exit(rb750_led_exit);++MODULE_DESCRIPTION(DRV_NAME);+MODULE_DESCRIPTION("LED driver for the RouterBOARD 750");+MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");+MODULE_LICENSE("GPL v2");diff -Nur linux-2.6.37.orig/drivers/leds/leds-wndr3700-usb.c linux-2.6.37/drivers/leds/leds-wndr3700-usb.c--- linux-2.6.37.orig/drivers/leds/leds-wndr3700-usb.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/leds/leds-wndr3700-usb.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,75 @@+/*+ *  USB LED driver for the NETGEAR WNDR3700+ *+ *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/leds.h>+#include <linux/module.h>+#include <linux/platform_device.h>++#include <asm/mach-ar71xx/ar71xx.h>++#define DRIVER_NAME	"wndr3700-led-usb"++static void wndr3700_usb_led_set(struct led_classdev *cdev,+				 enum led_brightness brightness)+{+	if (brightness)+		ar71xx_device_start(RESET_MODULE_GE1_PHY);+	else+		ar71xx_device_stop(RESET_MODULE_GE1_PHY);+}++static enum led_brightness wndr3700_usb_led_get(struct led_classdev *cdev)+{+	return ar71xx_device_stopped(RESET_MODULE_GE1_PHY) ? LED_OFF : LED_FULL;+}++static struct led_classdev wndr3700_usb_led = {+	.name = "wndr3700:green:usb",+	.brightness_set = wndr3700_usb_led_set,+	.brightness_get = wndr3700_usb_led_get,+};++static int __devinit wndr3700_usb_led_probe(struct platform_device *pdev)+{+	return led_classdev_register(&pdev->dev, &wndr3700_usb_led);+}++static int __devexit wndr3700_usb_led_remove(struct platform_device *pdev)+{+	led_classdev_unregister(&wndr3700_usb_led);+	return 0;+}++static struct platform_driver wndr3700_usb_led_driver = {+	.probe = wndr3700_usb_led_probe,+	.remove = __devexit_p(wndr3700_usb_led_remove),+	.driver = {+		.name = DRIVER_NAME,+		.owner = THIS_MODULE,+	},+};++static int __init wndr3700_usb_led_init(void)+{+	return platform_driver_register(&wndr3700_usb_led_driver);+}++static void __exit wndr3700_usb_led_exit(void)+{+	platform_driver_unregister(&wndr3700_usb_led_driver);+}++module_init(wndr3700_usb_led_init);+module_exit(wndr3700_usb_led_exit);++MODULE_DESCRIPTION("USB LED driver for the NETGEAR WNDR3700");+MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");+MODULE_LICENSE("GPL v2");+MODULE_ALIAS("platform:" DRIVER_NAME);diff -Nur linux-2.6.37.orig/drivers/mtd/maps/Kconfig linux-2.6.37/drivers/mtd/maps/Kconfig--- linux-2.6.37.orig/drivers/mtd/maps/Kconfig	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/mtd/maps/Kconfig	2011-01-11 20:25:48.000000000 +0100@@ -260,6 +260,13 @@ 	  Support for parsing CFE image tag and creating MTD partitions on 	  Broadcom BCM63xx boards. +config MTD_AR91XX_FLASH+	tristate "Atheros AR91xx parallel flash support"+	depends on ATHEROS_AR71XX+	select MTD_COMPLEX_MAPPINGS+	help+	  Parallel flash driver for the Atheros AR91xx based boards.+ config MTD_DILNETPC 	tristate "CFI Flash device mapped on DIL/Net PC" 	depends on X86 && MTD_CONCAT && MTD_PARTITIONS && MTD_CFI_INTELEXT && BROKENdiff -Nur linux-2.6.37.orig/drivers/mtd/maps/Makefile linux-2.6.37/drivers/mtd/maps/Makefile--- linux-2.6.37.orig/drivers/mtd/maps/Makefile	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/mtd/maps/Makefile	2011-01-11 20:25:48.000000000 +0100@@ -7,6 +7,7 @@ endif  # Chip mappings+obj-$(CONFIG_MTD_AR91XX_FLASH)	+= ar91xx_flash.o obj-$(CONFIG_MTD_CDB89712)	+= cdb89712.o obj-$(CONFIG_MTD_ARM_INTEGRATOR)+= integrator-flash.o obj-$(CONFIG_MTD_CFI_FLAGADM)	+= cfi_flagadm.odiff -Nur linux-2.6.37.orig/drivers/mtd/maps/ar91xx_flash.c linux-2.6.37/drivers/mtd/maps/ar91xx_flash.c--- linux-2.6.37.orig/drivers/mtd/maps/ar91xx_flash.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/mtd/maps/ar91xx_flash.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,310 @@+/*+ * Parallel flash driver for the Atheros AR91xx SoC+ *+ * Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ * This program is free software; you can redistribute it and/or modify+ * it under the terms of the GNU General Public License version 2 as+ * published by the Free Software Foundation.+ *+ */++#include <linux/module.h>+#include <linux/types.h>+#include <linux/kernel.h>+#include <linux/init.h>+#include <linux/slab.h>+#include <linux/device.h>+#include <linux/platform_device.h>+#include <linux/mtd/mtd.h>+#include <linux/mtd/map.h>+#include <linux/mtd/partitions.h>+#include <linux/io.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/ar91xx_flash.h>++#define DRV_NAME	"ar91xx-flash"++struct ar91xx_flash_info {+	struct mtd_info		*mtd;+	struct map_info		map;+#ifdef CONFIG_MTD_PARTITIONS+	int			nr_parts;+	struct mtd_partition	*parts;+#endif+};++static map_word ar91xx_flash_read(struct map_info *map, unsigned long ofs)+{+	map_word val;++	if (map_bankwidth_is_1(map))+		val.x[0] = __raw_readb(map->virt + (ofs ^ 3));+	else if (map_bankwidth_is_2(map))+		val.x[0] = __raw_readw(map->virt + (ofs ^ 2));+	else+		val = map_word_ff(map);++	return val;+}++static void ar91xx_flash_write(struct map_info *map, map_word d,+			       unsigned long ofs)+{+	if (map_bankwidth_is_1(map))+		__raw_writeb(d.x[0], map->virt + (ofs ^ 3));+	else if (map_bankwidth_is_2(map))+		__raw_writew(d.x[0], map->virt + (ofs ^ 2));++	mb();+}++static map_word ar91xx_flash_read_lock(struct map_info *map, unsigned long ofs)+{+	map_word ret;++	ar71xx_flash_acquire();+	ret = ar91xx_flash_read(map, ofs);+	ar71xx_flash_release();++	return ret;+}++static void ar91xx_flash_write_lock(struct map_info *map, map_word d,+			       unsigned long ofs)+{+	ar71xx_flash_acquire();+	ar91xx_flash_write(map, d, ofs);+	ar71xx_flash_release();+}++static void ar91xx_flash_copy_from_lock(struct map_info *map, void *to,+					unsigned long from, ssize_t len)+{+	ar71xx_flash_acquire();+	inline_map_copy_from(map, to, from, len);+	ar71xx_flash_release();+}++static void ar91xx_flash_copy_to_lock(struct map_info *map, unsigned long to,+				      const void *from, ssize_t len)+{+	ar71xx_flash_acquire();+	inline_map_copy_to(map, to, from, len);+	ar71xx_flash_release();+}++static int ar91xx_flash_remove(struct platform_device *pdev)+{+	struct ar91xx_flash_platform_data *pdata;+	struct ar91xx_flash_info *info;++	info = platform_get_drvdata(pdev);+	if (info == NULL)+		return 0;++	platform_set_drvdata(pdev, NULL);++	if (info->mtd == NULL)+		return 0;++	pdata = pdev->dev.platform_data;+#ifdef CONFIG_MTD_PARTITIONS+	if (info->nr_parts) {+		del_mtd_partitions(info->mtd);+		kfree(info->parts);+	} else if (pdata->nr_parts) {+		del_mtd_partitions(info->mtd);+	} else {+		del_mtd_device(info->mtd);+	}+#else+	del_mtd_device(info->mtd);+#endif+	map_destroy(info->mtd);++	return 0;+}++static const char *rom_probe_types[] = { "cfi_probe", "jedec_probe", NULL };+#ifdef CONFIG_MTD_PARTITIONS+static const char *part_probe_types[] = { "cmdlinepart", "RedBoot", NULL };+#endif++static int ar91xx_flash_probe(struct platform_device *pdev)+{+	struct ar91xx_flash_platform_data *pdata;+	struct ar91xx_flash_info *info;+	struct resource *res;+	struct resource *region;+	const char **probe_type;+	int err = 0;++	pdata = pdev->dev.platform_data;+	if (pdata == NULL)+		return -EINVAL;++	info = devm_kzalloc(&pdev->dev, sizeof(struct ar91xx_flash_info),+			    GFP_KERNEL);+	if (info == NULL) {+		err = -ENOMEM;+		goto err_out;+	}++	platform_set_drvdata(pdev, info);++	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);+	if (res == NULL) {+		err = -ENOENT;+		goto err_out;+	}++	dev_info(&pdev->dev, "%.8llx at %.8llx\n",+		 (unsigned long long)(res->end - res->start + 1),+		 (unsigned long long)res->start);++	region = devm_request_mem_region(&pdev->dev,+					 res->start, res->end - res->start + 1,+					 dev_name(&pdev->dev));+	if (region == NULL) {+		dev_err(&pdev->dev, "could not reserve memory region\n");+		err = -ENOMEM;+		goto err_out;+	}++	info->map.name = dev_name(&pdev->dev);+	info->map.phys = res->start;+	info->map.size = res->end - res->start + 1;+	info->map.bankwidth = pdata->width;++	info->map.virt = devm_ioremap(&pdev->dev, info->map.phys,+				      info->map.size);+	if (info->map.virt == NULL) {+		dev_err(&pdev->dev, "failed to ioremap flash region\n");+		err = -EIO;+		goto err_out;+	}++	simple_map_init(&info->map);+	if (pdata->is_shared) {+		info->map.read = ar91xx_flash_read_lock;+		info->map.write = ar91xx_flash_write_lock;+		info->map.copy_from = ar91xx_flash_copy_from_lock;+		info->map.copy_to = ar91xx_flash_copy_to_lock;+	} else {+		info->map.read = ar91xx_flash_read;+		info->map.write = ar91xx_flash_write;+	}++	probe_type = rom_probe_types;+	for (; info->mtd == NULL && *probe_type != NULL; probe_type++)+		info->mtd = do_map_probe(*probe_type, &info->map);++	if (info->mtd == NULL) {+		dev_err(&pdev->dev, "map_probe failed\n");+		err = -ENXIO;+		goto err_out;+	}++	info->mtd->owner = THIS_MODULE;++#ifdef CONFIG_MTD_PARTITIONS+	if (pdata->nr_parts) {+		dev_info(&pdev->dev, "using static partition mapping\n");+		add_mtd_partitions(info->mtd, pdata->parts, pdata->nr_parts);+		return 0;+	}++	err = parse_mtd_partitions(info->mtd, part_probe_types,+				   &info->parts, 0);+	if (err > 0) {+		add_mtd_partitions(info->mtd, info->parts, err);+		return 0;+	}+#endif++	add_mtd_device(info->mtd);+	return 0;++ err_out:+	ar91xx_flash_remove(pdev);+	return err;+}++#ifdef CONFIG_PM+static int ar91xx_flash_suspend(struct platform_device *dev, pm_message_t state)+{+	struct ar91xx_flash_info *info = platform_get_drvdata(dev);+	int ret = 0;++	if (info->mtd->suspend)+		ret = info->mtd->suspend(info->mtd);++	if (ret)+		goto fail;++	return 0;++ fail:+	if (info->mtd->suspend) {+		BUG_ON(!info->mtd->resume);+		info->mtd->resume(info->mtd);+	}++	return ret;+}++static int ar91xx_flash_resume(struct platform_device *pdev)+{+	struct ar91xx_flash_info *info = platform_get_drvdata(pdev);++	if (info->mtd->resume)+		info->mtd->resume(info->mtd);++	return 0;+}++static void ar91xx_flash_shutdown(struct platform_device *pdev)+{+	struct ar91xx_flash_info *info = platform_get_drvdata(pdev);++	if (info->mtd->suspend && info->mtd->resume)+		if (info->mtd->suspend(info->mtd) == 0)+			info->mtd->resume(info->mtd);+}+#else+#define ar91xx_flash_suspend	NULL+#define ar91xx_flash_resume	NULL+#define ar91xx_flash_shutdown	NULL+#endif++static struct platform_driver ar91xx_flash_driver = {+	.probe		= ar91xx_flash_probe,+	.remove		= ar91xx_flash_remove,+	.suspend	= ar91xx_flash_suspend,+	.resume		= ar91xx_flash_resume,+	.shutdown	= ar91xx_flash_shutdown,+	.driver		= {+		.name	= DRV_NAME,+		.owner	= THIS_MODULE,+	},+};++static int __init ar91xx_flash_init(void)+{+	return platform_driver_register(&ar91xx_flash_driver);+}++static void __exit ar91xx_flash_exit(void)+{+	platform_driver_unregister(&ar91xx_flash_driver);+}++module_init(ar91xx_flash_init);+module_exit(ar91xx_flash_exit);++MODULE_LICENSE("GPL v2");+MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");+MODULE_DESCRIPTION("Parallel flash driver for the Atheros AR91xx SoC");+MODULE_ALIAS("platform:" DRV_NAME);diff -Nur linux-2.6.37.orig/drivers/mtd/nand/Kconfig linux-2.6.37/drivers/mtd/nand/Kconfig--- linux-2.6.37.orig/drivers/mtd/nand/Kconfig	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/mtd/nand/Kconfig	2011-01-11 20:25:48.000000000 +0100@@ -532,4 +532,8 @@ 	  Enables support for NAND Flash chips on the ST Microelectronics 	  Flexible Static Memory Controller (FSMC) +config MTD_NAND_RB4XX+	tristate "NAND flash driver for RouterBoard 4xx series"+	depends on MTD_NAND && AR71XX_MACH_RB4XX+ endif # MTD_NANDdiff -Nur linux-2.6.37.orig/drivers/mtd/nand/Makefile linux-2.6.37/drivers/mtd/nand/Makefile--- linux-2.6.37.orig/drivers/mtd/nand/Makefile	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/mtd/nand/Makefile	2011-01-11 20:25:48.000000000 +0100@@ -33,6 +33,7 @@ obj-$(CONFIG_MTD_NAND_PXA3xx)		+= pxa3xx_nand.o obj-$(CONFIG_MTD_NAND_TMIO)		+= tmio_nand.o obj-$(CONFIG_MTD_NAND_PLATFORM)		+= plat_nand.o+obj-$(CONFIG_MTD_NAND_RB4XX)		+= rb4xx_nand.o obj-$(CONFIG_MTD_ALAUDA)		+= alauda.o obj-$(CONFIG_MTD_NAND_PASEMI)		+= pasemi_nand.o obj-$(CONFIG_MTD_NAND_ORION)		+= orion_nand.odiff -Nur linux-2.6.37.orig/drivers/mtd/nand/rb4xx_nand.c linux-2.6.37/drivers/mtd/nand/rb4xx_nand.c--- linux-2.6.37.orig/drivers/mtd/nand/rb4xx_nand.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/mtd/nand/rb4xx_nand.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,513 @@+/*+ *  NAND flash driver for the MikroTik RouterBoard 4xx series+ *+ *  Copyright (C) 2008 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  This file was based on the driver for Linux 2.6.22 published by+ *  MikroTik for their RouterBoard 4xx series devices.+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/init.h>+#include <linux/mtd/nand.h>+#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>+#include <linux/platform_device.h>+#include <linux/delay.h>+#include <linux/io.h>+#include <linux/gpio.h>+#include <linux/slab.h>++#include <asm/mach-ar71xx/ar71xx.h>++#define DRV_NAME        "rb4xx-nand"+#define DRV_VERSION     "0.1.10"+#define DRV_DESC        "NAND flash driver for RouterBoard 4xx series"++#define USE_FAST_READ	1+#define USE_FAST_WRITE	1+#undef RB4XX_NAND_DEBUG++#ifdef RB4XX_NAND_DEBUG+#define DBG(fmt, arg...)	printk(KERN_DEBUG DRV_NAME ": " fmt, ## arg)+#else+#define DBG(fmt, arg...)	do {} while (0)+#endif++#define RB4XX_NAND_GPIO_RDY	5+#define RB4XX_FLASH_HZ		33333334+#define RB4XX_NAND_HZ		33333334++#define SPI_CTRL_FASTEST	0x40+#define SPI_CTRL_SAFE		0x43	/* 25 MHz for AHB 200 MHz */+#define SBIT_IOC_BASE		SPI_IOC_CS1+#define SBIT_IOC_DO_SHIFT	0+#define SBIT_IOC_DO		(1u << SBIT_IOC_DO_SHIFT)+#define SBIT_IOC_DO2_SHIFT	18+#define SBIT_IOC_DO2		(1u << SBIT_IOC_DO2_SHIFT)++#define CPLD_CMD_WRITE_MULT	0x08	/* send cmd, n x send data, read data */+#define CPLD_CMD_WRITE_CFG	0x09	/* send cmd, n x send cfg */+#define CPLD_CMD_READ_MULT	0x0a	/* send cmd, send idle, n x read data */+#define CPLD_CMD_READ_FAST	0x0b	/* send cmd, 4 x idle, n x read data */++#define CFG_BIT_nCE	0x80+#define CFG_BIT_CLE	0x40+#define CFG_BIT_ALE	0x20+#define CFG_BIT_FAN	0x10+#define CFG_BIT_nLED4	0x08+#define CFG_BIT_nLED3	0x04+#define CFG_BIT_nLED2	0x02+#define CFG_BIT_nLED1	0x01++#define CFG_BIT_nLEDS \+	(CFG_BIT_nLED1 | CFG_BIT_nLED2 | CFG_BIT_nLED3 | CFG_BIT_nLED4)++struct rb4xx_nand_info {+	struct nand_chip	chip;+	struct mtd_info		mtd;+};++/*+ * We need to use the OLD Yaffs-1 OOB layout, otherwise the RB bootloader+ * will not be able to find the kernel that we load.+ */+static struct nand_ecclayout rb4xx_nand_ecclayout = {+	.eccbytes	= 6,+	.eccpos		= { 8, 9, 10, 13, 14, 15 },+	.oobavail	= 9,+	.oobfree	= { { 0, 4 }, { 6, 2 }, { 11, 2 }, { 4, 1 } }+};++static struct mtd_partition rb4xx_nand_partitions[] = {+	{+		.name	= "booter",+		.offset	= 0,+		.size	= (256 * 1024),+		.mask_flags = MTD_WRITEABLE,+	},+	{+		.name	= "kernel",+		.offset	= (256 * 1024),+		.size	= (4 * 1024 * 1024) - (256 * 1024),+	},+	{+		.name	= "rootfs",+		.offset	= MTDPART_OFS_NXTBLK,+		.size	= (1024*1024*64) - (1024*256) - (4 * 1024 * 1024)+	},+	{+		.name	= "cfgfs",+		.offset	= (1024*1024*64) - (1024*256),+		.size	= (1024*256),+	},+};++#if USE_FAST_READ+#define SPI_NDATA_BASE	0x00800000+static unsigned spi_ctrl_fread = SPI_CTRL_SAFE;+static unsigned spi_ctrl_flash = SPI_CTRL_SAFE;+extern unsigned mips_hpt_frequency;+#endif++static inline unsigned rb4xx_spi_rreg(unsigned r)+{+	return __raw_readl((void * __iomem)(KSEG1ADDR(AR71XX_SPI_BASE) + r));+}++static inline void rb4xx_spi_wreg(unsigned r, unsigned v)+{+	__raw_writel(v, (void * __iomem)(KSEG1ADDR(AR71XX_SPI_BASE) + r));+}++static inline void do_spi_clk(int bit)+{+	unsigned bval = SBIT_IOC_BASE | (bit & 1);++	rb4xx_spi_wreg(SPI_REG_IOC, bval);+	rb4xx_spi_wreg(SPI_REG_IOC, bval | SPI_IOC_CLK);+}++static void do_spi_byte(uint8_t byte)+{+	do_spi_clk(byte >> 7);+	do_spi_clk(byte >> 6);+	do_spi_clk(byte >> 5);+	do_spi_clk(byte >> 4);+	do_spi_clk(byte >> 3);+	do_spi_clk(byte >> 2);+	do_spi_clk(byte >> 1);+	do_spi_clk(byte);++	DBG("spi_byte sent 0x%02x got 0x%x\n",+					byte, rb4xx_spi_rreg(SPI_REG_RDS));+}++#if USE_FAST_WRITE+static inline void do_spi_clk_fast(int bit1, int bit2)+{+	unsigned bval = (SBIT_IOC_BASE |+			((bit1 << SBIT_IOC_DO_SHIFT) & SBIT_IOC_DO) |+			((bit2 << SBIT_IOC_DO2_SHIFT) & SBIT_IOC_DO2));++	rb4xx_spi_wreg(SPI_REG_IOC, bval);+	rb4xx_spi_wreg(SPI_REG_IOC, bval | SPI_IOC_CLK);+}++static inline void do_spi_byte_fast(uint8_t byte)+{+	do_spi_clk_fast(byte >> 7, byte >> 6);+	do_spi_clk_fast(byte >> 5, byte >> 4);+	do_spi_clk_fast(byte >> 3, byte >> 2);+	do_spi_clk_fast(byte >> 1, byte >> 0);++	DBG("spi_byte_fast sent 0x%02x got 0x%x\n",+					byte, rb4xx_spi_rreg(SPI_REG_RDS));+}+#else+static inline void do_spi_byte_fast(uint8_t byte)+{+	do_spi_byte(byte);+}+#endif /* USE_FAST_WRITE */++static int do_spi_cmd(unsigned cmd, unsigned sendCnt, const uint8_t *sendData,+		unsigned recvCnt, uint8_t *recvData,+		const uint8_t *verifyData, int fastWrite)+{+	unsigned i;++	DBG("SPI cmd 0x%x send %u recv %u\n", cmd, sendCnt, recvCnt);++	rb4xx_spi_wreg(SPI_REG_FS, SPI_FS_GPIO);+	rb4xx_spi_wreg(SPI_REG_CTRL, SPI_CTRL_FASTEST);++	do_spi_byte(cmd);+#if 0+	if (cmd == CPLD_CMD_READ_FAST) {+		do_spi_byte(0x80);+		do_spi_byte(0);+		do_spi_byte(0);+	}+#endif+	for (i = 0; i < sendCnt; ++i) {+		if (fastWrite)+			do_spi_byte_fast(sendData[i]);+		else+			do_spi_byte(sendData[i]);+	}++	for (i = 0; i < recvCnt; ++i) {+		if (fastWrite)+			do_spi_byte_fast(0);+		else+			do_spi_byte(0);++		if (recvData) {+			recvData[i] = rb4xx_spi_rreg(SPI_REG_RDS) & 0xff;+		} else if (verifyData) {+			if (verifyData[i] != (rb4xx_spi_rreg(SPI_REG_RDS)+							 & 0xff))+				break;+		}+	}++	rb4xx_spi_wreg(SPI_REG_IOC, SBIT_IOC_BASE | SPI_IOC_CS0);+	rb4xx_spi_wreg(SPI_REG_CTRL, spi_ctrl_flash);+	rb4xx_spi_wreg(SPI_REG_FS, 0);++	return i == recvCnt;+}++static int got_write = 1;++static void rb4xx_nand_write_data(const uint8_t *byte, unsigned cnt)+{+	do_spi_cmd(CPLD_CMD_WRITE_MULT, cnt, byte, 1, NULL, NULL, 1);+	got_write = 1;+}++static void rb4xx_nand_write_byte(uint8_t byte)+{+	rb4xx_nand_write_data(&byte, 1);+}++#if USE_FAST_READ+static uint8_t *rb4xx_nand_read_getaddr(unsigned cnt)+{+	static unsigned nboffset = 0x100000;+	unsigned addr;++	if (got_write) {+		nboffset = (nboffset + 31) & ~31;+		if (nboffset >= 0x100000)	/* 1MB */+			nboffset = 0;++		got_write = 0;+		rb4xx_spi_wreg(SPI_REG_FS, SPI_FS_GPIO);+		rb4xx_spi_wreg(SPI_REG_CTRL, spi_ctrl_fread);+		rb4xx_spi_wreg(SPI_REG_FS, 0);+	}++	addr = KSEG1ADDR(AR71XX_SPI_BASE + SPI_NDATA_BASE) + nboffset;+	DBG("rb4xx_nand_read_getaddr 0x%x cnt 0x%x\n", addr, cnt);++	nboffset += cnt;+	return (uint8_t *)addr;+}++static void rb4xx_nand_read_data(uint8_t *buf, unsigned cnt)+{+	unsigned size32 = cnt & ~31;+	unsigned remain = cnt & 31;++	if (size32) {+		uint8_t *addr = rb4xx_nand_read_getaddr(size32);+		memcpy(buf, (void *)addr, size32);+	}++	if (remain) {+		do_spi_cmd(CPLD_CMD_READ_MULT, 1, buf, remain,+			   buf + size32, NULL, 0);+	}+}++static int rb4xx_nand_verify_data(const uint8_t *buf, unsigned cnt)+{+	unsigned size32 = cnt & ~31;+	unsigned remain = cnt & 31;++	if (size32) {+		uint8_t *addr = rb4xx_nand_read_getaddr(size32);+		if (memcmp(buf, (void *)addr, size32) != 0)+			return 0;+	}++	if (remain) {+		return do_spi_cmd(CPLD_CMD_READ_MULT, 1, buf, remain,+				  NULL, buf + size32, 0);+	}+	return 1;+}+#else /* USE_FAST_READ */+static void rb4xx_nand_read_data(uint8_t *buf, unsigned cnt)+{+	do_spi_cmd(CPLD_CMD_READ_MULT, 1, buf, cnt, buf, NULL, 0);+}++static int rb4xx_nand_verify_data(const uint8_t *buf, unsigned cnt)+{+	return do_spi_cmd(CPLD_CMD_READ_MULT, 1, buf, cnt, NULL, buf, 0);+}+#endif /* USE_FAST_READ */++static void rb4xx_nand_write_cfg(uint8_t byte)+{+	do_spi_cmd(CPLD_CMD_WRITE_CFG, 1, &byte, 0, NULL, NULL, 0);+	got_write = 1;+}++static int rb4xx_nand_dev_ready(struct mtd_info *mtd)+{+	return gpio_get_value(RB4XX_NAND_GPIO_RDY);+}++static void rb4xx_nand_cmd_ctrl(struct mtd_info *mtd, int cmd,+				unsigned int ctrl)+{+	if (ctrl & NAND_CTRL_CHANGE) {+		uint8_t cfg = CFG_BIT_nLEDS;++		cfg |= (ctrl & NAND_CLE) ? CFG_BIT_CLE : 0;+		cfg |= (ctrl & NAND_ALE) ? CFG_BIT_ALE : 0;+		cfg |= (ctrl & NAND_NCE) ? 0 : CFG_BIT_nCE;++		rb4xx_nand_write_cfg(cfg);+	}++	if (cmd != NAND_CMD_NONE)+		rb4xx_nand_write_byte(cmd);+}++static uint8_t rb4xx_nand_read_byte(struct mtd_info *mtd)+{+	uint8_t byte = 0;++	rb4xx_nand_read_data(&byte, 1);+	return byte;+}++static void rb4xx_nand_write_buf(struct mtd_info *mtd, const uint8_t *buf,+				int len)+{+	rb4xx_nand_write_data(buf, len);+}++static void rb4xx_nand_read_buf(struct mtd_info *mtd, uint8_t *buf,+				int len)+{+	rb4xx_nand_read_data(buf, len);+}++static int rb4xx_nand_verify_buf(struct mtd_info *mtd, const uint8_t *buf,+				int len)+{+	if (!rb4xx_nand_verify_data(buf, len))+		return -EFAULT;++	return 0;+}++static unsigned get_spi_ctrl(unsigned hz_max, const char *name)+{+	unsigned div;++	div = (ar71xx_ahb_freq - 1) / (2 * hz_max);+	/*+	 * CPU has a bug at (div == 0) - first bit read is random+	 */+	if (div == 0)+		++div;++	if (name) {+		unsigned ahb_khz = (ar71xx_ahb_freq + 500) / 1000;+		unsigned div_real = 2 * (div + 1);+		printk(KERN_INFO "%s SPI clock %u kHz (AHB %u kHz / %u)\n",+		       name,+		       ahb_khz / div_real,+		       ahb_khz, div_real);+	}++	return SPI_CTRL_FASTEST + div;+}++static int __init rb4xx_nand_probe(struct platform_device *pdev)+{+	struct rb4xx_nand_info	*info;+	int ret;++	printk(KERN_INFO DRV_DESC " version " DRV_VERSION "\n");++	ret = gpio_request(RB4XX_NAND_GPIO_RDY, "NAND RDY");+	if (ret) {+		printk(KERN_ERR "rb4xx-nand: gpio request failed\n");+		return ret;+	}++	ret = gpio_direction_input(RB4XX_NAND_GPIO_RDY);+	if (ret) {+		printk(KERN_ERR "rb4xx-nand: unable to set input mode "+					"on gpio%d\n", RB4XX_NAND_GPIO_RDY);+		goto err_free_gpio;+	}++	info = kzalloc(sizeof(*info), GFP_KERNEL);+	if (!info) {+		printk(KERN_ERR "rb4xx-nand: no memory for private data\n");+		ret = -ENOMEM;+		goto err_free_gpio;+	}++#if USE_FAST_READ+	spi_ctrl_fread = get_spi_ctrl(RB4XX_NAND_HZ, "NAND");+#endif+	spi_ctrl_flash = get_spi_ctrl(RB4XX_FLASH_HZ, "FLASH");++	rb4xx_nand_write_cfg(CFG_BIT_nLEDS | CFG_BIT_nCE);++	info->chip.priv	= &info;+	info->mtd.priv	= &info->chip;+	info->mtd.owner	= THIS_MODULE;++	info->chip.cmd_ctrl	= rb4xx_nand_cmd_ctrl;+	info->chip.dev_ready	= rb4xx_nand_dev_ready;+	info->chip.read_byte	= rb4xx_nand_read_byte;+	info->chip.write_buf	= rb4xx_nand_write_buf;+	info->chip.read_buf	= rb4xx_nand_read_buf;+	info->chip.verify_buf	= rb4xx_nand_verify_buf;++	info->chip.chip_delay	= 25;+	info->chip.ecc.mode	= NAND_ECC_SOFT;+	info->chip.options	|= NAND_NO_AUTOINCR;++	platform_set_drvdata(pdev, info);++	ret = nand_scan_ident(&info->mtd, 1, NULL);+	if (ret) {+		ret = -ENXIO;+		goto err_free_info;+	}++	if (info->mtd.writesize == 512)+		info->chip.ecc.layout = &rb4xx_nand_ecclayout;++	ret = nand_scan_tail(&info->mtd);+	if (ret) {+		return -ENXIO;+		goto err_set_drvdata;+	}++#ifdef CONFIG_MTD_PARTITIONS+	ret = add_mtd_partitions(&info->mtd, rb4xx_nand_partitions,+				ARRAY_SIZE(rb4xx_nand_partitions));+#else+	ret = add_mtd_device(&info->mtd);+#endif+	if (ret)+		goto err_release_nand;++	return 0;++err_release_nand:+	nand_release(&info->mtd);+err_set_drvdata:+	platform_set_drvdata(pdev, NULL);+err_free_info:+	kfree(info);+err_free_gpio:+	gpio_free(RB4XX_NAND_GPIO_RDY);+	return ret;+}++static int __devexit rb4xx_nand_remove(struct platform_device *pdev)+{+	struct rb4xx_nand_info *info = platform_get_drvdata(pdev);++	nand_release(&info->mtd);+	platform_set_drvdata(pdev, NULL);+	kfree(info);++	return 0;+}++static struct platform_driver rb4xx_nand_driver = {+	.probe	= rb4xx_nand_probe,+	.remove	= __devexit_p(rb4xx_nand_remove),+	.driver	= {+		.name	= DRV_NAME,+		.owner	= THIS_MODULE,+	},+};++static int __init rb4xx_nand_init(void)+{+	return platform_driver_register(&rb4xx_nand_driver);+}++static void __exit rb4xx_nand_exit(void)+{+	platform_driver_unregister(&rb4xx_nand_driver);+}++module_init(rb4xx_nand_init);+module_exit(rb4xx_nand_exit);++MODULE_DESCRIPTION(DRV_DESC);+MODULE_VERSION(DRV_VERSION);+MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");+MODULE_AUTHOR("Imre Kaloz <kaloz@openwrt.org>");+MODULE_LICENSE("GPL v2");diff -Nur linux-2.6.37.orig/drivers/mtd/nand/rb750_nand.c linux-2.6.37/drivers/mtd/nand/rb750_nand.c--- linux-2.6.37.orig/drivers/mtd/nand/rb750_nand.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/mtd/nand/rb750_nand.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,360 @@+/*+ *  NAND flash driver for the MikroTik RouterBOARD 750+ *+ *  Copyright (C) 2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/init.h>+#include <linux/mtd/nand.h>+#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>+#include <linux/platform_device.h>+#include <linux/io.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/mach-rb750.h>++#define DRV_NAME	"rb750-nand"+#define DRV_VERSION	"0.1.0"+#define DRV_DESC	"NAND flash driver for the RouterBOARD 750"++#define RB750_NAND_IO0		BIT(RB750_GPIO_NAND_IO0)+#define RB750_NAND_ALE		BIT(RB750_GPIO_NAND_ALE)+#define RB750_NAND_CLE		BIT(RB750_GPIO_NAND_CLE)+#define RB750_NAND_NRE		BIT(RB750_GPIO_NAND_NRE)+#define RB750_NAND_NWE		BIT(RB750_GPIO_NAND_NWE)+#define RB750_NAND_RDY		BIT(RB750_GPIO_NAND_RDY)+#define RB750_NAND_NCE		BIT(RB750_GPIO_NAND_NCE)++#define RB750_NAND_DATA_SHIFT	1+#define RB750_NAND_DATA_BITS	(0xff << RB750_NAND_DATA_SHIFT)+#define RB750_NAND_INPUT_BITS	(RB750_NAND_DATA_BITS | RB750_NAND_RDY)+#define RB750_NAND_OUTPUT_BITS	(RB750_NAND_ALE | RB750_NAND_CLE | \+				 RB750_NAND_NRE | RB750_NAND_NWE | \+				 RB750_NAND_NCE)++struct rb750_nand_info {+	struct nand_chip	chip;+	struct mtd_info		mtd;+};++/*+ * We need to use the OLD Yaffs-1 OOB layout, otherwise the RB bootloader+ * will not be able to find the kernel that we load.+ */+static struct nand_ecclayout rb750_nand_ecclayout = {+	.eccbytes	= 6,+	.eccpos		= { 8, 9, 10, 13, 14, 15 },+	.oobavail	= 9,+	.oobfree	= { { 0, 4 }, { 6, 2 }, { 11, 2 }, { 4, 1 } }+};++static struct mtd_partition rb750_nand_partitions[] = {+	{+		.name	= "booter",+		.offset	= 0,+		.size	= (256 * 1024),+		.mask_flags = MTD_WRITEABLE,+	}, {+		.name	= "kernel",+		.offset	= (256 * 1024),+		.size	= (4 * 1024 * 1024) - (256 * 1024),+	}, {+		.name	= "rootfs",+		.offset	= MTDPART_OFS_NXTBLK,+		.size	= MTDPART_SIZ_FULL,+	},+};++static void rb750_nand_write(const u8 *buf, unsigned len)+{+	void __iomem *base = ar71xx_gpio_base;+	u32 out;+	unsigned i;++	/* set data lines to output mode */+	__raw_writel(__raw_readl(base + GPIO_REG_OE) | RB750_NAND_DATA_BITS,+		     base + GPIO_REG_OE);++	out = __raw_readl(base + GPIO_REG_OUT);+	out &= ~(RB750_NAND_DATA_BITS | RB750_NAND_NWE);+	for (i = 0; i != len; i++) {+		u32 data;++		data = buf[i];+		data <<= RB750_NAND_DATA_SHIFT;+		data |= out;+		__raw_writel(data, base + GPIO_REG_OUT);++		__raw_writel(data | RB750_NAND_NWE, base + GPIO_REG_OUT);+		/* flush write */+		__raw_readl(base + GPIO_REG_OUT);+	}++	/* set data lines to input mode */+	__raw_writel(__raw_readl(base + GPIO_REG_OE) & ~RB750_NAND_DATA_BITS,+		     base + GPIO_REG_OE);+	/* flush write */+	__raw_readl(base + GPIO_REG_OE);+}++static int rb750_nand_read_verify(u8 *read_buf, unsigned len,+				  const u8 *verify_buf)+{+	void __iomem *base = ar71xx_gpio_base;+	unsigned i;++	for (i = 0; i < len; i++) {+		u8 data;++		/* activate RE line */+		__raw_writel(RB750_NAND_NRE, base + GPIO_REG_CLEAR);+		/* flush write */+		__raw_readl(base + GPIO_REG_CLEAR);++		/* read input lines */+		data = __raw_readl(base + GPIO_REG_IN) >> RB750_NAND_DATA_SHIFT;++		/* deactivate RE line */+		__raw_writel(RB750_NAND_NRE, base + GPIO_REG_SET);++		if (read_buf)+			read_buf[i] = data;+		else if (verify_buf && verify_buf[i] != data)+			return -EFAULT;+	}++	return 0;+}++static void rb750_nand_select_chip(struct mtd_info *mtd, int chip)+{+	void __iomem *base = ar71xx_gpio_base;+	u32 func;++	func = __raw_readl(base + GPIO_REG_FUNC);+	if (chip >= 0) {+		/* disable latch */+		rb750_latch_change(RB750_LVC573_LE, 0);++		/* disable alternate functions */+		ar71xx_gpio_function_setup(AR724X_GPIO_FUNC_JTAG_DISABLE,+					   AR724X_GPIO_FUNC_SPI_EN);++		/* set input mode for data lines */+		__raw_writel(__raw_readl(base + GPIO_REG_OE) &+			     ~RB750_NAND_INPUT_BITS,+			     base + GPIO_REG_OE);++		/* deactivate RE and WE lines */+		__raw_writel(RB750_NAND_NRE | RB750_NAND_NWE,+			     base + GPIO_REG_SET);+		/* flush write */+		(void) __raw_readl(base + GPIO_REG_SET);++		/* activate CE line */+		__raw_writel(RB750_NAND_NCE, base + GPIO_REG_CLEAR);+	} else {+		/* deactivate CE line */+		__raw_writel(RB750_NAND_NCE, base + GPIO_REG_SET);+		/* flush write */+		(void) __raw_readl(base + GPIO_REG_SET);++		__raw_writel(__raw_readl(base + GPIO_REG_OE) |+			     RB750_NAND_IO0 | RB750_NAND_RDY,+			     base + GPIO_REG_OE);++		/* restore alternate functions */+		ar71xx_gpio_function_setup(AR724X_GPIO_FUNC_SPI_EN,+					   AR724X_GPIO_FUNC_JTAG_DISABLE);++		/* enable latch */+		rb750_latch_change(0, RB750_LVC573_LE);+	}+}++static int rb750_nand_dev_ready(struct mtd_info *mtd)+{+	void __iomem *base = ar71xx_gpio_base;++	return !!(__raw_readl(base + GPIO_REG_IN) & RB750_NAND_RDY);+}++static void rb750_nand_cmd_ctrl(struct mtd_info *mtd, int cmd,+				unsigned int ctrl)+{+	if (ctrl & NAND_CTRL_CHANGE) {+		void __iomem *base = ar71xx_gpio_base;+		u32 t;++		t = __raw_readl(base + GPIO_REG_OUT);++		t &= ~(RB750_NAND_CLE | RB750_NAND_ALE);+		t |= (ctrl & NAND_CLE) ? RB750_NAND_CLE : 0;+		t |= (ctrl & NAND_ALE) ? RB750_NAND_ALE : 0;++		__raw_writel(t, base + GPIO_REG_OUT);+		/* flush write */+		__raw_readl(base + GPIO_REG_OUT);+	}++	if (cmd != NAND_CMD_NONE) {+		u8 t = cmd;+		rb750_nand_write(&t, 1);+	}+}++static u8 rb750_nand_read_byte(struct mtd_info *mtd)+{+	u8 data = 0;+	rb750_nand_read_verify(&data, 1, NULL);+	return data;+}++static void rb750_nand_read_buf(struct mtd_info *mtd, u8 *buf, int len)+{+	rb750_nand_read_verify(buf, len, NULL);+}++static void rb750_nand_write_buf(struct mtd_info *mtd, const u8 *buf, int len)+{+	rb750_nand_write(buf, len);+}++static int rb750_nand_verify_buf(struct mtd_info *mtd, const u8 *buf, int len)+{+	return rb750_nand_read_verify(NULL, len, buf);+}++static void __init rb750_nand_gpio_init(void)+{+	void __iomem *base = ar71xx_gpio_base;+	u32 out;++	out = __raw_readl(base + GPIO_REG_OUT);++	/* setup output levels */+	__raw_writel(RB750_NAND_NCE | RB750_NAND_NRE | RB750_NAND_NWE,+		     base + GPIO_REG_SET);++	__raw_writel(RB750_NAND_ALE | RB750_NAND_CLE,+		     base + GPIO_REG_CLEAR);++	/* setup input lines */+	__raw_writel(__raw_readl(base + GPIO_REG_OE) & ~(RB750_NAND_INPUT_BITS),+		     base + GPIO_REG_OE);++	/* setup output lines */+	__raw_writel(__raw_readl(base + GPIO_REG_OE) | RB750_NAND_OUTPUT_BITS,+		     base + GPIO_REG_OE);++	rb750_latch_change(~out & RB750_NAND_IO0, out & RB750_NAND_IO0);+}++static int __init rb750_nand_probe(struct platform_device *pdev)+{+	struct rb750_nand_info	*info;+	int ret;++	printk(KERN_INFO DRV_DESC " version " DRV_VERSION "\n");++	rb750_nand_gpio_init();++	info = kzalloc(sizeof(*info), GFP_KERNEL);+	if (!info)+		return -ENOMEM;++	info->chip.priv	= &info;+	info->mtd.priv	= &info->chip;+	info->mtd.owner	= THIS_MODULE;++	info->chip.select_chip	= rb750_nand_select_chip;+	info->chip.cmd_ctrl	= rb750_nand_cmd_ctrl;+	info->chip.dev_ready	= rb750_nand_dev_ready;+	info->chip.read_byte	= rb750_nand_read_byte;+	info->chip.write_buf	= rb750_nand_write_buf;+	info->chip.read_buf	= rb750_nand_read_buf;+	info->chip.verify_buf	= rb750_nand_verify_buf;++	info->chip.chip_delay	= 25;+	info->chip.ecc.mode	= NAND_ECC_SOFT;+	info->chip.options	|= NAND_NO_AUTOINCR;++	platform_set_drvdata(pdev, info);++	ret = nand_scan_ident(&info->mtd, 1);+	if (ret) {+		ret = -ENXIO;+		goto err_free_info;+	}++	if (info->mtd.writesize == 512)+		info->chip.ecc.layout = &rb750_nand_ecclayout;++	ret = nand_scan_tail(&info->mtd);+	if (ret) {+		return -ENXIO;+		goto err_set_drvdata;+	}++#ifdef CONFIG_MTD_PARTITIONS+	ret = add_mtd_partitions(&info->mtd, rb750_nand_partitions,+				 ARRAY_SIZE(rb750_nand_partitions));+#else+	ret = add_mtd_device(&info->mtd);+#endif+	if (ret)+		goto err_release_nand;++	return 0;++ err_release_nand:+	nand_release(&info->mtd);+ err_set_drvdata:+	platform_set_drvdata(pdev, NULL);+ err_free_info:+	kfree(info);+	return ret;+}++static int __devexit rb750_nand_remove(struct platform_device *pdev)+{+	struct rb750_nand_info *info = platform_get_drvdata(pdev);++	nand_release(&info->mtd);+	platform_set_drvdata(pdev, NULL);+	kfree(info);++	return 0;+}++static struct platform_driver rb750_nand_driver = {+	.probe	= rb750_nand_probe,+	.remove	= __devexit_p(rb750_nand_remove),+	.driver	= {+		.name	= DRV_NAME,+		.owner	= THIS_MODULE,+	},+};++static int __init rb750_nand_init(void)+{+	return platform_driver_register(&rb750_nand_driver);+}++static void __exit rb750_nand_exit(void)+{+	platform_driver_unregister(&rb750_nand_driver);+}++module_init(rb750_nand_init);+module_exit(rb750_nand_exit);++MODULE_DESCRIPTION(DRV_DESC);+MODULE_VERSION(DRV_VERSION);+MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");+MODULE_LICENSE("GPL v2");diff -Nur linux-2.6.37.orig/drivers/mtd/wrt160nl_part.c linux-2.6.37/drivers/mtd/wrt160nl_part.c--- linux-2.6.37.orig/drivers/mtd/wrt160nl_part.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/mtd/wrt160nl_part.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,181 @@+/*+ * Copyright (C) 2009 Christian Daniel <cd@maintech.de>+ * Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ * This program is free software; you can redistribute it and/or modify+ * it under the terms of the GNU General Public License as published by+ * the Free Software Foundation; either version 2 of the License, or+ * (at your option) any later version.+ *+ * This program is distributed in the hope that it will be useful,+ * but WITHOUT ANY WARRANTY; without even the implied warranty of+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the+ * GNU General Public License for more details.+ *+ * You should have received a copy of the GNU General Public License+ * along with this program; if not, write to the Free Software+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA+ *+ * TRX flash partition table.+ * Based on ar7 map by Felix Fietkau <nbd@openwrt.org>+ *+ */++#include <linux/kernel.h>+#include <linux/slab.h>+#include <linux/vmalloc.h>++#include <linux/mtd/mtd.h>+#include <linux/mtd/partitions.h>++struct cybertan_header {+	char	magic[4];+	u8	res1[4];+	char	fw_date[3];+	char	fw_ver[3];+	char	id[4];+	char	hw_ver;+	char	unused;+	u8	flags[2];+	u8	res2[10];+};++#define TRX_PARTS	6+#define TRX_MAGIC	0x30524448+#define TRX_MAX_OFFSET	3++struct trx_header {+	uint32_t magic;           /* "HDR0" */+	uint32_t len;             /* Length of file including header */+	uint32_t crc32;           /* 32-bit CRC from flag_version to end of file */+	uint32_t flag_version;    /* 0:15 flags, 16:31 version */+	uint32_t offsets[TRX_MAX_OFFSET]; /* Offsets of partitions from start of header */+};++#define IH_MAGIC	0x27051956	/* Image Magic Number */+#define IH_NMLEN	32		/* Image Name Length */++struct uimage_header {+	uint32_t	ih_magic;	/* Image Header Magic Number */+	uint32_t	ih_hcrc;	/* Image Header CRC Checksum */+	uint32_t	ih_time;	/* Image Creation Timestamp */+	uint32_t	ih_size;	/* Image Data Size */+	uint32_t	ih_load;	/* Data» Load  Address */+	uint32_t	ih_ep;		/* Entry Point Address */+	uint32_t	ih_dcrc;	/* Image Data CRC Checksum */+	uint8_t		ih_os;		/* Operating System */+	uint8_t		ih_arch;	/* CPU architecture */+	uint8_t		ih_type;	/* Image Type */+	uint8_t		ih_comp;	/* Compression Type */+	uint8_t		ih_name[IH_NMLEN];	/* Image Name */+};++struct wrt160nl_header {+	struct cybertan_header	cybertan;+	struct trx_header	trx;+	struct uimage_header	uimage;+} __attribute__ ((packed));++static struct mtd_partition trx_parts[TRX_PARTS];++static int wrt160nl_parse_partitions(struct mtd_info *master,+				     struct mtd_partition **pparts,+				     unsigned long origin)+{+	struct wrt160nl_header *header;+	struct trx_header *theader;+	struct uimage_header *uheader;+	size_t retlen;+	unsigned int kernel_len;+	int ret;++	header = vmalloc(sizeof(*header));+	if (!header) {+		return -ENOMEM;+		goto out;+	}++	ret = master->read(master, 4 * master->erasesize, sizeof(*header),+			   &retlen, (void *) header);+	if (ret)+		goto free_hdr;++	if (retlen != sizeof(*header)) {+		ret = -EIO;+		goto free_hdr;+	}++	if (strncmp(header->cybertan.magic, "NL16", 4) != 0) {+		printk(KERN_NOTICE "%s: no WRT160NL signature found\n",+			master->name);+		goto free_hdr;+	}++	theader = &header->trx;+	if (le32_to_cpu(theader->magic) != TRX_MAGIC) {+		printk(KERN_NOTICE "%s: no TRX header found\n", master->name);+		goto free_hdr;+	}++	uheader = &header->uimage;+	if (uheader->ih_magic != IH_MAGIC) {+		printk(KERN_NOTICE "%s: no uImage found\n", master->name);+		goto free_hdr;+	}++	kernel_len = le32_to_cpu(theader->offsets[1]) + sizeof(struct cybertan_header);++	trx_parts[0].name = "u-boot";+	trx_parts[0].offset = 0;+	trx_parts[0].size = 4 * master->erasesize;+	trx_parts[0].mask_flags = MTD_WRITEABLE;++	trx_parts[1].name = "kernel";+	trx_parts[1].offset = trx_parts[0].offset + trx_parts[0].size;+	trx_parts[1].size = kernel_len;+	trx_parts[1].mask_flags = 0;++	trx_parts[2].name = "rootfs";+	trx_parts[2].offset = trx_parts[1].offset + trx_parts[1].size;+	trx_parts[2].size = master->size - 6 * master->erasesize - trx_parts[1].size;+	trx_parts[2].mask_flags = 0;++	trx_parts[3].name = "nvram";+	trx_parts[3].offset = master->size - 2 * master->erasesize;+	trx_parts[3].size = master->erasesize;+	trx_parts[3].mask_flags = MTD_WRITEABLE;++	trx_parts[4].name = "art";+	trx_parts[4].offset = master->size - master->erasesize;+	trx_parts[4].size = master->erasesize;+	trx_parts[4].mask_flags = MTD_WRITEABLE;++	trx_parts[5].name = "firmware";+	trx_parts[5].offset = 4 * master->erasesize;+	trx_parts[5].size = master->size - 6 * master->erasesize;+	trx_parts[5].mask_flags = 0;++	*pparts = trx_parts;+	ret = TRX_PARTS;++ free_hdr:+	vfree(header);+ out:+	return ret;+}++static struct mtd_part_parser wrt160nl_parser = {+	.owner		= THIS_MODULE,+	.parse_fn	= wrt160nl_parse_partitions,+	.name		= "wrt160nl",+};++static int __init wrt160nl_parser_init(void)+{+	return register_mtd_parser(&wrt160nl_parser);+}++module_init(wrt160nl_parser_init);++MODULE_LICENSE("GPL");+MODULE_AUTHOR("Christian Daniel <cd@maintech.de>");diff -Nur linux-2.6.37.orig/drivers/net/Kconfig linux-2.6.37/drivers/net/Kconfig--- linux-2.6.37.orig/drivers/net/Kconfig	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/net/Kconfig	2011-01-11 20:25:48.000000000 +0100@@ -2068,6 +2068,8 @@  	  The safe and default value for this is N. +source drivers/net/ag71xx/Kconfig+ config DL2K 	tristate "DL2000/TC902x-based Gigabit Ethernet support" 	depends on PCIdiff -Nur linux-2.6.37.orig/drivers/net/Makefile linux-2.6.37/drivers/net/Makefile--- linux-2.6.37.orig/drivers/net/Makefile	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/net/Makefile	2011-01-11 20:25:48.000000000 +0100@@ -112,6 +112,7 @@ # end link order section # +obj-$(CONFIG_AG71XX) += ag71xx/ obj-$(CONFIG_SUNDANCE) += sundance.o obj-$(CONFIG_HAMACHI) += hamachi.o obj-$(CONFIG_NET) += Space.o loopback.odiff -Nur linux-2.6.37.orig/drivers/net/ag71xx/Kconfig linux-2.6.37/drivers/net/ag71xx/Kconfig--- linux-2.6.37.orig/drivers/net/ag71xx/Kconfig	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/net/ag71xx/Kconfig	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,33 @@+config AG71XX+	tristate "Atheros AR71xx built-in ethernet mac support"+	depends on ATHEROS_AR71XX+	select PHYLIB+	help+	  If you wish to compile a kernel for AR71xx/91xx and enable+	  ethernet support, then you should always answer Y to this.++if AG71XX++config AG71XX_DEBUG+	bool "Atheros AR71xx built-in ethernet driver debugging"+	default n+	help+	  Atheros AR71xx built-in ethernet driver debugging messages.++config AG71XX_DEBUG_FS+	bool "Atheros AR71xx built-in ethernet driver debugfs support"+	depends on DEBUG_FS+	default n+	help+	  Say Y, if you need access to various statistics provided by+	  the ag71xx driver.++config AG71XX_AR8216_SUPPORT+	bool "special support for the Atheros AR8216 switch"+	default n+	default y if AR71XX_MACH_WNR2000 || AR71XX_MACH_MZK_W04NU+	help+	  Say 'y' here if you want to enable special support for the+	  Atheros AR8216 switch found on some boards.++endifdiff -Nur linux-2.6.37.orig/drivers/net/ag71xx/Makefile linux-2.6.37/drivers/net/ag71xx/Makefile--- linux-2.6.37.orig/drivers/net/ag71xx/Makefile	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/net/ag71xx/Makefile	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,14 @@+#+# Makefile for the Atheros AR71xx built-in ethernet macs+#++ag71xx-y	+= ag71xx_main.o+ag71xx-y	+= ag71xx_ethtool.o+ag71xx-y	+= ag71xx_phy.o+ag71xx-y	+= ag71xx_mdio.o++ag71xx-$(CONFIG_AG71XX_DEBUG_FS)	+= ag71xx_debugfs.o+ag71xx-$(CONFIG_AG71XX_AR8216_SUPPORT)	+= ag71xx_ar8216.o++obj-$(CONFIG_AG71XX)	+= ag71xx.o+diff -Nur linux-2.6.37.orig/drivers/net/ag71xx/ag71xx.h linux-2.6.37/drivers/net/ag71xx/ag71xx.h--- linux-2.6.37.orig/drivers/net/ag71xx/ag71xx.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/net/ag71xx/ag71xx.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,500 @@+/*+ *  Atheros AR71xx built-in ethernet mac driver+ *+ *  Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Based on Atheros' AG7100 driver+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#ifndef __AG71XX_H+#define __AG71XX_H++#include <linux/kernel.h>+#include <linux/version.h>+#include <linux/module.h>+#include <linux/init.h>+#include <linux/types.h>+#include <linux/random.h>+#include <linux/spinlock.h>+#include <linux/interrupt.h>+#include <linux/platform_device.h>+#include <linux/ethtool.h>+#include <linux/etherdevice.h>+#include <linux/phy.h>+#include <linux/skbuff.h>+#include <linux/dma-mapping.h>+#include <linux/workqueue.h>++#include <linux/bitops.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/platform.h>++#define ETH_FCS_LEN	4++#define AG71XX_DRV_NAME		"ag71xx"+#define AG71XX_DRV_VERSION	"0.5.35"++#define AG71XX_NAPI_WEIGHT	64+#define AG71XX_OOM_REFILL	(1 + HZ/10)++#define AG71XX_INT_ERR	(AG71XX_INT_RX_BE | AG71XX_INT_TX_BE)+#define AG71XX_INT_TX	(AG71XX_INT_TX_PS)+#define AG71XX_INT_RX	(AG71XX_INT_RX_PR | AG71XX_INT_RX_OF)++#define AG71XX_INT_POLL	(AG71XX_INT_RX | AG71XX_INT_TX)+#define AG71XX_INT_INIT	(AG71XX_INT_ERR | AG71XX_INT_POLL)++#define AG71XX_TX_FIFO_LEN	2048+#define AG71XX_TX_MTU_LEN	1536+#define AG71XX_RX_PKT_RESERVE	64+#define AG71XX_RX_PKT_SIZE	\+	(AG71XX_RX_PKT_RESERVE + ETH_HLEN + ETH_FRAME_LEN + ETH_FCS_LEN)++#define AG71XX_TX_RING_SIZE	64+#define AG71XX_TX_THRES_STOP	(AG71XX_TX_RING_SIZE - 4)+#define AG71XX_TX_THRES_WAKEUP	\+		(AG71XX_TX_RING_SIZE - (AG71XX_TX_RING_SIZE / 4))++#define AG71XX_RX_RING_SIZE	128++#ifdef CONFIG_AG71XX_DEBUG+#define DBG(fmt, args...)	printk(KERN_DEBUG fmt, ## args)+#else+#define DBG(fmt, args...)	do {} while (0)+#endif++#define ag71xx_assert(_cond)						\+do {									\+	if (_cond)							\+		break;							\+	printk("%s,%d: assertion failed\n", __FILE__, __LINE__);	\+	BUG();								\+} while (0)++struct ag71xx_desc {+	u32	data;+	u32	ctrl;+#define DESC_EMPTY	BIT(31)+#define DESC_MORE	BIT(24)+#define DESC_PKTLEN_M	0xfff+	u32	next;+	u32	pad;+} __attribute__((aligned(4)));++struct ag71xx_buf {+	struct sk_buff		*skb;+	struct ag71xx_desc 	*desc;+	dma_addr_t		dma_addr;+	u32			pad;+};++struct ag71xx_ring {+	struct ag71xx_buf	*buf;+	u8			*descs_cpu;+	dma_addr_t		descs_dma;+	unsigned int		desc_size;+	unsigned int		curr;+	unsigned int		dirty;+	unsigned int		size;+};++struct ag71xx_mdio {+	struct mii_bus		*mii_bus;+	int			mii_irq[PHY_MAX_ADDR];+	void __iomem		*mdio_base;+	struct ag71xx_mdio_platform_data *pdata;+};++struct ag71xx_int_stats {+	unsigned long		rx_pr;+	unsigned long		rx_be;+	unsigned long		rx_of;+	unsigned long		tx_ps;+	unsigned long		tx_be;+	unsigned long		tx_ur;+	unsigned long		total;+};++struct ag71xx_napi_stats {+	unsigned long		napi_calls;+	unsigned long		rx_count;+	unsigned long		rx_packets;+	unsigned long		rx_packets_max;+	unsigned long		tx_count;+	unsigned long		tx_packets;+	unsigned long		tx_packets_max;++	unsigned long		rx[AG71XX_NAPI_WEIGHT + 1];+	unsigned long		tx[AG71XX_NAPI_WEIGHT + 1];+};++struct ag71xx_debug {+	struct dentry		*debugfs_dir;+	struct dentry		*debugfs_int_stats;+	struct dentry		*debugfs_napi_stats;++	struct ag71xx_int_stats int_stats;+	struct ag71xx_napi_stats napi_stats;+};++struct ag71xx {+	void __iomem		*mac_base;+	void __iomem		*mii_ctrl;++	spinlock_t		lock;+	struct platform_device	*pdev;+	struct net_device	*dev;+	struct napi_struct	napi;+	u32			msg_enable;++	struct ag71xx_ring	rx_ring;+	struct ag71xx_ring	tx_ring;++	struct mii_bus		*mii_bus;+	struct phy_device	*phy_dev;++	unsigned int		link;+	unsigned int		speed;+	int 			duplex;++	struct work_struct	restart_work;+	struct timer_list	oom_timer;++#ifdef CONFIG_AG71XX_DEBUG_FS+	struct ag71xx_debug	debug;+#endif+};++extern struct ethtool_ops ag71xx_ethtool_ops;+void ag71xx_link_adjust(struct ag71xx *ag);++int ag71xx_mdio_driver_init(void) __init;+void ag71xx_mdio_driver_exit(void);++int ag71xx_phy_connect(struct ag71xx *ag);+void ag71xx_phy_disconnect(struct ag71xx *ag);+void ag71xx_phy_start(struct ag71xx *ag);+void ag71xx_phy_stop(struct ag71xx *ag);++static inline struct ag71xx_platform_data *ag71xx_get_pdata(struct ag71xx *ag)+{+	return ag->pdev->dev.platform_data;+}++static inline int ag71xx_desc_empty(struct ag71xx_desc *desc)+{+	return ((desc->ctrl & DESC_EMPTY) != 0);+}++static inline int ag71xx_desc_pktlen(struct ag71xx_desc *desc)+{+	return (desc->ctrl & DESC_PKTLEN_M);+}++/* Register offsets */+#define AG71XX_REG_MAC_CFG1	0x0000+#define AG71XX_REG_MAC_CFG2	0x0004+#define AG71XX_REG_MAC_IPG	0x0008+#define AG71XX_REG_MAC_HDX	0x000c+#define AG71XX_REG_MAC_MFL	0x0010+#define AG71XX_REG_MII_CFG	0x0020+#define AG71XX_REG_MII_CMD	0x0024+#define AG71XX_REG_MII_ADDR	0x0028+#define AG71XX_REG_MII_CTRL	0x002c+#define AG71XX_REG_MII_STATUS	0x0030+#define AG71XX_REG_MII_IND	0x0034+#define AG71XX_REG_MAC_IFCTL	0x0038+#define AG71XX_REG_MAC_ADDR1	0x0040+#define AG71XX_REG_MAC_ADDR2	0x0044+#define AG71XX_REG_FIFO_CFG0	0x0048+#define AG71XX_REG_FIFO_CFG1	0x004c+#define AG71XX_REG_FIFO_CFG2	0x0050+#define AG71XX_REG_FIFO_CFG3	0x0054+#define AG71XX_REG_FIFO_CFG4	0x0058+#define AG71XX_REG_FIFO_CFG5	0x005c+#define AG71XX_REG_FIFO_RAM0	0x0060+#define AG71XX_REG_FIFO_RAM1	0x0064+#define AG71XX_REG_FIFO_RAM2	0x0068+#define AG71XX_REG_FIFO_RAM3	0x006c+#define AG71XX_REG_FIFO_RAM4	0x0070+#define AG71XX_REG_FIFO_RAM5	0x0074+#define AG71XX_REG_FIFO_RAM6	0x0078+#define AG71XX_REG_FIFO_RAM7	0x007c++#define AG71XX_REG_TX_CTRL	0x0180+#define AG71XX_REG_TX_DESC	0x0184+#define AG71XX_REG_TX_STATUS	0x0188+#define AG71XX_REG_RX_CTRL	0x018c+#define AG71XX_REG_RX_DESC	0x0190+#define AG71XX_REG_RX_STATUS	0x0194+#define AG71XX_REG_INT_ENABLE	0x0198+#define AG71XX_REG_INT_STATUS	0x019c++#define MAC_CFG1_TXE		BIT(0)	/* Tx Enable */+#define MAC_CFG1_STX		BIT(1)	/* Synchronize Tx Enable */+#define MAC_CFG1_RXE		BIT(2)	/* Rx Enable */+#define MAC_CFG1_SRX		BIT(3)	/* Synchronize Rx Enable */+#define MAC_CFG1_TFC		BIT(4)	/* Tx Flow Control Enable */+#define MAC_CFG1_RFC		BIT(5)	/* Rx Flow Control Enable */+#define MAC_CFG1_LB		BIT(8)	/* Loopback mode */+#define MAC_CFG1_SR		BIT(31)	/* Soft Reset */++#define MAC_CFG2_FDX		BIT(0)+#define MAC_CFG2_CRC_EN		BIT(1)+#define MAC_CFG2_PAD_CRC_EN	BIT(2)+#define MAC_CFG2_LEN_CHECK	BIT(4)+#define MAC_CFG2_HUGE_FRAME_EN	BIT(5)+#define MAC_CFG2_IF_1000	BIT(9)+#define MAC_CFG2_IF_10_100	BIT(8)++#define FIFO_CFG0_WTM		BIT(0)	/* Watermark Module */+#define FIFO_CFG0_RXS		BIT(1)	/* Rx System Module */+#define FIFO_CFG0_RXF		BIT(2)	/* Rx Fabric Module */+#define FIFO_CFG0_TXS		BIT(3)	/* Tx System Module */+#define FIFO_CFG0_TXF		BIT(4)	/* Tx Fabric Module */+#define FIFO_CFG0_ALL	(FIFO_CFG0_WTM | FIFO_CFG0_RXS | FIFO_CFG0_RXF \+			| FIFO_CFG0_TXS | FIFO_CFG0_TXF)++#define FIFO_CFG0_ENABLE_SHIFT	8++#define FIFO_CFG4_DE		BIT(0)	/* Drop Event */+#define FIFO_CFG4_DV		BIT(1)	/* RX_DV Event */+#define FIFO_CFG4_FC		BIT(2)	/* False Carrier */+#define FIFO_CFG4_CE		BIT(3)	/* Code Error */+#define FIFO_CFG4_CR		BIT(4)	/* CRC error */+#define FIFO_CFG4_LM		BIT(5)	/* Length Mismatch */+#define FIFO_CFG4_LO		BIT(6)	/* Length out of range */+#define FIFO_CFG4_OK		BIT(7)	/* Packet is OK */+#define FIFO_CFG4_MC		BIT(8)	/* Multicast Packet */+#define FIFO_CFG4_BC		BIT(9)	/* Broadcast Packet */+#define FIFO_CFG4_DR		BIT(10)	/* Dribble */+#define FIFO_CFG4_LE		BIT(11)	/* Long Event */+#define FIFO_CFG4_CF		BIT(12)	/* Control Frame */+#define FIFO_CFG4_PF		BIT(13)	/* Pause Frame */+#define FIFO_CFG4_UO		BIT(14)	/* Unsupported Opcode */+#define FIFO_CFG4_VT		BIT(15)	/* VLAN tag detected */+#define FIFO_CFG4_FT		BIT(16)	/* Frame Truncated */+#define FIFO_CFG4_UC		BIT(17)	/* Unicast Packet */++#define FIFO_CFG5_DE		BIT(0)	/* Drop Event */+#define FIFO_CFG5_DV		BIT(1)	/* RX_DV Event */+#define FIFO_CFG5_FC		BIT(2)	/* False Carrier */+#define FIFO_CFG5_CE		BIT(3)	/* Code Error */+#define FIFO_CFG5_LM		BIT(4)	/* Length Mismatch */+#define FIFO_CFG5_LO		BIT(5)	/* Length Out of Range */+#define FIFO_CFG5_OK		BIT(6)	/* Packet is OK */+#define FIFO_CFG5_MC		BIT(7)	/* Multicast Packet */+#define FIFO_CFG5_BC		BIT(8)	/* Broadcast Packet */+#define FIFO_CFG5_DR		BIT(9)	/* Dribble */+#define FIFO_CFG5_CF		BIT(10)	/* Control Frame */+#define FIFO_CFG5_PF		BIT(11)	/* Pause Frame */+#define FIFO_CFG5_UO		BIT(12)	/* Unsupported Opcode */+#define FIFO_CFG5_VT		BIT(13)	/* VLAN tag detected */+#define FIFO_CFG5_LE		BIT(14)	/* Long Event */+#define FIFO_CFG5_FT		BIT(15)	/* Frame Truncated */+#define FIFO_CFG5_16		BIT(16)	/* unknown */+#define FIFO_CFG5_17		BIT(17)	/* unknown */+#define FIFO_CFG5_SF		BIT(18)	/* Short Frame */+#define FIFO_CFG5_BM		BIT(19)	/* Byte Mode */++#define AG71XX_INT_TX_PS	BIT(0)+#define AG71XX_INT_TX_UR	BIT(1)+#define AG71XX_INT_TX_BE	BIT(3)+#define AG71XX_INT_RX_PR	BIT(4)+#define AG71XX_INT_RX_OF	BIT(6)+#define AG71XX_INT_RX_BE	BIT(7)++#define MAC_IFCTL_SPEED		BIT(16)++#define MII_CFG_CLK_DIV_4	0+#define MII_CFG_CLK_DIV_6	2+#define MII_CFG_CLK_DIV_8	3+#define MII_CFG_CLK_DIV_10	4+#define MII_CFG_CLK_DIV_14	5+#define MII_CFG_CLK_DIV_20	6+#define MII_CFG_CLK_DIV_28	7+#define MII_CFG_RESET		BIT(31)++#define MII_CMD_WRITE		0x0+#define MII_CMD_READ		0x1+#define MII_ADDR_SHIFT		8+#define MII_IND_BUSY		BIT(0)+#define MII_IND_INVALID		BIT(2)++#define TX_CTRL_TXE		BIT(0)	/* Tx Enable */++#define TX_STATUS_PS		BIT(0)	/* Packet Sent */+#define TX_STATUS_UR		BIT(1)	/* Tx Underrun */+#define TX_STATUS_BE		BIT(3)	/* Bus Error */++#define RX_CTRL_RXE		BIT(0)	/* Rx Enable */++#define RX_STATUS_PR		BIT(0)	/* Packet Received */+#define RX_STATUS_OF		BIT(2)	/* Rx Overflow */+#define RX_STATUS_BE		BIT(3)	/* Bus Error */++#define MII_CTRL_IF_MASK	3+#define MII_CTRL_SPEED_SHIFT	4+#define MII_CTRL_SPEED_MASK	3+#define MII_CTRL_SPEED_10	0+#define MII_CTRL_SPEED_100	1+#define MII_CTRL_SPEED_1000	2++static inline void ag71xx_check_reg_offset(struct ag71xx *ag, unsigned reg)+{+	switch (reg) {+	case AG71XX_REG_MAC_CFG1 ... AG71XX_REG_MAC_MFL:+	case AG71XX_REG_MAC_IFCTL ... AG71XX_REG_INT_STATUS:+		break;++	default:+		BUG();+	}+}++static inline void ag71xx_wr(struct ag71xx *ag, unsigned reg, u32 value)+{+	ag71xx_check_reg_offset(ag, reg);++	__raw_writel(value, ag->mac_base + reg);+	/* flush write */+	(void) __raw_readl(ag->mac_base + reg);+}++static inline u32 ag71xx_rr(struct ag71xx *ag, unsigned reg)+{+	ag71xx_check_reg_offset(ag, reg);++	return __raw_readl(ag->mac_base + reg);+}++static inline void ag71xx_sb(struct ag71xx *ag, unsigned reg, u32 mask)+{+	void __iomem *r;++	ag71xx_check_reg_offset(ag, reg);++	r = ag->mac_base + reg;+	__raw_writel(__raw_readl(r) | mask, r);+	/* flush write */+	(void)__raw_readl(r);+}++static inline void ag71xx_cb(struct ag71xx *ag, unsigned reg, u32 mask)+{+	void __iomem *r;++	ag71xx_check_reg_offset(ag, reg);++	r = ag->mac_base + reg;+	__raw_writel(__raw_readl(r) & ~mask, r);+	/* flush write */+	(void) __raw_readl(r);+}++static inline void ag71xx_int_enable(struct ag71xx *ag, u32 ints)+{+	ag71xx_sb(ag, AG71XX_REG_INT_ENABLE, ints);+}++static inline void ag71xx_int_disable(struct ag71xx *ag, u32 ints)+{+	ag71xx_cb(ag, AG71XX_REG_INT_ENABLE, ints);+}++static inline void ag71xx_mii_ctrl_wr(struct ag71xx *ag, u32 value)+{+	struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);++	if (pdata->is_ar724x)+		return;++	__raw_writel(value, ag->mii_ctrl);++	/* flush write */+	__raw_readl(ag->mii_ctrl);+}++static inline u32 ag71xx_mii_ctrl_rr(struct ag71xx *ag)+{+	struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);++	if (pdata->is_ar724x)+		return 0xffffffff;++	return __raw_readl(ag->mii_ctrl);+}++static void inline ag71xx_mii_ctrl_set_if(struct ag71xx *ag,+					  unsigned int mii_if)+{+	u32 t;++	t = ag71xx_mii_ctrl_rr(ag);+	t &= ~(MII_CTRL_IF_MASK);+	t |= (mii_if & MII_CTRL_IF_MASK);+	ag71xx_mii_ctrl_wr(ag, t);+}++static void inline ag71xx_mii_ctrl_set_speed(struct ag71xx *ag,+					     unsigned int speed)+{+	u32 t;++	t = ag71xx_mii_ctrl_rr(ag);+	t &= ~(MII_CTRL_SPEED_MASK << MII_CTRL_SPEED_SHIFT);+	t |= (speed & MII_CTRL_SPEED_MASK) << MII_CTRL_SPEED_SHIFT;+	ag71xx_mii_ctrl_wr(ag, t);+}++#ifdef CONFIG_AG71XX_AR8216_SUPPORT+void ag71xx_add_ar8216_header(struct ag71xx *ag, struct sk_buff *skb);+int ag71xx_remove_ar8216_header(struct ag71xx *ag, struct sk_buff *skb,+				int pktlen);+static inline int ag71xx_has_ar8216(struct ag71xx *ag)+{+	return ag71xx_get_pdata(ag)->has_ar8216;+}+#else+static inline void ag71xx_add_ar8216_header(struct ag71xx *ag,+					   struct sk_buff *skb)+{+}++static inline int ag71xx_remove_ar8216_header(struct ag71xx *ag,+					      struct sk_buff *skb,+					      int pktlen)+{+	return 0;+}+static inline int ag71xx_has_ar8216(struct ag71xx *ag)+{+	return 0;+}+#endif++#ifdef CONFIG_AG71XX_DEBUG_FS+int ag71xx_debugfs_root_init(void);+void ag71xx_debugfs_root_exit(void);+int ag71xx_debugfs_init(struct ag71xx *ag);+void ag71xx_debugfs_exit(struct ag71xx *ag);+void ag71xx_debugfs_update_int_stats(struct ag71xx *ag, u32 status);+void ag71xx_debugfs_update_napi_stats(struct ag71xx *ag, int rx, int tx);+#else+static inline int ag71xx_debugfs_root_init(void) { return 0; }+static inline void ag71xx_debugfs_root_exit(void) {}+static inline int ag71xx_debugfs_init(struct ag71xx *ag) { return 0; }+static inline void ag71xx_debugfs_exit(struct ag71xx *ag) {}+static inline void ag71xx_debugfs_update_int_stats(struct ag71xx *ag,+						   u32 status) {}+static inline void ag71xx_debugfs_update_napi_stats(struct ag71xx *ag,+						    int rx, int tx) {}+#endif /* CONFIG_AG71XX_DEBUG_FS */++#endif /* _AG71XX_H */diff -Nur linux-2.6.37.orig/drivers/net/ag71xx/ag71xx_ar8216.c linux-2.6.37/drivers/net/ag71xx/ag71xx_ar8216.c--- linux-2.6.37.orig/drivers/net/ag71xx/ag71xx_ar8216.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/net/ag71xx/ag71xx_ar8216.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,44 @@+/*+ *  Atheros AR71xx built-in ethernet mac driver+ *  Special support for the Atheros ar8216 switch chip+ *+ *  Copyright (C) 2009-2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  Based on Atheros' AG7100 driver+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include "ag71xx.h"++#define AR8216_PACKET_TYPE_MASK		0xf+#define AR8216_PACKET_TYPE_NORMAL	0++#define AR8216_HEADER_LEN	2++void ag71xx_add_ar8216_header(struct ag71xx *ag, struct sk_buff *skb)+{+	skb_push(skb, AR8216_HEADER_LEN);+	skb->data[0] = 0x10;+	skb->data[1] = 0x80;+}++int ag71xx_remove_ar8216_header(struct ag71xx *ag, struct sk_buff *skb,+				int pktlen)+{+	u8 type;++	type = skb->data[1] & AR8216_PACKET_TYPE_MASK;+	switch (type) {+	case AR8216_PACKET_TYPE_NORMAL:+		break;++	default:+		return -EINVAL;+	}++	skb_pull(skb, AR8216_HEADER_LEN);+	return 0;+}diff -Nur linux-2.6.37.orig/drivers/net/ag71xx/ag71xx_debugfs.c linux-2.6.37/drivers/net/ag71xx/ag71xx_debugfs.c--- linux-2.6.37.orig/drivers/net/ag71xx/ag71xx_debugfs.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/net/ag71xx/ag71xx_debugfs.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,197 @@+/*+ *  Atheros AR71xx built-in ethernet mac driver+ *+ *  Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Based on Atheros' AG7100 driver+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/debugfs.h>++#include "ag71xx.h"++static struct dentry *ag71xx_debugfs_root;++static int ag71xx_debugfs_generic_open(struct inode *inode, struct file *file)+{+	file->private_data = inode->i_private;+	return 0;+}++void ag71xx_debugfs_update_int_stats(struct ag71xx *ag, u32 status)+{+	if (status)+		ag->debug.int_stats.total++;+	if (status & AG71XX_INT_TX_PS)+		ag->debug.int_stats.tx_ps++;+	if (status & AG71XX_INT_TX_UR)+		ag->debug.int_stats.tx_ur++;+	if (status & AG71XX_INT_TX_BE)+		ag->debug.int_stats.tx_be++;+	if (status & AG71XX_INT_RX_PR)+		ag->debug.int_stats.rx_pr++;+	if (status & AG71XX_INT_RX_OF)+		ag->debug.int_stats.rx_of++;+	if (status & AG71XX_INT_RX_BE)+		ag->debug.int_stats.rx_be++;+}++static ssize_t read_file_int_stats(struct file *file, char __user *user_buf,+				   size_t count, loff_t *ppos)+{+#define PR_INT_STAT(_label, _field) 					\+	len += snprintf(buf + len, sizeof(buf) - len, 			\+		"%20s: %10lu\n", _label, ag->debug.int_stats._field);++	struct ag71xx *ag = file->private_data;+	char buf[256];+	unsigned int len = 0;++	PR_INT_STAT("TX Packet Sent", tx_ps);+	PR_INT_STAT("TX Underrun", tx_ur);+	PR_INT_STAT("TX Bus Error", tx_be);+	PR_INT_STAT("RX Packet Received", rx_pr);+	PR_INT_STAT("RX Overflow", rx_of);+	PR_INT_STAT("RX Bus Error", rx_be);+	len += snprintf(buf + len, sizeof(buf) - len, "\n");+	PR_INT_STAT("Total", total);++	return simple_read_from_buffer(user_buf, count, ppos, buf, len);+#undef PR_INT_STAT+}++static const struct file_operations ag71xx_fops_int_stats = {+	.open	= ag71xx_debugfs_generic_open,+	.read	= read_file_int_stats,+	.owner	= THIS_MODULE+};++void ag71xx_debugfs_update_napi_stats(struct ag71xx *ag, int rx, int tx)+{+	struct ag71xx_napi_stats *stats = &ag->debug.napi_stats;++	if (rx) {+		stats->rx_count++;+		stats->rx_packets += rx;+		if (rx <= AG71XX_NAPI_WEIGHT)+			stats->rx[rx]++;+		if (rx > stats->rx_packets_max)+			stats->rx_packets_max = rx;+	}++	if (tx) {+		stats->tx_count++;+		stats->tx_packets += tx;+		if (tx <= AG71XX_NAPI_WEIGHT)+			stats->tx[tx]++;+		if (tx > stats->tx_packets_max)+			stats->tx_packets_max = tx;+	}+}++static ssize_t read_file_napi_stats(struct file *file, char __user *user_buf,+				    size_t count, loff_t *ppos)+{+	struct ag71xx *ag = file->private_data;+	struct ag71xx_napi_stats *stats = &ag->debug.napi_stats;+	char buf[2048];+	unsigned int len = 0;+	unsigned long rx_avg = 0;+	unsigned long tx_avg = 0;+	int i;++	if (stats->rx_count)+		rx_avg = stats->rx_packets / stats->rx_count;++	if (stats->tx_count)+		tx_avg = stats->tx_packets / stats->tx_count;++	len += snprintf(buf + len, sizeof(buf) - len, "%3s  %10s %10s\n",+			"len", "rx", "tx");++	for (i = 1; i <= AG71XX_NAPI_WEIGHT; i++)+		len += snprintf(buf + len, sizeof(buf) - len,+				"%3d: %10lu %10lu\n",+				i, stats->rx[i], stats->tx[i]);++	len += snprintf(buf + len, sizeof(buf) - len, "\n");++	len += snprintf(buf + len, sizeof(buf) - len, "%3s: %10lu %10lu\n",+			"sum", stats->rx_count, stats->tx_count);+	len += snprintf(buf + len, sizeof(buf) - len, "%3s: %10lu %10lu\n",+			"avg", rx_avg, tx_avg);+	len += snprintf(buf + len, sizeof(buf) - len, "%3s: %10lu %10lu\n",+			"max", stats->rx_packets_max, stats->tx_packets_max);+	len += snprintf(buf + len, sizeof(buf) - len, "%3s: %10lu %10lu\n",+			"pkt", stats->rx_packets, stats->tx_packets);++	return simple_read_from_buffer(user_buf, count, ppos, buf, len);+}++static const struct file_operations ag71xx_fops_napi_stats = {+	.open	= ag71xx_debugfs_generic_open,+	.read	= read_file_napi_stats,+	.owner	= THIS_MODULE+};++void ag71xx_debugfs_exit(struct ag71xx *ag)+{+	debugfs_remove(ag->debug.debugfs_napi_stats);+	debugfs_remove(ag->debug.debugfs_int_stats);+	debugfs_remove(ag->debug.debugfs_dir);+}++int ag71xx_debugfs_init(struct ag71xx *ag)+{+	ag->debug.debugfs_dir = debugfs_create_dir(ag->dev->name,+						   ag71xx_debugfs_root);+	if (!ag->debug.debugfs_dir)+		goto err;++	ag->debug.debugfs_int_stats =+			debugfs_create_file("int_stats",+					    S_IRUGO,+					    ag->debug.debugfs_dir,+					    ag,+					    &ag71xx_fops_int_stats);+	if (!ag->debug.debugfs_int_stats)+		goto err;++	ag->debug.debugfs_napi_stats =+			debugfs_create_file("napi_stats",+					    S_IRUGO,+					    ag->debug.debugfs_dir,+					    ag,+					    &ag71xx_fops_napi_stats);+	if (!ag->debug.debugfs_napi_stats)+		goto err;++	return 0;++ err:+	ag71xx_debugfs_exit(ag);+	return -ENOMEM;+}++int ag71xx_debugfs_root_init(void)+{+	if (ag71xx_debugfs_root)+		return -EBUSY;++	ag71xx_debugfs_root = debugfs_create_dir(KBUILD_MODNAME, NULL);+	if (!ag71xx_debugfs_root)+		return -ENOENT;++	return 0;+}++void ag71xx_debugfs_root_exit(void)+{+	debugfs_remove(ag71xx_debugfs_root);+	ag71xx_debugfs_root = NULL;+}diff -Nur linux-2.6.37.orig/drivers/net/ag71xx/ag71xx_ethtool.c linux-2.6.37/drivers/net/ag71xx/ag71xx_ethtool.c--- linux-2.6.37.orig/drivers/net/ag71xx/ag71xx_ethtool.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/net/ag71xx/ag71xx_ethtool.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,71 @@+/*+ *  Atheros AR71xx built-in ethernet mac driver+ *+ *  Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Based on Atheros' AG7100 driver+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include "ag71xx.h"++static int ag71xx_ethtool_get_settings(struct net_device *dev,+				       struct ethtool_cmd *cmd)+{+	struct ag71xx *ag = netdev_priv(dev);+	struct phy_device *phydev = ag->phy_dev;++	if (!phydev)+		return -ENODEV;++	return phy_ethtool_gset(phydev, cmd);+}++static int ag71xx_ethtool_set_settings(struct net_device *dev,+				       struct ethtool_cmd *cmd)+{+	struct ag71xx *ag = netdev_priv(dev);+	struct phy_device *phydev = ag->phy_dev;++	if (!phydev)+		return -ENODEV;++	return phy_ethtool_sset(phydev, cmd);+}++static void ag71xx_ethtool_get_drvinfo(struct net_device *dev,+				       struct ethtool_drvinfo *info)+{+	struct ag71xx *ag = netdev_priv(dev);++	strcpy(info->driver, ag->pdev->dev.driver->name);+	strcpy(info->version, AG71XX_DRV_VERSION);+	strcpy(info->bus_info, dev_name(&ag->pdev->dev));+}++static u32 ag71xx_ethtool_get_msglevel(struct net_device *dev)+{+	struct ag71xx *ag = netdev_priv(dev);++	return ag->msg_enable;+}++static void ag71xx_ethtool_set_msglevel(struct net_device *dev, u32 msg_level)+{+	struct ag71xx *ag = netdev_priv(dev);++	ag->msg_enable = msg_level;+}++struct ethtool_ops ag71xx_ethtool_ops = {+	.set_settings	= ag71xx_ethtool_set_settings,+	.get_settings	= ag71xx_ethtool_get_settings,+	.get_drvinfo	= ag71xx_ethtool_get_drvinfo,+	.get_msglevel	= ag71xx_ethtool_get_msglevel,+	.set_msglevel	= ag71xx_ethtool_set_msglevel,+	.get_link	= ethtool_op_get_link,+};diff -Nur linux-2.6.37.orig/drivers/net/ag71xx/ag71xx_main.c linux-2.6.37/drivers/net/ag71xx/ag71xx_main.c--- linux-2.6.37.orig/drivers/net/ag71xx/ag71xx_main.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/net/ag71xx/ag71xx_main.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,1184 @@+/*+ *  Atheros AR71xx built-in ethernet mac driver+ *+ *  Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Based on Atheros' AG7100 driver+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include "ag71xx.h"++#define AG71XX_DEFAULT_MSG_ENABLE	\+	( NETIF_MSG_DRV 		\+	| NETIF_MSG_PROBE		\+	| NETIF_MSG_LINK		\+	| NETIF_MSG_TIMER		\+	| NETIF_MSG_IFDOWN		\+	| NETIF_MSG_IFUP		\+	| NETIF_MSG_RX_ERR		\+	| NETIF_MSG_TX_ERR )++static int ag71xx_msg_level = -1;++module_param_named(msg_level, ag71xx_msg_level, int, 0);+MODULE_PARM_DESC(msg_level, "Message level (-1=defaults,0=none,...,16=all)");++static void ag71xx_dump_dma_regs(struct ag71xx *ag)+{+	DBG("%s: dma_tx_ctrl=%08x, dma_tx_desc=%08x, dma_tx_status=%08x\n",+		ag->dev->name,+		ag71xx_rr(ag, AG71XX_REG_TX_CTRL),+		ag71xx_rr(ag, AG71XX_REG_TX_DESC),+		ag71xx_rr(ag, AG71XX_REG_TX_STATUS));++	DBG("%s: dma_rx_ctrl=%08x, dma_rx_desc=%08x, dma_rx_status=%08x\n",+		ag->dev->name,+		ag71xx_rr(ag, AG71XX_REG_RX_CTRL),+		ag71xx_rr(ag, AG71XX_REG_RX_DESC),+		ag71xx_rr(ag, AG71XX_REG_RX_STATUS));+}++static void ag71xx_dump_regs(struct ag71xx *ag)+{+	DBG("%s: mac_cfg1=%08x, mac_cfg2=%08x, ipg=%08x, hdx=%08x, mfl=%08x\n",+		ag->dev->name,+		ag71xx_rr(ag, AG71XX_REG_MAC_CFG1),+		ag71xx_rr(ag, AG71XX_REG_MAC_CFG2),+		ag71xx_rr(ag, AG71XX_REG_MAC_IPG),+		ag71xx_rr(ag, AG71XX_REG_MAC_HDX),+		ag71xx_rr(ag, AG71XX_REG_MAC_MFL));+	DBG("%s: mac_ifctl=%08x, mac_addr1=%08x, mac_addr2=%08x\n",+		ag->dev->name,+		ag71xx_rr(ag, AG71XX_REG_MAC_IFCTL),+		ag71xx_rr(ag, AG71XX_REG_MAC_ADDR1),+		ag71xx_rr(ag, AG71XX_REG_MAC_ADDR2));+	DBG("%s: fifo_cfg0=%08x, fifo_cfg1=%08x, fifo_cfg2=%08x\n",+		ag->dev->name,+		ag71xx_rr(ag, AG71XX_REG_FIFO_CFG0),+		ag71xx_rr(ag, AG71XX_REG_FIFO_CFG1),+		ag71xx_rr(ag, AG71XX_REG_FIFO_CFG2));+	DBG("%s: fifo_cfg3=%08x, fifo_cfg4=%08x, fifo_cfg5=%08x\n",+		ag->dev->name,+		ag71xx_rr(ag, AG71XX_REG_FIFO_CFG3),+		ag71xx_rr(ag, AG71XX_REG_FIFO_CFG4),+		ag71xx_rr(ag, AG71XX_REG_FIFO_CFG5));+}++static inline void ag71xx_dump_intr(struct ag71xx *ag, char *label, u32 intr)+{+	DBG("%s: %s intr=%08x %s%s%s%s%s%s\n",+		ag->dev->name, label, intr,+		(intr & AG71XX_INT_TX_PS) ? "TXPS " : "",+		(intr & AG71XX_INT_TX_UR) ? "TXUR " : "",+		(intr & AG71XX_INT_TX_BE) ? "TXBE " : "",+		(intr & AG71XX_INT_RX_PR) ? "RXPR " : "",+		(intr & AG71XX_INT_RX_OF) ? "RXOF " : "",+		(intr & AG71XX_INT_RX_BE) ? "RXBE " : "");+}++static void ag71xx_ring_free(struct ag71xx_ring *ring)+{+	kfree(ring->buf);++	if (ring->descs_cpu)+		dma_free_coherent(NULL, ring->size * ring->desc_size,+				  ring->descs_cpu, ring->descs_dma);+}++static int ag71xx_ring_alloc(struct ag71xx_ring *ring, unsigned int size)+{+	int err;+	int i;++	ring->desc_size = sizeof(struct ag71xx_desc);+	if (ring->desc_size % cache_line_size()) {+		DBG("ag71xx: ring %p, desc size %u rounded to %u\n",+			ring, ring->desc_size,+			roundup(ring->desc_size, cache_line_size()));+		ring->desc_size = roundup(ring->desc_size, cache_line_size());+	}++	ring->descs_cpu = dma_alloc_coherent(NULL, size * ring->desc_size,+					     &ring->descs_dma, GFP_ATOMIC);+	if (!ring->descs_cpu) {+		err = -ENOMEM;+		goto err;+	}++	ring->size = size;++	ring->buf = kzalloc(size * sizeof(*ring->buf), GFP_KERNEL);+	if (!ring->buf) {+		err = -ENOMEM;+		goto err;+	}++	for (i = 0; i < size; i++) {+		ring->buf[i].desc = (struct ag71xx_desc *)&ring->descs_cpu[i * ring->desc_size];+		DBG("ag71xx: ring %p, desc %d at %p\n",+			ring, i, ring->buf[i].desc);+	}++	return 0;++ err:+	return err;+}++static void ag71xx_ring_tx_clean(struct ag71xx *ag)+{+	struct ag71xx_ring *ring = &ag->tx_ring;+	struct net_device *dev = ag->dev;++	while (ring->curr != ring->dirty) {+		u32 i = ring->dirty % AG71XX_TX_RING_SIZE;++		if (!ag71xx_desc_empty(ring->buf[i].desc)) {+			ring->buf[i].desc->ctrl = 0;+			dev->stats.tx_errors++;+		}++		if (ring->buf[i].skb)+			dev_kfree_skb_any(ring->buf[i].skb);++		ring->buf[i].skb = NULL;++		ring->dirty++;+	}++	/* flush descriptors */+	wmb();++}++static void ag71xx_ring_tx_init(struct ag71xx *ag)+{+	struct ag71xx_ring *ring = &ag->tx_ring;+	int i;++	for (i = 0; i < AG71XX_TX_RING_SIZE; i++) {+		ring->buf[i].desc->next = (u32) (ring->descs_dma ++			ring->desc_size * ((i + 1) % AG71XX_TX_RING_SIZE));++		ring->buf[i].desc->ctrl = DESC_EMPTY;+		ring->buf[i].skb = NULL;+	}++	/* flush descriptors */+	wmb();++	ring->curr = 0;+	ring->dirty = 0;+}++static void ag71xx_ring_rx_clean(struct ag71xx *ag)+{+	struct ag71xx_ring *ring = &ag->rx_ring;+	int i;++	if (!ring->buf)+		return;++	for (i = 0; i < AG71XX_RX_RING_SIZE; i++)+		if (ring->buf[i].skb) {+			dma_unmap_single(&ag->dev->dev, ring->buf[i].dma_addr,+					 AG71XX_RX_PKT_SIZE, DMA_FROM_DEVICE);+			kfree_skb(ring->buf[i].skb);+		}+}++static int ag71xx_rx_reserve(struct ag71xx *ag)+{+	int reserve = 0;++	if (ag71xx_get_pdata(ag)->is_ar724x) {+		if (!ag71xx_has_ar8216(ag))+			reserve = 2;++		if (ag->phy_dev)+			reserve += 4 - (ag->phy_dev->pkt_align % 4);++		reserve %= 4;+	}++	return reserve + AG71XX_RX_PKT_RESERVE;+}+++static int ag71xx_ring_rx_init(struct ag71xx *ag)+{+	struct ag71xx_ring *ring = &ag->rx_ring;+	unsigned int reserve = ag71xx_rx_reserve(ag);+	unsigned int i;+	int ret;++	ret = 0;+	for (i = 0; i < AG71XX_RX_RING_SIZE; i++) {+		ring->buf[i].desc->next = (u32) (ring->descs_dma ++			ring->desc_size * ((i + 1) % AG71XX_RX_RING_SIZE));++		DBG("ag71xx: RX desc at %p, next is %08x\n",+			ring->buf[i].desc,+			ring->buf[i].desc->next);+	}++	for (i = 0; i < AG71XX_RX_RING_SIZE; i++) {+		struct sk_buff *skb;+		dma_addr_t dma_addr;++		skb = dev_alloc_skb(AG71XX_RX_PKT_SIZE + reserve);+		if (!skb) {+			ret = -ENOMEM;+			break;+		}++		skb->dev = ag->dev;+		skb_reserve(skb, reserve);++		dma_addr = dma_map_single(&ag->dev->dev, skb->data,+					  AG71XX_RX_PKT_SIZE,+					  DMA_FROM_DEVICE);+		ring->buf[i].skb = skb;+		ring->buf[i].dma_addr = dma_addr;+		ring->buf[i].desc->data = (u32) dma_addr;+		ring->buf[i].desc->ctrl = DESC_EMPTY;+	}++	/* flush descriptors */+	wmb();++	ring->curr = 0;+	ring->dirty = 0;++	return ret;+}++static int ag71xx_ring_rx_refill(struct ag71xx *ag)+{+	struct ag71xx_ring *ring = &ag->rx_ring;+	unsigned int reserve = ag71xx_rx_reserve(ag);+	unsigned int count;++	count = 0;+	for (; ring->curr - ring->dirty > 0; ring->dirty++) {+		unsigned int i;++		i = ring->dirty % AG71XX_RX_RING_SIZE;++		if (ring->buf[i].skb == NULL) {+			dma_addr_t dma_addr;+			struct sk_buff *skb;++			skb = dev_alloc_skb(AG71XX_RX_PKT_SIZE + reserve);+			if (skb == NULL)+				break;++			skb_reserve(skb, reserve);+			skb->dev = ag->dev;++			dma_addr = dma_map_single(&ag->dev->dev, skb->data,+						  AG71XX_RX_PKT_SIZE,+						  DMA_FROM_DEVICE);++			ring->buf[i].skb = skb;+			ring->buf[i].dma_addr = dma_addr;+			ring->buf[i].desc->data = (u32) dma_addr;+		}++		ring->buf[i].desc->ctrl = DESC_EMPTY;+		count++;+	}++	/* flush descriptors */+	wmb();++	DBG("%s: %u rx descriptors refilled\n", ag->dev->name, count);++	return count;+}++static int ag71xx_rings_init(struct ag71xx *ag)+{+	int ret;++	ret = ag71xx_ring_alloc(&ag->tx_ring, AG71XX_TX_RING_SIZE);+	if (ret)+		return ret;++	ag71xx_ring_tx_init(ag);++	ret = ag71xx_ring_alloc(&ag->rx_ring, AG71XX_RX_RING_SIZE);+	if (ret)+		return ret;++	ret = ag71xx_ring_rx_init(ag);+	return ret;+}++static void ag71xx_rings_cleanup(struct ag71xx *ag)+{+	ag71xx_ring_rx_clean(ag);+	ag71xx_ring_free(&ag->rx_ring);++	ag71xx_ring_tx_clean(ag);+	ag71xx_ring_free(&ag->tx_ring);+}++static unsigned char *ag71xx_speed_str(struct ag71xx *ag)+{+	switch (ag->speed) {+	case SPEED_1000:+		return "1000";+	case SPEED_100:+		return "100";+	case SPEED_10:+		return "10";+	}++	return "?";+}++void ag71xx_link_adjust(struct ag71xx *ag)+{+	struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);+	u32 cfg2;+	u32 ifctl;+	u32 fifo5;+	u32 mii_speed;++	if (!ag->link) {+		netif_carrier_off(ag->dev);+		if (netif_msg_link(ag))+			printk(KERN_INFO "%s: link down\n", ag->dev->name);+		return;+	}++	cfg2 = ag71xx_rr(ag, AG71XX_REG_MAC_CFG2);+	cfg2 &= ~(MAC_CFG2_IF_1000 | MAC_CFG2_IF_10_100 | MAC_CFG2_FDX);+	cfg2 |= (ag->duplex) ? MAC_CFG2_FDX : 0;++	ifctl = ag71xx_rr(ag, AG71XX_REG_MAC_IFCTL);+	ifctl &= ~(MAC_IFCTL_SPEED);++	fifo5 = ag71xx_rr(ag, AG71XX_REG_FIFO_CFG5);+	fifo5 &= ~FIFO_CFG5_BM;++	switch (ag->speed) {+	case SPEED_1000:+		mii_speed =  MII_CTRL_SPEED_1000;+		cfg2 |= MAC_CFG2_IF_1000;+		fifo5 |= FIFO_CFG5_BM;+		break;+	case SPEED_100:+		mii_speed = MII_CTRL_SPEED_100;+		cfg2 |= MAC_CFG2_IF_10_100;+		ifctl |= MAC_IFCTL_SPEED;+		break;+	case SPEED_10:+		mii_speed = MII_CTRL_SPEED_10;+		cfg2 |= MAC_CFG2_IF_10_100;+		break;+	default:+		BUG();+		return;+	}++	if (pdata->is_ar91xx)+		ag71xx_wr(ag, AG71XX_REG_FIFO_CFG3, 0x00780fff);+	else if (pdata->is_ar724x)+		ag71xx_wr(ag, AG71XX_REG_FIFO_CFG3, pdata->fifo_cfg3);+	else+		ag71xx_wr(ag, AG71XX_REG_FIFO_CFG3, 0x008001ff);++	if (pdata->set_pll)+		pdata->set_pll(ag->speed);++	ag71xx_mii_ctrl_set_speed(ag, mii_speed);++	ag71xx_wr(ag, AG71XX_REG_MAC_CFG2, cfg2);+	ag71xx_wr(ag, AG71XX_REG_FIFO_CFG5, fifo5);+	ag71xx_wr(ag, AG71XX_REG_MAC_IFCTL, ifctl);++	netif_carrier_on(ag->dev);+	if (netif_msg_link(ag))+		printk(KERN_INFO "%s: link up (%sMbps/%s duplex)\n",+			ag->dev->name,+			ag71xx_speed_str(ag),+			(DUPLEX_FULL == ag->duplex) ? "Full" : "Half");++	DBG("%s: fifo_cfg0=%#x, fifo_cfg1=%#x, fifo_cfg2=%#x\n",+		ag->dev->name,+		ag71xx_rr(ag, AG71XX_REG_FIFO_CFG0),+		ag71xx_rr(ag, AG71XX_REG_FIFO_CFG1),+		ag71xx_rr(ag, AG71XX_REG_FIFO_CFG2));++	DBG("%s: fifo_cfg3=%#x, fifo_cfg4=%#x, fifo_cfg5=%#x\n",+		ag->dev->name,+		ag71xx_rr(ag, AG71XX_REG_FIFO_CFG3),+		ag71xx_rr(ag, AG71XX_REG_FIFO_CFG4),+		ag71xx_rr(ag, AG71XX_REG_FIFO_CFG5));++	DBG("%s: mac_cfg2=%#x, mac_ifctl=%#x, mii_ctrl=%#x\n",+		ag->dev->name,+		ag71xx_rr(ag, AG71XX_REG_MAC_CFG2),+		ag71xx_rr(ag, AG71XX_REG_MAC_IFCTL),+		ag71xx_mii_ctrl_rr(ag));+}++static void ag71xx_hw_set_macaddr(struct ag71xx *ag, unsigned char *mac)+{+	u32 t;++	t = (((u32) mac[5]) << 24) | (((u32) mac[4]) << 16)+	  | (((u32) mac[3]) << 8) | ((u32) mac[2]);++	ag71xx_wr(ag, AG71XX_REG_MAC_ADDR1, t);++	t = (((u32) mac[1]) << 24) | (((u32) mac[0]) << 16);+	ag71xx_wr(ag, AG71XX_REG_MAC_ADDR2, t);+}++static void ag71xx_dma_reset(struct ag71xx *ag)+{+	u32 val;+	int i;++	ag71xx_dump_dma_regs(ag);++	/* stop RX and TX */+	ag71xx_wr(ag, AG71XX_REG_RX_CTRL, 0);+	ag71xx_wr(ag, AG71XX_REG_TX_CTRL, 0);++	/* clear descriptor addresses */+	ag71xx_wr(ag, AG71XX_REG_TX_DESC, 0);+	ag71xx_wr(ag, AG71XX_REG_RX_DESC, 0);++	/* clear pending RX/TX interrupts */+	for (i = 0; i < 256; i++) {+		ag71xx_wr(ag, AG71XX_REG_RX_STATUS, RX_STATUS_PR);+		ag71xx_wr(ag, AG71XX_REG_TX_STATUS, TX_STATUS_PS);+	}++	/* clear pending errors */+	ag71xx_wr(ag, AG71XX_REG_RX_STATUS, RX_STATUS_BE | RX_STATUS_OF);+	ag71xx_wr(ag, AG71XX_REG_TX_STATUS, TX_STATUS_BE | TX_STATUS_UR);++	val = ag71xx_rr(ag, AG71XX_REG_RX_STATUS);+	if (val)+		printk(KERN_ALERT "%s: unable to clear DMA Rx status: %08x\n",+			ag->dev->name, val);++	val = ag71xx_rr(ag, AG71XX_REG_TX_STATUS);++	/* mask out reserved bits */+	val &= ~0xff000000;++	if (val)+		printk(KERN_ALERT "%s: unable to clear DMA Tx status: %08x\n",+			ag->dev->name, val);++	ag71xx_dump_dma_regs(ag);+}++#define MAC_CFG1_INIT	(MAC_CFG1_RXE | MAC_CFG1_TXE | \+			 MAC_CFG1_SRX | MAC_CFG1_STX)++#define FIFO_CFG0_INIT	(FIFO_CFG0_ALL << FIFO_CFG0_ENABLE_SHIFT)++#define FIFO_CFG4_INIT	(FIFO_CFG4_DE | FIFO_CFG4_DV | FIFO_CFG4_FC | \+			 FIFO_CFG4_CE | FIFO_CFG4_CR | FIFO_CFG4_LM | \+			 FIFO_CFG4_LO | FIFO_CFG4_OK | FIFO_CFG4_MC | \+			 FIFO_CFG4_BC | FIFO_CFG4_DR | FIFO_CFG4_LE | \+			 FIFO_CFG4_CF | FIFO_CFG4_PF | FIFO_CFG4_UO | \+			 FIFO_CFG4_VT)++#define FIFO_CFG5_INIT	(FIFO_CFG5_DE | FIFO_CFG5_DV | FIFO_CFG5_FC | \+			 FIFO_CFG5_CE | FIFO_CFG5_LO | FIFO_CFG5_OK | \+			 FIFO_CFG5_MC | FIFO_CFG5_BC | FIFO_CFG5_DR | \+			 FIFO_CFG5_CF | FIFO_CFG5_PF | FIFO_CFG5_VT | \+			 FIFO_CFG5_LE | FIFO_CFG5_FT | FIFO_CFG5_16 | \+			 FIFO_CFG5_17 | FIFO_CFG5_SF)++static void ag71xx_hw_init(struct ag71xx *ag)+{+	struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);++	ag71xx_sb(ag, AG71XX_REG_MAC_CFG1, MAC_CFG1_SR);+	udelay(20);++	ar71xx_device_stop(pdata->reset_bit);+	mdelay(100);+	ar71xx_device_start(pdata->reset_bit);+	mdelay(100);++	/* setup MAC configuration registers */+	if (pdata->is_ar724x)+		ag71xx_wr(ag, AG71XX_REG_MAC_CFG1,+			  MAC_CFG1_INIT | MAC_CFG1_TFC | MAC_CFG1_RFC);+	else+		ag71xx_wr(ag, AG71XX_REG_MAC_CFG1, MAC_CFG1_INIT);++	ag71xx_sb(ag, AG71XX_REG_MAC_CFG2,+		  MAC_CFG2_PAD_CRC_EN | MAC_CFG2_LEN_CHECK);++	/* setup max frame length */+	ag71xx_wr(ag, AG71XX_REG_MAC_MFL, AG71XX_TX_MTU_LEN);++	/* setup MII interface type */+	ag71xx_mii_ctrl_set_if(ag, pdata->mii_if);++	/* setup FIFO configuration registers */+	ag71xx_wr(ag, AG71XX_REG_FIFO_CFG0, FIFO_CFG0_INIT);+	if (pdata->is_ar724x) {+		ag71xx_wr(ag, AG71XX_REG_FIFO_CFG1, pdata->fifo_cfg1);+		ag71xx_wr(ag, AG71XX_REG_FIFO_CFG2, pdata->fifo_cfg2);+	} else {+		ag71xx_wr(ag, AG71XX_REG_FIFO_CFG1, 0x0fff0000);+		ag71xx_wr(ag, AG71XX_REG_FIFO_CFG2, 0x00001fff);+	}+	ag71xx_wr(ag, AG71XX_REG_FIFO_CFG4, FIFO_CFG4_INIT);+	ag71xx_wr(ag, AG71XX_REG_FIFO_CFG5, FIFO_CFG5_INIT);++	ag71xx_dma_reset(ag);+}++static void ag71xx_hw_start(struct ag71xx *ag)+{+	/* start RX engine */+	ag71xx_wr(ag, AG71XX_REG_RX_CTRL, RX_CTRL_RXE);++	/* enable interrupts */+	ag71xx_wr(ag, AG71XX_REG_INT_ENABLE, AG71XX_INT_INIT);+}++static void ag71xx_hw_stop(struct ag71xx *ag)+{+	/* disable all interrupts */+	ag71xx_wr(ag, AG71XX_REG_INT_ENABLE, 0);++	ag71xx_dma_reset(ag);+}++static int ag71xx_open(struct net_device *dev)+{+	struct ag71xx *ag = netdev_priv(dev);+	int ret;++	ret = ag71xx_rings_init(ag);+	if (ret)+		goto err;++	napi_enable(&ag->napi);++	netif_carrier_off(dev);+	ag71xx_phy_start(ag);++	ag71xx_wr(ag, AG71XX_REG_TX_DESC, ag->tx_ring.descs_dma);+	ag71xx_wr(ag, AG71XX_REG_RX_DESC, ag->rx_ring.descs_dma);++	ag71xx_hw_set_macaddr(ag, dev->dev_addr);++	ag71xx_hw_start(ag);++	netif_start_queue(dev);++	return 0;++ err:+	ag71xx_rings_cleanup(ag);+	return ret;+}++static int ag71xx_stop(struct net_device *dev)+{+	struct ag71xx *ag = netdev_priv(dev);+	unsigned long flags;++	netif_carrier_off(dev);+	ag71xx_phy_stop(ag);++	spin_lock_irqsave(&ag->lock, flags);++	netif_stop_queue(dev);++	ag71xx_hw_stop(ag);++	napi_disable(&ag->napi);+	del_timer_sync(&ag->oom_timer);++	spin_unlock_irqrestore(&ag->lock, flags);++	ag71xx_rings_cleanup(ag);++	return 0;+}++static netdev_tx_t ag71xx_hard_start_xmit(struct sk_buff *skb,+					  struct net_device *dev)+{+	struct ag71xx *ag = netdev_priv(dev);+	struct ag71xx_ring *ring = &ag->tx_ring;+	struct ag71xx_desc *desc;+	dma_addr_t dma_addr;+	int i;++	i = ring->curr % AG71XX_TX_RING_SIZE;+	desc = ring->buf[i].desc;++	if (!ag71xx_desc_empty(desc))+		goto err_drop;++	if (ag71xx_has_ar8216(ag))+		ag71xx_add_ar8216_header(ag, skb);++	if (skb->len <= 0) {+		DBG("%s: packet len is too small\n", ag->dev->name);+		goto err_drop;+	}++	dma_addr = dma_map_single(&dev->dev, skb->data, skb->len,+				  DMA_TO_DEVICE);++	ring->buf[i].skb = skb;++	/* setup descriptor fields */+	desc->data = (u32) dma_addr;+	desc->ctrl = (skb->len & DESC_PKTLEN_M);++	/* flush descriptor */+	wmb();++	ring->curr++;+	if (ring->curr == (ring->dirty + AG71XX_TX_THRES_STOP)) {+		DBG("%s: tx queue full\n", ag->dev->name);+		netif_stop_queue(dev);+	}++	DBG("%s: packet injected into TX queue\n", ag->dev->name);++	/* enable TX engine */+	ag71xx_wr(ag, AG71XX_REG_TX_CTRL, TX_CTRL_TXE);++	return NETDEV_TX_OK;++ err_drop:+	dev->stats.tx_dropped++;++	dev_kfree_skb(skb);+	return NETDEV_TX_OK;+}++static int ag71xx_do_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)+{+	struct mii_ioctl_data *data = (struct mii_ioctl_data *) &ifr->ifr_data;+	struct ag71xx *ag = netdev_priv(dev);+	int ret;++	switch (cmd) {+	case SIOCETHTOOL:+		if (ag->phy_dev == NULL)+			break;++		spin_lock_irq(&ag->lock);+		ret = phy_ethtool_ioctl(ag->phy_dev, (void *) ifr->ifr_data);+		spin_unlock_irq(&ag->lock);+		return ret;++	case SIOCSIFHWADDR:+		if (copy_from_user+			(dev->dev_addr, ifr->ifr_data, sizeof(dev->dev_addr)))+			return -EFAULT;+		return 0;++	case SIOCGIFHWADDR:+		if (copy_to_user+			(ifr->ifr_data, dev->dev_addr, sizeof(dev->dev_addr)))+			return -EFAULT;+		return 0;++	case SIOCGMIIPHY:+	case SIOCGMIIREG:+	case SIOCSMIIREG:+		if (ag->phy_dev == NULL)+			break;++		return phy_mii_ioctl(ag->phy_dev, data, cmd);++	default:+		break;+	}++	return -EOPNOTSUPP;+}++static void ag71xx_oom_timer_handler(unsigned long data)+{+	struct net_device *dev = (struct net_device *) data;+	struct ag71xx *ag = netdev_priv(dev);++	napi_schedule(&ag->napi);+}++static void ag71xx_tx_timeout(struct net_device *dev)+{+	struct ag71xx *ag = netdev_priv(dev);++	if (netif_msg_tx_err(ag))+		printk(KERN_DEBUG "%s: tx timeout\n", ag->dev->name);++	schedule_work(&ag->restart_work);+}++static void ag71xx_restart_work_func(struct work_struct *work)+{+	struct ag71xx *ag = container_of(work, struct ag71xx, restart_work);++	ag71xx_stop(ag->dev);+	ag71xx_open(ag->dev);+}++static int ag71xx_tx_packets(struct ag71xx *ag)+{+	struct ag71xx_ring *ring = &ag->tx_ring;+	int sent;++	DBG("%s: processing TX ring\n", ag->dev->name);++	sent = 0;+	while (ring->dirty != ring->curr) {+		unsigned int i = ring->dirty % AG71XX_TX_RING_SIZE;+		struct ag71xx_desc *desc = ring->buf[i].desc;+		struct sk_buff *skb = ring->buf[i].skb;++		if (!ag71xx_desc_empty(desc))+			break;++		ag71xx_wr(ag, AG71XX_REG_TX_STATUS, TX_STATUS_PS);++		ag->dev->stats.tx_bytes += skb->len;+		ag->dev->stats.tx_packets++;++		dev_kfree_skb_any(skb);+		ring->buf[i].skb = NULL;++		ring->dirty++;+		sent++;+	}++	DBG("%s: %d packets sent out\n", ag->dev->name, sent);++	if ((ring->curr - ring->dirty) < AG71XX_TX_THRES_WAKEUP)+		netif_wake_queue(ag->dev);++	return sent;+}++static int ag71xx_rx_packets(struct ag71xx *ag, int limit)+{+	struct net_device *dev = ag->dev;+	struct ag71xx_ring *ring = &ag->rx_ring;+	int done = 0;++	DBG("%s: rx packets, limit=%d, curr=%u, dirty=%u\n",+			dev->name, limit, ring->curr, ring->dirty);++	while (done < limit) {+		unsigned int i = ring->curr % AG71XX_RX_RING_SIZE;+		struct ag71xx_desc *desc = ring->buf[i].desc;+		struct sk_buff *skb;+		int pktlen;+		int err = 0;++		if (ag71xx_desc_empty(desc))+			break;++		if ((ring->dirty + AG71XX_RX_RING_SIZE) == ring->curr) {+			ag71xx_assert(0);+			break;+		}++		ag71xx_wr(ag, AG71XX_REG_RX_STATUS, RX_STATUS_PR);++		skb = ring->buf[i].skb;+		pktlen = ag71xx_desc_pktlen(desc);+		pktlen -= ETH_FCS_LEN;++		dma_unmap_single(&dev->dev, ring->buf[i].dma_addr,+				 AG71XX_RX_PKT_SIZE, DMA_FROM_DEVICE);++		dev->last_rx = jiffies;+		dev->stats.rx_packets++;+		dev->stats.rx_bytes += pktlen;++		skb_put(skb, pktlen);+		if (ag71xx_has_ar8216(ag))+			err = ag71xx_remove_ar8216_header(ag, skb, pktlen);++		if (err) {+			dev->stats.rx_dropped++;+			kfree_skb(skb);+		} else {+			skb->dev = dev;+			skb->ip_summed = CHECKSUM_NONE;+			if (ag->phy_dev) {+				ag->phy_dev->netif_receive_skb(skb);+			} else {+				skb->protocol = eth_type_trans(skb, dev);+				netif_receive_skb(skb);+			}+		}++		ring->buf[i].skb = NULL;+		done++;++		ring->curr++;+	}++	ag71xx_ring_rx_refill(ag);++	DBG("%s: rx finish, curr=%u, dirty=%u, done=%d\n",+		dev->name, ring->curr, ring->dirty, done);++	return done;+}++static int ag71xx_poll(struct napi_struct *napi, int limit)+{+	struct ag71xx *ag = container_of(napi, struct ag71xx, napi);+	struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);+	struct net_device *dev = ag->dev;+	struct ag71xx_ring *rx_ring;+	unsigned long flags;+	u32 status;+	int tx_done;+	int rx_done;++	pdata->ddr_flush();+	tx_done = ag71xx_tx_packets(ag);++	DBG("%s: processing RX ring\n", dev->name);+	rx_done = ag71xx_rx_packets(ag, limit);++	ag71xx_debugfs_update_napi_stats(ag, rx_done, tx_done);++	rx_ring = &ag->rx_ring;+	if (rx_ring->buf[rx_ring->dirty % AG71XX_RX_RING_SIZE].skb == NULL)+		goto oom;++	status = ag71xx_rr(ag, AG71XX_REG_RX_STATUS);+	if (unlikely(status & RX_STATUS_OF)) {+		ag71xx_wr(ag, AG71XX_REG_RX_STATUS, RX_STATUS_OF);+		dev->stats.rx_fifo_errors++;++		/* restart RX */+		ag71xx_wr(ag, AG71XX_REG_RX_CTRL, RX_CTRL_RXE);+	}++	if (rx_done < limit) {+		if (status & RX_STATUS_PR)+			goto more;++		status = ag71xx_rr(ag, AG71XX_REG_TX_STATUS);+		if (status & TX_STATUS_PS)+			goto more;++		DBG("%s: disable polling mode, rx=%d, tx=%d,limit=%d\n",+			dev->name, rx_done, tx_done, limit);++		napi_complete(napi);++		/* enable interrupts */+		spin_lock_irqsave(&ag->lock, flags);+		ag71xx_int_enable(ag, AG71XX_INT_POLL);+		spin_unlock_irqrestore(&ag->lock, flags);+		return rx_done;+	}++ more:+	DBG("%s: stay in polling mode, rx=%d, tx=%d, limit=%d\n",+			dev->name, rx_done, tx_done, limit);+	return rx_done;++ oom:+	if (netif_msg_rx_err(ag))+		printk(KERN_DEBUG "%s: out of memory\n", dev->name);++	mod_timer(&ag->oom_timer, jiffies + AG71XX_OOM_REFILL);+	napi_complete(napi);+	return 0;+}++static irqreturn_t ag71xx_interrupt(int irq, void *dev_id)+{+	struct net_device *dev = dev_id;+	struct ag71xx *ag = netdev_priv(dev);+	u32 status;++	status = ag71xx_rr(ag, AG71XX_REG_INT_STATUS);+	ag71xx_dump_intr(ag, "raw", status);++	if (unlikely(!status))+		return IRQ_NONE;++	if (unlikely(status & AG71XX_INT_ERR)) {+		if (status & AG71XX_INT_TX_BE) {+			ag71xx_wr(ag, AG71XX_REG_TX_STATUS, TX_STATUS_BE);+			dev_err(&dev->dev, "TX BUS error\n");+		}+		if (status & AG71XX_INT_RX_BE) {+			ag71xx_wr(ag, AG71XX_REG_RX_STATUS, RX_STATUS_BE);+			dev_err(&dev->dev, "RX BUS error\n");+		}+	}++	if (likely(status & AG71XX_INT_POLL)) {+		ag71xx_int_disable(ag, AG71XX_INT_POLL);+		DBG("%s: enable polling mode\n", dev->name);+		napi_schedule(&ag->napi);+	}++	ag71xx_debugfs_update_int_stats(ag, status);++	return IRQ_HANDLED;+}++static void ag71xx_set_multicast_list(struct net_device *dev)+{+	/* TODO */+}++#ifdef CONFIG_NET_POLL_CONTROLLER+/*+ * Polling 'interrupt' - used by things like netconsole to send skbs+ * without having to re-enable interrupts. It's not called while+ * the interrupt routine is executing.+ */+static void ag71xx_netpoll(struct net_device *dev)+{+	disable_irq(dev->irq);+	ag71xx_interrupt(dev->irq, dev);+	enable_irq(dev->irq);+}+#endif++static const struct net_device_ops ag71xx_netdev_ops = {+	.ndo_open		= ag71xx_open,+	.ndo_stop		= ag71xx_stop,+	.ndo_start_xmit		= ag71xx_hard_start_xmit,+	.ndo_set_multicast_list	= ag71xx_set_multicast_list,+	.ndo_do_ioctl		= ag71xx_do_ioctl,+	.ndo_tx_timeout		= ag71xx_tx_timeout,+	.ndo_change_mtu		= eth_change_mtu,+	.ndo_set_mac_address	= eth_mac_addr,+	.ndo_validate_addr	= eth_validate_addr,+#ifdef CONFIG_NET_POLL_CONTROLLER+	.ndo_poll_controller	= ag71xx_netpoll,+#endif+};++static int __init ag71xx_probe(struct platform_device *pdev)+{+	struct net_device *dev;+	struct resource *res;+	struct ag71xx *ag;+	struct ag71xx_platform_data *pdata;+	int err;++	pdata = pdev->dev.platform_data;+	if (!pdata) {+		dev_err(&pdev->dev, "no platform data specified\n");+		err = -ENXIO;+		goto err_out;+	}++	if (pdata->mii_bus_dev == NULL) {+		dev_err(&pdev->dev, "no MII bus device specified\n");+		err = -EINVAL;+		goto err_out;+	}++	dev = alloc_etherdev(sizeof(*ag));+	if (!dev) {+		dev_err(&pdev->dev, "alloc_etherdev failed\n");+		err = -ENOMEM;+		goto err_out;+	}++	SET_NETDEV_DEV(dev, &pdev->dev);++	ag = netdev_priv(dev);+	ag->pdev = pdev;+	ag->dev = dev;+	ag->msg_enable = netif_msg_init(ag71xx_msg_level,+					AG71XX_DEFAULT_MSG_ENABLE);+	spin_lock_init(&ag->lock);++	res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mac_base");+	if (!res) {+		dev_err(&pdev->dev, "no mac_base resource found\n");+		err = -ENXIO;+		goto err_out;+	}++	ag->mac_base = ioremap_nocache(res->start, res->end - res->start + 1);+	if (!ag->mac_base) {+		dev_err(&pdev->dev, "unable to ioremap mac_base\n");+		err = -ENOMEM;+		goto err_free_dev;+	}++	res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mii_ctrl");+	if (!res) {+		dev_err(&pdev->dev, "no mii_ctrl resource found\n");+		err = -ENXIO;+		goto err_unmap_base;+	}++	ag->mii_ctrl = ioremap_nocache(res->start, res->end - res->start + 1);+	if (!ag->mii_ctrl) {+		dev_err(&pdev->dev, "unable to ioremap mii_ctrl\n");+		err = -ENOMEM;+		goto err_unmap_base;+	}++	dev->irq = platform_get_irq(pdev, 0);+	err = request_irq(dev->irq, ag71xx_interrupt,+			  IRQF_DISABLED | IRQF_SAMPLE_RANDOM,+			  dev->name, dev);+	if (err) {+		dev_err(&pdev->dev, "unable to request IRQ %d\n", dev->irq);+		goto err_unmap_mii_ctrl;+	}++	dev->base_addr = (unsigned long)ag->mac_base;+	dev->netdev_ops = &ag71xx_netdev_ops;+	dev->ethtool_ops = &ag71xx_ethtool_ops;++	INIT_WORK(&ag->restart_work, ag71xx_restart_work_func);++	init_timer(&ag->oom_timer);+	ag->oom_timer.data = (unsigned long) dev;+	ag->oom_timer.function = ag71xx_oom_timer_handler;++	memcpy(dev->dev_addr, pdata->mac_addr, ETH_ALEN);++	netif_napi_add(dev, &ag->napi, ag71xx_poll, AG71XX_NAPI_WEIGHT);++	err = register_netdev(dev);+	if (err) {+		dev_err(&pdev->dev, "unable to register net device\n");+		goto err_free_irq;+	}++	printk(KERN_INFO "%s: Atheros AG71xx at 0x%08lx, irq %d\n",+	       dev->name, dev->base_addr, dev->irq);++	ag71xx_dump_regs(ag);++	ag71xx_hw_init(ag);++	ag71xx_dump_regs(ag);++	err = ag71xx_phy_connect(ag);+	if (err)+		goto err_unregister_netdev;++	err = ag71xx_debugfs_init(ag);+	if (err)+		goto err_phy_disconnect;++	platform_set_drvdata(pdev, dev);++	return 0;++ err_phy_disconnect:+	ag71xx_phy_disconnect(ag);+ err_unregister_netdev:+	unregister_netdev(dev);+ err_free_irq:+	free_irq(dev->irq, dev);+ err_unmap_mii_ctrl:+	iounmap(ag->mii_ctrl);+ err_unmap_base:+	iounmap(ag->mac_base);+ err_free_dev:+	kfree(dev);+ err_out:+	platform_set_drvdata(pdev, NULL);+	return err;+}++static int __exit ag71xx_remove(struct platform_device *pdev)+{+	struct net_device *dev = platform_get_drvdata(pdev);++	if (dev) {+		struct ag71xx *ag = netdev_priv(dev);++		ag71xx_debugfs_exit(ag);+		ag71xx_phy_disconnect(ag);+		unregister_netdev(dev);+		free_irq(dev->irq, dev);+		iounmap(ag->mii_ctrl);+		iounmap(ag->mac_base);+		kfree(dev);+		platform_set_drvdata(pdev, NULL);+	}++	return 0;+}++static struct platform_driver ag71xx_driver = {+	.probe		= ag71xx_probe,+	.remove		= __exit_p(ag71xx_remove),+	.driver = {+		.name	= AG71XX_DRV_NAME,+	}+};++static int __init ag71xx_module_init(void)+{+	int ret;++	ret = ag71xx_debugfs_root_init();+	if (ret)+		goto err_out;++	ret = ag71xx_mdio_driver_init();+	if (ret)+		goto err_debugfs_exit;++	ret = platform_driver_register(&ag71xx_driver);+	if (ret)+		goto err_mdio_exit;++	return 0;++ err_mdio_exit:+	ag71xx_mdio_driver_exit();+ err_debugfs_exit:+	ag71xx_debugfs_root_exit();+ err_out:+	return ret;+}++static void __exit ag71xx_module_exit(void)+{+	platform_driver_unregister(&ag71xx_driver);+	ag71xx_mdio_driver_exit();+	ag71xx_debugfs_root_exit();+}++module_init(ag71xx_module_init);+module_exit(ag71xx_module_exit);++MODULE_VERSION(AG71XX_DRV_VERSION);+MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");+MODULE_AUTHOR("Imre Kaloz <kaloz@openwrt.org>");+MODULE_LICENSE("GPL v2");+MODULE_ALIAS("platform:" AG71XX_DRV_NAME);diff -Nur linux-2.6.37.orig/drivers/net/ag71xx/ag71xx_mdio.c linux-2.6.37/drivers/net/ag71xx/ag71xx_mdio.c--- linux-2.6.37.orig/drivers/net/ag71xx/ag71xx_mdio.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/net/ag71xx/ag71xx_mdio.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,243 @@+/*+ *  Atheros AR71xx built-in ethernet mac driver+ *+ *  Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Based on Atheros' AG7100 driver+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include "ag71xx.h"++#define AG71XX_MDIO_RETRY	1000+#define AG71XX_MDIO_DELAY	5++static inline void ag71xx_mdio_wr(struct ag71xx_mdio *am, unsigned reg,+				  u32 value)+{+	void __iomem *r;++	r = am->mdio_base + reg;+	__raw_writel(value, r);++	/* flush write */+	(void) __raw_readl(r);+}++static inline u32 ag71xx_mdio_rr(struct ag71xx_mdio *am, unsigned reg)+{+	return __raw_readl(am->mdio_base + reg);+}++static void ag71xx_mdio_dump_regs(struct ag71xx_mdio *am)+{+	DBG("%s: mii_cfg=%08x, mii_cmd=%08x, mii_addr=%08x\n",+		am->mii_bus->name,+		ag71xx_mdio_rr(am, AG71XX_REG_MII_CFG),+		ag71xx_mdio_rr(am, AG71XX_REG_MII_CMD),+		ag71xx_mdio_rr(am, AG71XX_REG_MII_ADDR));+	DBG("%s: mii_ctrl=%08x, mii_status=%08x, mii_ind=%08x\n",+		am->mii_bus->name,+		ag71xx_mdio_rr(am, AG71XX_REG_MII_CTRL),+		ag71xx_mdio_rr(am, AG71XX_REG_MII_STATUS),+		ag71xx_mdio_rr(am, AG71XX_REG_MII_IND));+}++static int ag71xx_mdio_mii_read(struct ag71xx_mdio *am, int addr, int reg)+{+	int ret;+	int i;++	ag71xx_mdio_wr(am, AG71XX_REG_MII_CMD, MII_CMD_WRITE);+	ag71xx_mdio_wr(am, AG71XX_REG_MII_ADDR,+			((addr & 0xff) << MII_ADDR_SHIFT) | (reg & 0xff));+	ag71xx_mdio_wr(am, AG71XX_REG_MII_CMD, MII_CMD_READ);++	i = AG71XX_MDIO_RETRY;+	while (ag71xx_mdio_rr(am, AG71XX_REG_MII_IND) & MII_IND_BUSY) {+		if (i-- == 0) {+			printk(KERN_ERR "%s: mii_read timed out\n",+				am->mii_bus->name);+			ret = 0xffff;+			goto out;+		}+		udelay(AG71XX_MDIO_DELAY);+	}++	ret = ag71xx_mdio_rr(am, AG71XX_REG_MII_STATUS) & 0xffff;+	ag71xx_mdio_wr(am, AG71XX_REG_MII_CMD, MII_CMD_WRITE);++	DBG("mii_read: addr=%04x, reg=%04x, value=%04x\n", addr, reg, ret);++ out:+	return ret;+}++static void ag71xx_mdio_mii_write(struct ag71xx_mdio *am,+				  int addr, int reg, u16 val)+{+	int i;++	DBG("mii_write: addr=%04x, reg=%04x, value=%04x\n", addr, reg, val);++	ag71xx_mdio_wr(am, AG71XX_REG_MII_ADDR,+			((addr & 0xff) << MII_ADDR_SHIFT) | (reg & 0xff));+	ag71xx_mdio_wr(am, AG71XX_REG_MII_CTRL, val);++	i = AG71XX_MDIO_RETRY;+	while (ag71xx_mdio_rr(am, AG71XX_REG_MII_IND) & MII_IND_BUSY) {+		if (i-- == 0) {+			printk(KERN_ERR "%s: mii_write timed out\n",+				am->mii_bus->name);+			break;+		}+		udelay(AG71XX_MDIO_DELAY);+	}+}++static int ag71xx_mdio_reset(struct mii_bus *bus)+{+	struct ag71xx_mdio *am = bus->priv;+	u32 t;++	if (am->pdata->is_ar7240)+		t = MII_CFG_CLK_DIV_6;+	else+		t = MII_CFG_CLK_DIV_28;++	ag71xx_mdio_wr(am, AG71XX_REG_MII_CFG, t | MII_CFG_RESET);+	udelay(100);++	ag71xx_mdio_wr(am, AG71XX_REG_MII_CFG, t);+	udelay(100);++	return 0;+}++static int ag71xx_mdio_read(struct mii_bus *bus, int addr, int reg)+{+	struct ag71xx_mdio *am = bus->priv;++	return ag71xx_mdio_mii_read(am, addr, reg);+}++static int ag71xx_mdio_write(struct mii_bus *bus, int addr, int reg, u16 val)+{+	struct ag71xx_mdio *am = bus->priv;++	ag71xx_mdio_mii_write(am, addr, reg, val);+	return 0;+}++static int __init ag71xx_mdio_probe(struct platform_device *pdev)+{+	struct ag71xx_mdio_platform_data *pdata;+	struct ag71xx_mdio *am;+	struct resource *res;+	int i;+	int err;++	pdata = pdev->dev.platform_data;+	if (!pdata) {+		dev_err(&pdev->dev, "no platform data specified\n");+		return -EINVAL;+	}++	am = kzalloc(sizeof(*am), GFP_KERNEL);+	if (!am) {+		err = -ENOMEM;+		goto err_out;+	}++	am->pdata = pdata;++	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);+	if (!res) {+		dev_err(&pdev->dev, "no iomem resource found\n");+		err = -ENXIO;+		goto err_out;+	}++	am->mdio_base = ioremap_nocache(res->start, res->end - res->start + 1);+	if (!am->mdio_base) {+		dev_err(&pdev->dev, "unable to ioremap registers\n");+		err = -ENOMEM;+		goto err_free_mdio;+	}++	am->mii_bus = mdiobus_alloc();+	if (am->mii_bus == NULL) {+		err = -ENOMEM;+		goto err_iounmap;+	}++	am->mii_bus->name = "ag71xx_mdio";+	am->mii_bus->read = ag71xx_mdio_read;+	am->mii_bus->write = ag71xx_mdio_write;+	am->mii_bus->reset = ag71xx_mdio_reset;+	am->mii_bus->irq = am->mii_irq;+	am->mii_bus->priv = am;+	am->mii_bus->parent = &pdev->dev;+	snprintf(am->mii_bus->id, MII_BUS_ID_SIZE, "%s", dev_name(&pdev->dev));+	am->mii_bus->phy_mask = pdata->phy_mask;++	for (i = 0; i < PHY_MAX_ADDR; i++)+		am->mii_irq[i] = PHY_POLL;++	ag71xx_mdio_wr(am, AG71XX_REG_MAC_CFG1, 0);++	err = mdiobus_register(am->mii_bus);+	if (err)+		goto err_free_bus;++	ag71xx_mdio_dump_regs(am);++	platform_set_drvdata(pdev, am);+	return 0;++ err_free_bus:+	mdiobus_free(am->mii_bus);+ err_iounmap:+	iounmap(am->mdio_base);+ err_free_mdio:+	kfree(am);+ err_out:+	return err;+}++static int __exit ag71xx_mdio_remove(struct platform_device *pdev)+{+	struct ag71xx_mdio *am = platform_get_drvdata(pdev);++	if (am) {+		mdiobus_unregister(am->mii_bus);+		mdiobus_free(am->mii_bus);+		iounmap(am->mdio_base);+		kfree(am);+		platform_set_drvdata(pdev, NULL);+	}++	return 0;+}++static struct platform_driver ag71xx_mdio_driver = {+	.probe		= ag71xx_mdio_probe,+	.remove		= __exit_p(ag71xx_mdio_remove),+	.driver = {+		.name	= "ag71xx-mdio",+	}+};++int ag71xx_mdio_driver_init(void)+{+	return platform_driver_register(&ag71xx_mdio_driver);+}++void ag71xx_mdio_driver_exit(void)+{+	platform_driver_unregister(&ag71xx_mdio_driver);+}diff -Nur linux-2.6.37.orig/drivers/net/ag71xx/ag71xx_phy.c linux-2.6.37/drivers/net/ag71xx/ag71xx_phy.c--- linux-2.6.37.orig/drivers/net/ag71xx/ag71xx_phy.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/net/ag71xx/ag71xx_phy.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,213 @@+/*+ *  Atheros AR71xx built-in ethernet mac driver+ *+ *  Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Based on Atheros' AG7100 driver+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include "ag71xx.h"++static void ag71xx_phy_link_adjust(struct net_device *dev)+{+	struct ag71xx *ag = netdev_priv(dev);+	struct phy_device *phydev = ag->phy_dev;+	unsigned long flags;+	int status_change = 0;++	spin_lock_irqsave(&ag->lock, flags);++	if (phydev->link) {+		if (ag->duplex != phydev->duplex+		    || ag->speed != phydev->speed) {+			status_change = 1;+		}+	}++	if (phydev->link != ag->link)+		status_change = 1;++	ag->link = phydev->link;+	ag->duplex = phydev->duplex;+	ag->speed = phydev->speed;++	if (status_change)+		ag71xx_link_adjust(ag);++	spin_unlock_irqrestore(&ag->lock, flags);+}++void ag71xx_phy_start(struct ag71xx *ag)+{+	if (ag->phy_dev) {+		phy_start(ag->phy_dev);+	} else {+		ag->link = 1;+		ag71xx_link_adjust(ag);+	}+}++void ag71xx_phy_stop(struct ag71xx *ag)+{+	if (ag->phy_dev) {+		phy_stop(ag->phy_dev);+	} else {+		ag->link = 0;+		ag71xx_link_adjust(ag);+	}+}++static int ag71xx_phy_connect_fixed(struct ag71xx *ag)+{+	struct net_device *dev = ag->dev;+	struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);+	int ret = 0;++	/* use fixed settings */+	switch (pdata->speed) {+	case SPEED_10:+	case SPEED_100:+	case SPEED_1000:+		break;+	default:+		printk(KERN_ERR "%s: invalid speed specified\n", dev->name);+		ret = -EINVAL;+		break;+	}++	printk(KERN_DEBUG "%s: using fixed link parameters\n", dev->name);++	ag->duplex = pdata->duplex;+	ag->speed = pdata->speed;++	return ret;+}++static int ag71xx_phy_connect_multi(struct ag71xx *ag)+{+	struct net_device *dev = ag->dev;+	struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);+	struct phy_device *phydev = NULL;+	int phy_addr;+	int ret = 0;++	for (phy_addr = 0; phy_addr < PHY_MAX_ADDR; phy_addr++) {+		if (!(pdata->phy_mask & (1 << phy_addr)))+			continue;++		if (ag->mii_bus->phy_map[phy_addr] == NULL)+			continue;++		DBG("%s: PHY found at %s, uid=%08x\n",+			dev->name,+			dev_name(&ag->mii_bus->phy_map[phy_addr]->dev),+			ag->mii_bus->phy_map[phy_addr]->phy_id);++		if (phydev == NULL)+			phydev = ag->mii_bus->phy_map[phy_addr];+	}++	if (!phydev) {+		printk(KERN_ERR "%s: no PHY found with phy_mask=%08x\n",+			dev->name, pdata->phy_mask);+		return -ENODEV;+	}++	ag->phy_dev = phy_connect(dev, dev_name(&phydev->dev),+				  &ag71xx_phy_link_adjust, 0,+				  pdata->phy_if_mode);++	if (IS_ERR(ag->phy_dev)) {+		printk(KERN_ERR "%s: could not connect to PHY at %s\n",+			dev->name, dev_name(&phydev->dev));+		return PTR_ERR(ag->phy_dev);+	}++	/* mask with MAC supported features */+	if (pdata->has_gbit)+		phydev->supported &= PHY_GBIT_FEATURES;+	else+		phydev->supported &= PHY_BASIC_FEATURES;++	phydev->advertising = phydev->supported;++	printk(KERN_DEBUG "%s: connected to PHY at %s [uid=%08x, driver=%s]\n",+		dev->name, dev_name(&phydev->dev),+		phydev->phy_id, phydev->drv->name);++	ag->link = 0;+	ag->speed = 0;+	ag->duplex = -1;++	return ret;+}++static int dev_is_class(struct device *dev, void *class)+{+	if (dev->class != NULL && !strcmp(dev->class->name, class))+		return 1;++	return 0;+}++static struct device *dev_find_class(struct device *parent, char *class)+{+	if (dev_is_class(parent, class)) {+		get_device(parent);+		return parent;+	}++	return device_find_child(parent, class, dev_is_class);+}++static struct mii_bus *dev_to_mii_bus(struct device *dev)+{+	struct device *d;++	d = dev_find_class(dev, "mdio_bus");+	if (d != NULL) {+		struct mii_bus *bus;++		bus = to_mii_bus(d);+		put_device(d);++		return bus;+	}++	return NULL;+}++int ag71xx_phy_connect(struct ag71xx *ag)+{+	struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);++	ag->mii_bus = dev_to_mii_bus(pdata->mii_bus_dev);+	if (ag->mii_bus == NULL) {+		printk(KERN_ERR "%s: unable to find MII bus on device '%s'\n",+			ag->dev->name, dev_name(pdata->mii_bus_dev));+		return -ENODEV;+	}++	/* Reset the mdio bus explicitly */+	if (ag->mii_bus->reset) {+		mutex_lock(&ag->mii_bus->mdio_lock);+		ag->mii_bus->reset(ag->mii_bus);+		mutex_unlock(&ag->mii_bus->mdio_lock);+	}++	if (pdata->phy_mask)+		return ag71xx_phy_connect_multi(ag);++	return ag71xx_phy_connect_fixed(ag);+}++void ag71xx_phy_disconnect(struct ag71xx *ag)+{+	if (ag->phy_dev)+		phy_disconnect(ag->phy_dev);+}diff -Nur linux-2.6.37.orig/drivers/net/phy/Kconfig linux-2.6.37/drivers/net/phy/Kconfig--- linux-2.6.37.orig/drivers/net/phy/Kconfig	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/net/phy/Kconfig	2011-01-11 20:25:48.000000000 +0100@@ -92,6 +92,10 @@ 	---help--- 	  Supports the KSZ9021, VSC8201, KS8001 PHYs. +config IP175C_PHY+	tristate "Driver for IC+ IP175C/IP178C switches"+	select SWCONFIG+ config FIXED_PHY 	bool "Driver for MDIO Bus/PHY emulation with fixed speed/link PHYs" 	depends on PHYLIB=ydiff -Nur linux-2.6.37.orig/drivers/net/phy/phy.c linux-2.6.37/drivers/net/phy/phy.c--- linux-2.6.37.orig/drivers/net/phy/phy.c	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/net/phy/phy.c	2011-01-11 20:25:48.000000000 +0100@@ -297,6 +297,50 @@ } EXPORT_SYMBOL(phy_ethtool_gset); +int phy_ethtool_ioctl(struct phy_device *phydev, void *useraddr)+{+	u32 cmd;+	int tmp;+	struct ethtool_cmd ecmd = { ETHTOOL_GSET };+	struct ethtool_value edata = { ETHTOOL_GLINK };++	if (get_user(cmd, (u32 *) useraddr))+		return -EFAULT;++	switch (cmd) {+	case ETHTOOL_GSET:+		phy_ethtool_gset(phydev, &ecmd);+		if (copy_to_user(useraddr, &ecmd, sizeof(ecmd)))+			return -EFAULT;+		return 0;++	case ETHTOOL_SSET:+		if (copy_from_user(&ecmd, useraddr, sizeof(ecmd)))+			return -EFAULT;+		return phy_ethtool_sset(phydev, &ecmd);++	case ETHTOOL_NWAY_RST:+		/* if autoneg is off, it's an error */+		tmp = phy_read(phydev, MII_BMCR);+		if (tmp & BMCR_ANENABLE) {+			tmp |= (BMCR_ANRESTART);+			phy_write(phydev, MII_BMCR, tmp);+			return 0;+		}+		return -EINVAL;++	case ETHTOOL_GLINK:+		edata.data = (phy_read(phydev,+				MII_BMSR) & BMSR_LSTATUS) ? 1 : 0;+		if (copy_to_user(useraddr, &edata, sizeof(edata)))+			return -EFAULT;+		return 0;+	}++	return -EOPNOTSUPP;+}+EXPORT_SYMBOL(phy_ethtool_ioctl);+ /**  * phy_mii_ioctl - generic PHY MII ioctl interface  * @phydev: the phy_device struct@@ -351,7 +395,7 @@ 		}  		phy_write(phydev, mii_data->reg_num, val);-		+ 		if (mii_data->reg_num == MII_BMCR && 		    val & BMCR_RESET && 		    phydev->drv->config_init) {@@ -470,7 +514,7 @@ 	int idx;  	idx = phy_find_setting(phydev->speed, phydev->duplex);-	+ 	idx++;  	idx = phy_find_valid(idx, phydev->supported);diff -Nur linux-2.6.37.orig/drivers/net/phy/phy_device.c linux-2.6.37/drivers/net/phy/phy_device.c--- linux-2.6.37.orig/drivers/net/phy/phy_device.c	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/net/phy/phy_device.c	2011-01-11 20:27:54.000000000 +0100@@ -149,6 +149,19 @@ } EXPORT_SYMBOL(phy_scan_fixups); +static int generic_receive_skb(struct sk_buff *skb)+{+	skb->protocol = eth_type_trans(skb, skb->dev);+	return netif_receive_skb(skb);+}++static int generic_rx(struct sk_buff *skb)+{+	skb->protocol = eth_type_trans(skb, skb->dev);+	return netif_rx(skb);+}++ static struct phy_device* phy_device_create(struct mii_bus *bus, 					    int addr, int phy_id) {@@ -180,6 +193,8 @@ 	dev_set_name(&dev->dev, PHY_ID_FMT, bus->id, addr);  	dev->state = PHY_DOWN;+	dev->netif_receive_skb = &generic_receive_skb;+	dev->netif_rx = &generic_rx;  	mutex_init(&dev->lock); 	INIT_DELAYED_WORK(&dev->state_queue, phy_state_machine);diff -Nur linux-2.6.37.orig/drivers/spi/Kconfig linux-2.6.37/drivers/spi/Kconfig--- linux-2.6.37.orig/drivers/spi/Kconfig	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/spi/Kconfig	2011-01-11 20:25:48.000000000 +0100@@ -53,6 +53,13 @@  comment "SPI Master Controller Drivers" +config SPI_AR71XX+	tristate "Atheros AR71xx SPI Controller"+	depends on SPI_MASTER && ATHEROS_AR71XX+	select SPI_BITBANG+	help+	  This is the SPI contoller driver for Atheros AR71xx.+ config SPI_ATMEL 	tristate "Atmel SPI Controller" 	depends on (ARCH_AT91 || AVR32)diff -Nur linux-2.6.37.orig/drivers/spi/Makefile linux-2.6.37/drivers/spi/Makefile--- linux-2.6.37.orig/drivers/spi/Makefile	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/spi/Makefile	2011-01-11 20:25:48.000000000 +0100@@ -9,6 +9,7 @@ obj-$(CONFIG_SPI_MASTER)		+= spi.o  # SPI master controller drivers (bus)+obj-$(CONFIG_SPI_AR71XX)		+= ar71xx_spi.o obj-$(CONFIG_SPI_ATMEL)			+= atmel_spi.o obj-$(CONFIG_SPI_BFIN)			+= spi_bfin5xx.o obj-$(CONFIG_SPI_BITBANG)		+= spi_bitbang.odiff -Nur linux-2.6.37.orig/drivers/spi/ap83_spi.c linux-2.6.37/drivers/spi/ap83_spi.c--- linux-2.6.37.orig/drivers/spi/ap83_spi.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/spi/ap83_spi.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,282 @@+/*+ * Atheros AP83 board specific SPI Controller driver+ *+ * Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ * This program is free software; you can redistribute it and/or modify+ * it under the terms of the GNU General Public License version 2 as+ * published by the Free Software Foundation.+ *+ */++#include <linux/kernel.h>+#include <linux/init.h>+#include <linux/delay.h>+#include <linux/spinlock.h>+#include <linux/workqueue.h>+#include <linux/platform_device.h>+#include <linux/io.h>+#include <linux/spi/spi.h>+#include <linux/spi/spi_bitbang.h>+#include <linux/bitops.h>+#include <linux/gpio.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/platform.h>++#define DRV_DESC	"Atheros AP83 board SPI Controller driver"+#define DRV_VERSION	"0.1.0"+#define DRV_NAME	"ap83-spi"++#define AP83_SPI_CLK_HIGH	(1 << 23)+#define AP83_SPI_CLK_LOW	0+#define AP83_SPI_MOSI_HIGH	(1 << 22)+#define AP83_SPI_MOSI_LOW	0++#define AP83_SPI_GPIO_CS	1+#define AP83_SPI_GPIO_MISO	3++struct ap83_spi {+	struct	spi_bitbang 	bitbang;+	void __iomem 		*base;+	u32			addr;++	struct platform_device	*pdev;+};++static inline u32 ap83_spi_rr(struct ap83_spi *sp, u32 reg)+{+	return __raw_readl(sp->base + reg);+}++static inline struct ap83_spi *spidev_to_sp(struct spi_device *spi)+{+	return spi_master_get_devdata(spi->master);+}++static inline void setsck(struct spi_device *spi, int val)+{+	struct ap83_spi *sp = spidev_to_sp(spi);++	if (val)+		sp->addr |= AP83_SPI_CLK_HIGH;+	else+		sp->addr &= ~AP83_SPI_CLK_HIGH;++	dev_dbg(&spi->dev, "addr=%08x,  SCK set to %s\n",+		sp->addr, (val) ? "HIGH" : "LOW");++	ap83_spi_rr(sp, sp->addr);+}++static inline void setmosi(struct spi_device *spi, int val)+{+	struct ap83_spi *sp = spidev_to_sp(spi);++	if (val)+		sp->addr |= AP83_SPI_MOSI_HIGH;+	else+		sp->addr &= ~AP83_SPI_MOSI_HIGH;++	dev_dbg(&spi->dev, "addr=%08x, MOSI set to %s\n",+		sp->addr, (val) ? "HIGH" : "LOW");++	ap83_spi_rr(sp, sp->addr);+}++static inline u32 getmiso(struct spi_device *spi)+{+	u32 ret;++	ret = gpio_get_value(AP83_SPI_GPIO_MISO) ? 1 : 0;+	dev_dbg(&spi->dev, "get MISO: %d\n", ret);++	return ret;+}++static inline void do_spidelay(struct spi_device *spi, unsigned nsecs)+{+	ndelay(nsecs);+}++static void ap83_spi_chipselect(struct spi_device *spi, int on)+{+	struct ap83_spi *sp = spidev_to_sp(spi);++	dev_dbg(&spi->dev, "set CS to %d\n", (on) ? 0 : 1);++	if (on) {+		ar71xx_flash_acquire();++		sp->addr = 0;+		ap83_spi_rr(sp, sp->addr);++		gpio_set_value(AP83_SPI_GPIO_CS, 0);+	} else {+		gpio_set_value(AP83_SPI_GPIO_CS, 1);+		ar71xx_flash_release();+	}+}++#define spidelay(nsecs)							\+	do {								\+		/* Steal the spi_device pointer from our caller.	\+		 * The bitbang-API should probably get fixed here... */	\+		do_spidelay(spi, nsecs);				\+	} while (0)++#define EXPAND_BITBANG_TXRX+#include <linux/spi/spi_bitbang.h>++static u32 ap83_spi_txrx_mode0(struct spi_device *spi,+			       unsigned nsecs, u32 word, u8 bits)+{+	dev_dbg(&spi->dev, "TXRX0 word=%08x, bits=%u\n", word, bits);+	return bitbang_txrx_be_cpha0(spi, nsecs, 0, word, bits);+}++static u32 ap83_spi_txrx_mode1(struct spi_device *spi,+			       unsigned nsecs, u32 word, u8 bits)+{+	dev_dbg(&spi->dev, "TXRX1 word=%08x, bits=%u\n", word, bits);+	return bitbang_txrx_be_cpha1(spi, nsecs, 0, word, bits);+}++static u32 ap83_spi_txrx_mode2(struct spi_device *spi,+			       unsigned nsecs, u32 word, u8 bits)+{+	dev_dbg(&spi->dev, "TXRX2 word=%08x, bits=%u\n", word, bits);+	return bitbang_txrx_be_cpha0(spi, nsecs, 1, word, bits);+}++static u32 ap83_spi_txrx_mode3(struct spi_device *spi,+			       unsigned nsecs, u32 word, u8 bits)+{+	dev_dbg(&spi->dev, "TXRX3 word=%08x, bits=%u\n", word, bits);+	return bitbang_txrx_be_cpha1(spi, nsecs, 1, word, bits);+}++static int ap83_spi_probe(struct platform_device *pdev)+{+	struct spi_master *master;+	struct ap83_spi *sp;+	struct ap83_spi_platform_data *pdata;+	struct resource	*r;+	int ret;++	ret = gpio_request(AP83_SPI_GPIO_MISO, "spi-miso");+	if (ret) {+		dev_err(&pdev->dev, "gpio request failed for MISO\n");+		return ret;+	}++	ret = gpio_request(AP83_SPI_GPIO_CS, "spi-cs");+	if (ret) {+		dev_err(&pdev->dev, "gpio request failed for CS\n");+		goto err_free_miso;+	}++	ret = gpio_direction_input(AP83_SPI_GPIO_MISO);+	if (ret) {+		dev_err(&pdev->dev, "unable to set direction of MISO\n");+		goto err_free_cs;+	}++	ret = gpio_direction_output(AP83_SPI_GPIO_CS, 0);+	if (ret) {+		dev_err(&pdev->dev, "unable to set direction of CS\n");+		goto err_free_cs;+	}++	master = spi_alloc_master(&pdev->dev, sizeof(*sp));+	if (master == NULL) {+		dev_err(&pdev->dev, "failed to allocate spi master\n");+		return -ENOMEM;+	}++	sp = spi_master_get_devdata(master);+	platform_set_drvdata(pdev, sp);++	pdata = pdev->dev.platform_data;++	sp->bitbang.master = spi_master_get(master);+	sp->bitbang.chipselect = ap83_spi_chipselect;+	sp->bitbang.txrx_word[SPI_MODE_0] = ap83_spi_txrx_mode0;+	sp->bitbang.txrx_word[SPI_MODE_1] = ap83_spi_txrx_mode1;+	sp->bitbang.txrx_word[SPI_MODE_2] = ap83_spi_txrx_mode2;+	sp->bitbang.txrx_word[SPI_MODE_3] = ap83_spi_txrx_mode3;++	sp->bitbang.master->bus_num = pdev->id;+	sp->bitbang.master->num_chipselect = 1;++	r = platform_get_resource(pdev, IORESOURCE_MEM, 0);+	if (r == NULL) {+		ret = -ENOENT;+		goto err_spi_put;+	}++	sp->base = ioremap_nocache(r->start, r->end - r->start + 1);+	if (!sp->base) {+		ret = -ENXIO;+		goto err_spi_put;+	}++	ret = spi_bitbang_start(&sp->bitbang);+	if (!ret)+		goto err_unmap;++	dev_info(&pdev->dev, "AP83 SPI adapter at %08x\n", r->start);++	return 0;++ err_unmap:+	iounmap(sp->base);+ err_spi_put:+	platform_set_drvdata(pdev, NULL);+	spi_master_put(sp->bitbang.master);++ err_free_cs:+	gpio_free(AP83_SPI_GPIO_CS);+ err_free_miso:+	gpio_free(AP83_SPI_GPIO_MISO);+	return ret;+}++static int ap83_spi_remove(struct platform_device *pdev)+{+	struct ap83_spi *sp = platform_get_drvdata(pdev);++	spi_bitbang_stop(&sp->bitbang);+	iounmap(sp->base);+	platform_set_drvdata(pdev, NULL);+	spi_master_put(sp->bitbang.master);++	return 0;+}++static struct platform_driver ap83_spi_drv = {+	.probe		= ap83_spi_probe,+	.remove		= ap83_spi_remove,+	.driver		= {+		.name	= DRV_NAME,+		.owner	= THIS_MODULE,+	},+};++static int __init ap83_spi_init(void)+{+	return platform_driver_register(&ap83_spi_drv);+}+module_init(ap83_spi_init);++static void __exit ap83_spi_exit(void)+{+	platform_driver_unregister(&ap83_spi_drv);+}+module_exit(ap83_spi_exit);++MODULE_ALIAS("platform:" DRV_NAME);+MODULE_DESCRIPTION(DRV_DESC);+MODULE_VERSION(DRV_VERSION);+MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");+MODULE_LICENSE("GPL v2");diff -Nur linux-2.6.37.orig/drivers/spi/ar71xx_spi.c linux-2.6.37/drivers/spi/ar71xx_spi.c--- linux-2.6.37.orig/drivers/spi/ar71xx_spi.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/spi/ar71xx_spi.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,283 @@+/*+ * Atheros AR71xx SPI Controller driver+ *+ * Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>+ * Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ * This program is free software; you can redistribute it and/or modify+ * it under the terms of the GNU General Public License version 2 as+ * published by the Free Software Foundation.+ *+ */++#include <linux/kernel.h>+#include <linux/init.h>+#include <linux/delay.h>+#include <linux/spinlock.h>+#include <linux/workqueue.h>+#include <linux/platform_device.h>+#include <linux/io.h>+#include <linux/spi/spi.h>+#include <linux/spi/spi_bitbang.h>+#include <linux/bitops.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/platform.h>++#define DRV_DESC	"Atheros AR71xx SPI Controller driver"+#define DRV_VERSION	"0.2.4"+#define DRV_NAME	"ar71xx-spi"++#undef PER_BIT_READ++struct ar71xx_spi {+	struct	spi_bitbang 	bitbang;+	u32			ioc_base;+	u32			reg_ctrl;++	void __iomem 		*base;++	struct platform_device	*pdev;+	u32			(*get_ioc_base)(u8 chip_select, int cs_high,+						int is_on);+};++static inline u32 ar71xx_spi_rr(struct ar71xx_spi *sp, unsigned reg)+{+	return __raw_readl(sp->base + reg);+}++static inline void ar71xx_spi_wr(struct ar71xx_spi *sp, unsigned reg, u32 val)+{+	__raw_writel(val, sp->base + reg);+}++static inline struct ar71xx_spi *spidev_to_sp(struct spi_device *spi)+{+	return spi_master_get_devdata(spi->master);+}++static u32 ar71xx_spi_get_ioc_base(u8 chip_select, int cs_high, int is_on)+{+	u32 ret;++	if (is_on == AR71XX_SPI_CS_INACTIVE)+		ret = SPI_IOC_CS_ALL;+	else+		ret = SPI_IOC_CS_ALL & ~SPI_IOC_CS(chip_select);++	return ret;+}++static void ar71xx_spi_chipselect(struct spi_device *spi, int value)+{+	struct ar71xx_spi *sp = spidev_to_sp(spi);+	void __iomem *base = sp->base;+	u32 ioc_base;++	switch (value) {+	case BITBANG_CS_INACTIVE:+		ioc_base = sp->get_ioc_base(spi->chip_select,+					(spi->mode & SPI_CS_HIGH) != 0,+					AR71XX_SPI_CS_INACTIVE);+		__raw_writel(ioc_base, base + SPI_REG_IOC);+		break;++	case BITBANG_CS_ACTIVE:+		ioc_base = sp->get_ioc_base(spi->chip_select,+					(spi->mode & SPI_CS_HIGH) != 0,+					AR71XX_SPI_CS_ACTIVE);++		__raw_writel(ioc_base, base + SPI_REG_IOC);+		sp->ioc_base = ioc_base;+		break;+	}+}++static void ar71xx_spi_setup_regs(struct spi_device *spi)+{+	struct ar71xx_spi *sp = spidev_to_sp(spi);++	/* enable GPIO mode */+	ar71xx_spi_wr(sp, SPI_REG_FS, SPI_FS_GPIO);++	/* save CTRL register */+	sp->reg_ctrl = ar71xx_spi_rr(sp, SPI_REG_CTRL);++	/* TODO: setup speed? */+	ar71xx_spi_wr(sp, SPI_REG_CTRL, 0x43);+}++static void ar71xx_spi_restore_regs(struct spi_device *spi)+{+	struct ar71xx_spi *sp = spidev_to_sp(spi);++	/* restore CTRL register */+	ar71xx_spi_wr(sp, SPI_REG_CTRL, sp->reg_ctrl);+	/* disable GPIO mode */+	ar71xx_spi_wr(sp, SPI_REG_FS, 0);+}++static int ar71xx_spi_setup(struct spi_device *spi)+{+	int status;++	if (spi->bits_per_word > 32)+		return -EINVAL;++	if (!spi->controller_state)+		ar71xx_spi_setup_regs(spi);++	status = spi_bitbang_setup(spi);+	if (status && !spi->controller_state)+		ar71xx_spi_restore_regs(spi);++	return status;+}++static void ar71xx_spi_cleanup(struct spi_device *spi)+{+	ar71xx_spi_restore_regs(spi);+	spi_bitbang_cleanup(spi);+}++static u32 ar71xx_spi_txrx_mode0(struct spi_device *spi, unsigned nsecs,+					u32 word, u8 bits)+{+	struct ar71xx_spi *sp = spidev_to_sp(spi);+	void __iomem *base = sp->base;+	u32 ioc = sp->ioc_base;+	u32 ret;++	/* clock starts at inactive polarity */+	for (word <<= (32 - bits); likely(bits); bits--) {+		u32 out;++		if (word & (1 << 31))+			out = ioc | SPI_IOC_DO;+		else+			out = ioc & ~SPI_IOC_DO;++		/* setup MSB (to slave) on trailing edge */+		__raw_writel(out, base + SPI_REG_IOC);++		__raw_writel(out | SPI_IOC_CLK, base + SPI_REG_IOC);++		word <<= 1;++#ifdef PER_BIT_READ+		/* sample MSB (from slave) on leading edge */+		ret = __raw_readl(base + SPI_REG_RDS);+		__raw_writel(out, base + SPI_REG_IOC);+#endif++	}++#ifndef PER_BIT_READ+	ret = __raw_readl(base + SPI_REG_RDS);+#endif+	return ret;+}++static int ar71xx_spi_probe(struct platform_device *pdev)+{+	struct spi_master *master;+	struct ar71xx_spi *sp;+	struct ar71xx_spi_platform_data *pdata;+	struct resource	*r;+	int ret;++	master = spi_alloc_master(&pdev->dev, sizeof(*sp));+	if (master == NULL) {+		dev_err(&pdev->dev, "failed to allocate spi master\n");+		return -ENOMEM;+	}++	sp = spi_master_get_devdata(master);+	platform_set_drvdata(pdev, sp);++	pdata = pdev->dev.platform_data;++	master->setup = ar71xx_spi_setup;+	master->cleanup = ar71xx_spi_cleanup;++	sp->bitbang.master = spi_master_get(master);+	sp->bitbang.chipselect = ar71xx_spi_chipselect;+	sp->bitbang.txrx_word[SPI_MODE_0] = ar71xx_spi_txrx_mode0;+	sp->bitbang.setup_transfer = spi_bitbang_setup_transfer;++	sp->get_ioc_base = ar71xx_spi_get_ioc_base;+	if (pdata) {+		sp->bitbang.master->bus_num = pdata->bus_num;+		sp->bitbang.master->num_chipselect = pdata->num_chipselect;+		if (pdata->get_ioc_base)+			sp->get_ioc_base = pdata->get_ioc_base;+	} else {+		sp->bitbang.master->bus_num = 0;+		sp->bitbang.master->num_chipselect = 3;+	}++	r = platform_get_resource(pdev, IORESOURCE_MEM, 0);+	if (r == NULL) {+		ret = -ENOENT;+		goto err1;+	}++	sp->base = ioremap_nocache(r->start, r->end - r->start + 1);+	if (!sp->base) {+		ret = -ENXIO;+		goto err1;+	}++	ret = spi_bitbang_start(&sp->bitbang);+	if (!ret)+		return 0;++	iounmap(sp->base);+ err1:+	platform_set_drvdata(pdev, NULL);+	spi_master_put(sp->bitbang.master);++	return ret;+}++static int ar71xx_spi_remove(struct platform_device *pdev)+{+	struct ar71xx_spi *sp = platform_get_drvdata(pdev);++	spi_bitbang_stop(&sp->bitbang);+	iounmap(sp->base);+	platform_set_drvdata(pdev, NULL);+	spi_master_put(sp->bitbang.master);++	return 0;+}++static struct platform_driver ar71xx_spi_drv = {+	.probe		= ar71xx_spi_probe,+	.remove		= ar71xx_spi_remove,+	.driver		= {+		.name	= DRV_NAME,+		.owner	= THIS_MODULE,+	},+};++static int __init ar71xx_spi_init(void)+{+	printk(KERN_INFO DRV_DESC " version " DRV_VERSION "\n");+	return platform_driver_register(&ar71xx_spi_drv);+}+module_init(ar71xx_spi_init);++static void __exit ar71xx_spi_exit(void)+{+	platform_driver_unregister(&ar71xx_spi_drv);+}+module_exit(ar71xx_spi_exit);++MODULE_ALIAS("platform:" DRV_NAME);+MODULE_DESCRIPTION(DRV_DESC);+MODULE_VERSION(DRV_VERSION);+MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");+MODULE_AUTHOR("Imre Kaloz <kaloz@openwrt.org>");+MODULE_LICENSE("GPL v2");diff -Nur linux-2.6.37.orig/drivers/spi/pb44_spi.c linux-2.6.37/drivers/spi/pb44_spi.c--- linux-2.6.37.orig/drivers/spi/pb44_spi.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/spi/pb44_spi.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,299 @@+/*+ * Atheros PB44 board SPI controller driver+ *+ * Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ * This program is free software; you can redistribute it and/or modify+ * it under the terms of the GNU General Public License version 2 as+ * published by the Free Software Foundation.+ *+ */++#include <linux/kernel.h>+#include <linux/init.h>+#include <linux/delay.h>+#include <linux/spinlock.h>+#include <linux/workqueue.h>+#include <linux/platform_device.h>+#include <linux/io.h>+#include <linux/spi/spi.h>+#include <linux/spi/spi_bitbang.h>+#include <linux/bitops.h>+#include <linux/gpio.h>++#include <asm/mach-ar71xx/ar71xx.h>+#include <asm/mach-ar71xx/platform.h>++#define DRV_DESC	"Atheros PB44 SPI Controller driver"+#define DRV_VERSION	"0.1.0"+#define DRV_NAME	"pb44-spi"++#undef PER_BIT_READ++struct ar71xx_spi {+	struct	spi_bitbang 	bitbang;+	u32			ioc_base;+	u32			reg_ctrl;++	void __iomem 		*base;++	struct platform_device	*pdev;+};++static inline u32 pb44_spi_rr(struct ar71xx_spi *sp, unsigned reg)+{+	return __raw_readl(sp->base + reg);+}++static inline void pb44_spi_wr(struct ar71xx_spi *sp, unsigned reg, u32 val)+{+	__raw_writel(val, sp->base + reg);+}++static inline struct ar71xx_spi *spidev_to_sp(struct spi_device *spi)+{+	return spi_master_get_devdata(spi->master);+}++static void pb44_spi_chipselect(struct spi_device *spi, int is_active)+{+	struct ar71xx_spi *sp = spidev_to_sp(spi);+	int cs_high = (spi->mode & SPI_CS_HIGH) ? is_active : !is_active;++	if (is_active) {+		/* set initial clock polarity */+		if (spi->mode & SPI_CPOL)+			sp->ioc_base |= SPI_IOC_CLK;+		else+			sp->ioc_base &= ~SPI_IOC_CLK;++		pb44_spi_wr(sp, SPI_REG_IOC, sp->ioc_base);+	}++	if (spi->chip_select) {+		unsigned long gpio = (unsigned long) spi->controller_data;++		/* SPI is normally active-low */+		gpio_set_value(gpio, cs_high);+	} else {+		if (cs_high)+			sp->ioc_base |= SPI_IOC_CS0;+		else+			sp->ioc_base &= ~SPI_IOC_CS0;++		pb44_spi_wr(sp, SPI_REG_IOC, sp->ioc_base);+	}++}++static int pb44_spi_setup_cs(struct spi_device *spi)+{+	struct ar71xx_spi *sp = spidev_to_sp(spi);++	/* enable GPIO mode */+	pb44_spi_wr(sp, SPI_REG_FS, SPI_FS_GPIO);++	/* save CTRL register */+	sp->reg_ctrl = pb44_spi_rr(sp, SPI_REG_CTRL);+	sp->ioc_base = pb44_spi_rr(sp, SPI_REG_IOC);++	/* TODO: setup speed? */+	pb44_spi_wr(sp, SPI_REG_CTRL, 0x43);++	if (spi->chip_select) {+		unsigned long gpio = (unsigned long) spi->controller_data;+		int status = 0;++		status = gpio_request(gpio, dev_name(&spi->dev));+		if (status)+			return status;++		status = gpio_direction_output(gpio, spi->mode & SPI_CS_HIGH);+		if (status) {+			gpio_free(gpio);+			return status;+		}+	} else {+		if (spi->mode & SPI_CS_HIGH)+			sp->ioc_base |= SPI_IOC_CS0;+		else+			sp->ioc_base &= ~SPI_IOC_CS0;+		pb44_spi_wr(sp, SPI_REG_IOC, sp->ioc_base);+	}++	return 0;+}++static void pb44_spi_cleanup_cs(struct spi_device *spi)+{+	struct ar71xx_spi *sp = spidev_to_sp(spi);++	if (spi->chip_select) {+		unsigned long gpio = (unsigned long) spi->controller_data;+		gpio_free(gpio);+	}++	/* restore CTRL register */+	pb44_spi_wr(sp, SPI_REG_CTRL, sp->reg_ctrl);+	/* disable GPIO mode */+	pb44_spi_wr(sp, SPI_REG_FS, 0);+}++static int pb44_spi_setup(struct spi_device *spi)+{+	int status = 0;++	if (spi->bits_per_word > 32)+		return -EINVAL;++	if (!spi->controller_state) {+		status = pb44_spi_setup_cs(spi);+		if (status)+			return status;+	}++	status = spi_bitbang_setup(spi);+	if (status && !spi->controller_state)+		pb44_spi_cleanup_cs(spi);++	return status;+}++static void pb44_spi_cleanup(struct spi_device *spi)+{+	pb44_spi_cleanup_cs(spi);+	spi_bitbang_cleanup(spi);+}++static u32 pb44_spi_txrx_mode0(struct spi_device *spi, unsigned nsecs,+			       u32 word, u8 bits)+{+	struct ar71xx_spi *sp = spidev_to_sp(spi);+	u32 ioc = sp->ioc_base;+	u32 ret;++	/* clock starts at inactive polarity */+	for (word <<= (32 - bits); likely(bits); bits--) {+		u32 out;++		if (word & (1 << 31))+			out = ioc | SPI_IOC_DO;+		else+			out = ioc & ~SPI_IOC_DO;++		/* setup MSB (to slave) on trailing edge */+		pb44_spi_wr(sp, SPI_REG_IOC, out);+		pb44_spi_wr(sp, SPI_REG_IOC, out | SPI_IOC_CLK);++		word <<= 1;++#ifdef PER_BIT_READ+		/* sample MSB (from slave) on leading edge */+		ret = pb44_spi_rr(sp, SPI_REG_RDS);+		pb44_spi_wr(sp, SPI_REG_IOC, out);+#endif+	}++#ifndef PER_BIT_READ+	ret = pb44_spi_rr(sp, SPI_REG_RDS);+#endif+	return ret;+}++static int pb44_spi_probe(struct platform_device *pdev)+{+	struct spi_master *master;+	struct ar71xx_spi *sp;+	struct ar71xx_spi_platform_data *pdata;+	struct resource	*r;+	int ret;++	master = spi_alloc_master(&pdev->dev, sizeof(*sp));+	if (master == NULL) {+		dev_err(&pdev->dev, "failed to allocate spi master\n");+		return -ENOMEM;+	}++	sp = spi_master_get_devdata(master);+	platform_set_drvdata(pdev, sp);++	pdata = pdev->dev.platform_data;++	master->setup = pb44_spi_setup;+	master->cleanup = pb44_spi_cleanup;+	if (pdata) {+		master->bus_num = pdata->bus_num;+		master->num_chipselect = pdata->num_chipselect;+	} else {+		master->bus_num = 0;+		master->num_chipselect = 1;+	}++	sp->bitbang.master = spi_master_get(master);+	sp->bitbang.chipselect = pb44_spi_chipselect;+	sp->bitbang.txrx_word[SPI_MODE_0] = pb44_spi_txrx_mode0;+	sp->bitbang.setup_transfer = spi_bitbang_setup_transfer;+	sp->bitbang.flags = SPI_CS_HIGH;++	r = platform_get_resource(pdev, IORESOURCE_MEM, 0);+	if (r == NULL) {+		ret = -ENOENT;+		goto err1;+	}++	sp->base = ioremap_nocache(r->start, r->end - r->start + 1);+	if (!sp->base) {+		ret = -ENXIO;+		goto err1;+	}++	ret = spi_bitbang_start(&sp->bitbang);+	if (!ret)+		return 0;++	iounmap(sp->base);+ err1:+	platform_set_drvdata(pdev, NULL);+	spi_master_put(sp->bitbang.master);++	return ret;+}++static int pb44_spi_remove(struct platform_device *pdev)+{+	struct ar71xx_spi *sp = platform_get_drvdata(pdev);++	spi_bitbang_stop(&sp->bitbang);+	iounmap(sp->base);+	platform_set_drvdata(pdev, NULL);+	spi_master_put(sp->bitbang.master);++	return 0;+}++static struct platform_driver pb44_spi_drv = {+	.probe		= pb44_spi_probe,+	.remove		= pb44_spi_remove,+	.driver		= {+		.name	= DRV_NAME,+		.owner	= THIS_MODULE,+	},+};++static int __init pb44_spi_init(void)+{+	return platform_driver_register(&pb44_spi_drv);+}+module_init(pb44_spi_init);++static void __exit pb44_spi_exit(void)+{+	platform_driver_unregister(&pb44_spi_drv);+}+module_exit(pb44_spi_exit);++MODULE_ALIAS("platform:" DRV_NAME);+MODULE_DESCRIPTION(DRV_DESC);+MODULE_VERSION(DRV_VERSION);+MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");+MODULE_LICENSE("GPL v2");diff -Nur linux-2.6.37.orig/drivers/spi/spi_vsc7385.c linux-2.6.37/drivers/spi/spi_vsc7385.c--- linux-2.6.37.orig/drivers/spi/spi_vsc7385.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/spi/spi_vsc7385.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,620 @@+/*+ * SPI driver for the Vitesse VSC7385 ethernet switch+ *+ * Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ * Parts of this file are based on Atheros' 2.6.15 BSP+ *+ * This program is free software; you can redistribute it and/or modify it+ * under the terms of the GNU General Public License version 2 as published+ * by the Free Software Foundation.+ */++#include <linux/types.h>+#include <linux/kernel.h>+#include <linux/init.h>+#include <linux/module.h>+#include <linux/delay.h>+#include <linux/device.h>+#include <linux/bitops.h>+#include <linux/firmware.h>+#include <linux/spi/spi.h>+#include <linux/spi/vsc7385.h>++#define DRV_NAME	"spi-vsc7385"+#define DRV_DESC	"Vitesse VSC7385 Gbit ethernet switch driver"+#define DRV_VERSION	"0.1.0"++#define VSC73XX_BLOCK_MAC	0x1+#define VSC73XX_BLOCK_2		0x2+#define VSC73XX_BLOCK_MII	0x3+#define VSC73XX_BLOCK_4		0x4+#define VSC73XX_BLOCK_5		0x5+#define VSC73XX_BLOCK_SYSTEM	0x7++#define VSC73XX_SUBBLOCK_PORT_0		0+#define VSC73XX_SUBBLOCK_PORT_1		1+#define VSC73XX_SUBBLOCK_PORT_2		2+#define VSC73XX_SUBBLOCK_PORT_3		3+#define VSC73XX_SUBBLOCK_PORT_4		4+#define VSC73XX_SUBBLOCK_PORT_MAC	6++/* MAC Block registers */+#define VSC73XX_MAC_CFG		0x0+#define VSC73XX_ADVPORTM	0x19+#define VSC73XX_RXOCT		0x50+#define VSC73XX_TXOCT		0x51+#define VSC73XX_C_RX0		0x52+#define VSC73XX_C_RX1		0x53+#define VSC73XX_C_RX2		0x54+#define VSC73XX_C_TX0		0x55+#define VSC73XX_C_TX1		0x56+#define VSC73XX_C_TX2		0x57+#define VSC73XX_C_CFG		0x58++/* MAC_CFG register bits */+#define VSC73XX_MAC_CFG_WEXC_DIS	(1 << 31)+#define VSC73XX_MAC_CFG_PORT_RST	(1 << 29)+#define VSC73XX_MAC_CFG_TX_EN		(1 << 28)+#define VSC73XX_MAC_CFG_SEED_LOAD      	(1 << 27)+#define VSC73XX_MAC_CFG_FDX	        (1 << 18)+#define VSC73XX_MAC_CFG_GIGE		(1 << 17)+#define VSC73XX_MAC_CFG_RX_EN		(1 << 16)+#define VSC73XX_MAC_CFG_VLAN_DBLAWR	(1 << 15)+#define VSC73XX_MAC_CFG_VLAN_AWR	(1 << 14)+#define VSC73XX_MAC_CFG_100_BASE_T	(1 << 13)+#define VSC73XX_MAC_CFG_TX_IPG(x)	(((x) & 0x1f) << 6)+#define VSC73XX_MAC_CFG_MAC_RX_RST	(1 << 5)+#define VSC73XX_MAC_CFG_MAC_TX_RST	(1 << 4)+#define VSC73XX_MAC_CFG_BIT2		(1 << 2)+#define VSC73XX_MAC_CFG_CLK_SEL(x)	((x) & 0x3)++/* ADVPORTM register bits */+#define VSC73XX_ADVPORTM_IFG_PPM	(1 << 7)+#define VSC73XX_ADVPORTM_EXC_COL_CONT	(1 << 6)+#define VSC73XX_ADVPORTM_EXT_PORT	(1 << 5)+#define VSC73XX_ADVPORTM_INV_GTX	(1 << 4)+#define VSC73XX_ADVPORTM_ENA_GTX	(1 << 3)+#define VSC73XX_ADVPORTM_DDR_MODE	(1 << 2)+#define VSC73XX_ADVPORTM_IO_LOOPBACK	(1 << 1)+#define VSC73XX_ADVPORTM_HOST_LOOPBACK	(1 << 0)++/* MII Block registers */+#define VSC73XX_MII_STAT	0x0+#define VSC73XX_MII_CMD		0x1+#define VSC73XX_MII_DATA	0x2++/* System Block registers */+#define VSC73XX_ICPU_SIPAD		0x01+#define VSC73XX_ICPU_CLOCK_DELAY	0x05+#define VSC73XX_ICPU_CTRL		0x10+#define VSC73XX_ICPU_ADDR		0x11+#define VSC73XX_ICPU_SRAM		0x12+#define VSC73XX_ICPU_MBOX_VAL		0x15+#define VSC73XX_ICPU_MBOX_SET		0x16+#define VSC73XX_ICPU_MBOX_CLR		0x17+#define VSC73XX_ICPU_CHIPID		0x18+#define VSC73XX_ICPU_GPIO		0x34++#define VSC73XX_ICPU_CTRL_CLK_DIV	(1 << 8)+#define VSC73XX_ICPU_CTRL_SRST_HOLD	(1 << 7)+#define VSC73XX_ICPU_CTRL_BOOT_EN	(1 << 3)+#define VSC73XX_ICPU_CTRL_EXT_ACC_EN	(1 << 2)+#define VSC73XX_ICPU_CTRL_CLK_EN	(1 << 1)+#define VSC73XX_ICPU_CTRL_SRST		(1 << 0)++#define VSC73XX_ICPU_CHIPID_ID_SHIFT	12+#define VSC73XX_ICPU_CHIPID_ID_MASK	0xffff+#define VSC73XX_ICPU_CHIPID_REV_SHIFT	28+#define VSC73XX_ICPU_CHIPID_REV_MASK	0xf+#define VSC73XX_ICPU_CHIPID_ID_7385	0x7385+#define VSC73XX_ICPU_CHIPID_ID_7395	0x7395++#define VSC73XX_CMD_MODE_READ		0+#define VSC73XX_CMD_MODE_WRITE		1+#define VSC73XX_CMD_MODE_SHIFT		4+#define VSC73XX_CMD_BLOCK_SHIFT		5+#define VSC73XX_CMD_BLOCK_MASK		0x7+#define VSC73XX_CMD_SUBBLOCK_MASK	0xf++#define VSC7385_CLOCK_DELAY		((3 << 4) | 3)+#define VSC7385_CLOCK_DELAY_MASK	((3 << 4) | 3)++#define VSC73XX_ICPU_CTRL_STOP	(VSC73XX_ICPU_CTRL_SRST_HOLD | \+				 VSC73XX_ICPU_CTRL_BOOT_EN | \+				 VSC73XX_ICPU_CTRL_EXT_ACC_EN)++#define VSC73XX_ICPU_CTRL_START	(VSC73XX_ICPU_CTRL_CLK_DIV | \+				 VSC73XX_ICPU_CTRL_BOOT_EN | \+				 VSC73XX_ICPU_CTRL_CLK_EN | \+				 VSC73XX_ICPU_CTRL_SRST)++#define VSC7385_ADVPORTM_MASK	(VSC73XX_ADVPORTM_IFG_PPM | \+				 VSC73XX_ADVPORTM_EXC_COL_CONT | \+				 VSC73XX_ADVPORTM_EXT_PORT | \+				 VSC73XX_ADVPORTM_INV_GTX | \+				 VSC73XX_ADVPORTM_ENA_GTX | \+				 VSC73XX_ADVPORTM_DDR_MODE | \+				 VSC73XX_ADVPORTM_IO_LOOPBACK | \+				 VSC73XX_ADVPORTM_HOST_LOOPBACK)++#define VSC7385_ADVPORTM_INIT	(VSC73XX_ADVPORTM_EXT_PORT | \+				 VSC73XX_ADVPORTM_ENA_GTX | \+				 VSC73XX_ADVPORTM_DDR_MODE)++#define VSC7385_MAC_CFG_RESET	(VSC73XX_MAC_CFG_PORT_RST | \+				 VSC73XX_MAC_CFG_MAC_RX_RST | \+				 VSC73XX_MAC_CFG_MAC_TX_RST)++#define VSC73XX_MAC_CFG_INIT	(VSC73XX_MAC_CFG_TX_EN | \+				 VSC73XX_MAC_CFG_FDX | \+				 VSC73XX_MAC_CFG_GIGE | \+				 VSC73XX_MAC_CFG_RX_EN)++#define VSC73XX_RESET_DELAY	100++struct vsc7385 {+	struct spi_device		*spi;+	struct mutex			lock;+	struct vsc7385_platform_data	*pdata;+};++static int vsc7385_is_addr_valid(u8 block, u8 subblock)+{+	switch (block) {+	case VSC73XX_BLOCK_MAC:+		switch (subblock) {+		case 0 ... 4:+		case 6:+			return 1;+		}+		break;++	case VSC73XX_BLOCK_2:+	case VSC73XX_BLOCK_SYSTEM:+		switch (subblock) {+		case 0:+			return 1;+		}+		break;++	case VSC73XX_BLOCK_MII:+	case VSC73XX_BLOCK_4:+	case VSC73XX_BLOCK_5:+		switch (subblock) {+		case 0 ... 1:+			return 1;+		}+		break;+	}++	return 0;+}++static inline u8 vsc7385_make_addr(u8 mode, u8 block, u8 subblock)+{+	u8 ret;++	ret = (block & VSC73XX_CMD_BLOCK_MASK) << VSC73XX_CMD_BLOCK_SHIFT;+	ret |= (mode & 1) << VSC73XX_CMD_MODE_SHIFT;+	ret |= subblock & VSC73XX_CMD_SUBBLOCK_MASK;++	return ret;+}++static int vsc7385_read(struct vsc7385 *vsc, u8 block, u8 subblock, u8 reg,+			u32 *value)+{+	u8 cmd[4];+	u8 buf[4];+	struct spi_transfer t[2];+	struct spi_message m;+	int err;++	if (!vsc7385_is_addr_valid(block, subblock))+		return -EINVAL;++	spi_message_init(&m);++	memset(&t, 0, sizeof(t));++	t[0].tx_buf = cmd;+	t[0].len = sizeof(cmd);+	spi_message_add_tail(&t[0], &m);++	t[1].rx_buf = buf;+	t[1].len = sizeof(buf);+	spi_message_add_tail(&t[1], &m);++	cmd[0] = vsc7385_make_addr(VSC73XX_CMD_MODE_READ, block, subblock);+	cmd[1] = reg;+	cmd[2] = 0;+	cmd[3] = 0;++	mutex_lock(&vsc->lock);+	err = spi_sync(vsc->spi, &m);+	mutex_unlock(&vsc->lock);++	if (err)+		return err;++	*value = (((u32) buf[0]) << 24) | (((u32) buf[1]) << 16) |+		 (((u32) buf[2]) << 8) | ((u32) buf[3]);++	return 0;+}+++static int vsc7385_write(struct vsc7385 *vsc, u8 block, u8 subblock, u8 reg,+			 u32 value)+{+	u8 cmd[2];+	u8 buf[4];+	struct spi_transfer t[2];+	struct spi_message m;+	int err;++	if (!vsc7385_is_addr_valid(block, subblock))+		return -EINVAL;++	spi_message_init(&m);++	memset(&t, 0, sizeof(t));++	t[0].tx_buf = cmd;+	t[0].len = sizeof(cmd);+	spi_message_add_tail(&t[0], &m);++	t[1].tx_buf = buf;+	t[1].len = sizeof(buf);+	spi_message_add_tail(&t[1], &m);++	cmd[0] = vsc7385_make_addr(VSC73XX_CMD_MODE_WRITE, block, subblock);+	cmd[1] = reg;++	buf[0] = (value >> 24) & 0xff;+	buf[1] = (value >> 16) & 0xff;+	buf[2] = (value >> 8) & 0xff;+	buf[3] = value & 0xff;++	mutex_lock(&vsc->lock);+	err = spi_sync(vsc->spi, &m);+	mutex_unlock(&vsc->lock);++	return err;+}++static inline int vsc7385_write_verify(struct vsc7385 *vsc, u8 block,+				       u8 subblock, u8 reg, u32 value,+				       u32 read_mask, u32 read_val)+{+	struct spi_device *spi = vsc->spi;+	u32 t;+	int err;++	err = vsc7385_write(vsc, block, subblock, reg, value);+	if (err)+		return err;++	err = vsc7385_read(vsc, block, subblock, reg, &t);+	if (err)+		return err;++	if ((t & read_mask) != read_val) {+		dev_err(&spi->dev, "register write error\n");+		return -EIO;+	}++	return 0;+}++static inline int vsc7385_set_clock_delay(struct vsc7385 *vsc, u32 val)+{+	return vsc7385_write(vsc, VSC73XX_BLOCK_SYSTEM, 0,+			     VSC73XX_ICPU_CLOCK_DELAY, val);+}++static inline int vsc7385_get_clock_delay(struct vsc7385 *vsc, u32 *val)+{+	return vsc7385_read(vsc, VSC73XX_BLOCK_SYSTEM, 0,+			    VSC73XX_ICPU_CLOCK_DELAY, val);+}++static inline int vsc7385_icpu_stop(struct vsc7385 *vsc)+{+	return vsc7385_write(vsc, VSC73XX_BLOCK_SYSTEM, 0, VSC73XX_ICPU_CTRL,+			     VSC73XX_ICPU_CTRL_STOP);+}++static inline int vsc7385_icpu_start(struct vsc7385 *vsc)+{+	return vsc7385_write(vsc, VSC73XX_BLOCK_SYSTEM, 0, VSC73XX_ICPU_CTRL,+			     VSC73XX_ICPU_CTRL_START);+}++static inline int vsc7385_icpu_reset(struct vsc7385 *vsc)+{+	int rc;++	rc = vsc7385_write(vsc, VSC73XX_BLOCK_SYSTEM, 0, VSC73XX_ICPU_ADDR,+			   0x0000);+	if (rc)+		dev_err(&vsc->spi->dev,+			"could not reset microcode, err=%d\n", rc);++	return rc;+}++static int vsc7385_upload_ucode(struct vsc7385 *vsc)+{+	struct spi_device *spi = vsc->spi;+	const struct firmware *firmware;+	char *ucode_name;+	unsigned char *dp;+	unsigned int curVal;+	int i;+	int diffs;+	int rc;++	ucode_name = (vsc->pdata->ucode_name) ? vsc->pdata->ucode_name+					      : "vsc7385_ucode.bin";+	rc = request_firmware(&firmware, ucode_name, &spi->dev);+	if (rc) {+		dev_err(&spi->dev, "request_firmware failed, err=%d\n",+			rc);+		return rc;+	}++	rc = vsc7385_icpu_stop(vsc);+	if (rc)+		goto out;++	rc = vsc7385_icpu_reset(vsc);+	if (rc)+		goto out;++	dev_info(&spi->dev, "uploading microcode...\n");++	dp = (unsigned char *) firmware->data;+	for (i = 0; i < firmware->size; i++) {+		rc = vsc7385_write(vsc, VSC73XX_BLOCK_SYSTEM, 0,+				   VSC73XX_ICPU_SRAM, *dp++);+		if (rc) {+			dev_err(&spi->dev, "could not load microcode, err=%d\n",+				rc);+			goto out;+		}+	}++	rc = vsc7385_icpu_reset(vsc);+	if (rc)+		goto out;++	dev_info(&spi->dev, "verifying microcode...\n");++	dp = (unsigned char *) firmware->data;+	diffs = 0;+	for (i = 0; i < firmware->size; i++) {+		rc = vsc7385_read(vsc, VSC73XX_BLOCK_SYSTEM, 0,+				  VSC73XX_ICPU_SRAM, &curVal);+		if (rc) {+			dev_err(&spi->dev, "could not read microcode %d\n",rc);+			goto out;+		}++		if (curVal > 0xff) {+			dev_err(&spi->dev, "bad val read: %04x : %02x  %02x\n",+				i, *dp, curVal);+			rc = -EIO;+			goto out;+		}++		if ((curVal & 0xff) != *dp) {+			diffs++;+			dev_err(&spi->dev, "verify error: %04x : %02x  %02x\n",+				i, *dp, curVal);++			if (diffs > 4)+				break;+			}+		dp++;+	}++	if (diffs) {+		dev_err(&spi->dev, "microcode verification failed\n");+		rc = -EIO;+		goto out;+	}++	dev_info(&spi->dev, "microcode uploaded\n");++	rc = vsc7385_icpu_start(vsc);++ out:+	release_firmware(firmware);+	return rc;+}++static int vsc7385_setup(struct vsc7385 *vsc)+{+	struct vsc7385_platform_data *pdata = vsc->pdata;+	u32 t;+	int err;++	err = vsc7385_write_verify(vsc, VSC73XX_BLOCK_SYSTEM, 0,+				   VSC73XX_ICPU_CLOCK_DELAY,+				   VSC7385_CLOCK_DELAY,+				   VSC7385_CLOCK_DELAY_MASK,+				   VSC7385_CLOCK_DELAY);+	if (err)+		goto err;++	err = vsc7385_write_verify(vsc, VSC73XX_BLOCK_MAC,+				   VSC73XX_SUBBLOCK_PORT_MAC, VSC73XX_ADVPORTM,+				   VSC7385_ADVPORTM_INIT,+				   VSC7385_ADVPORTM_MASK,+				   VSC7385_ADVPORTM_INIT);+	if (err)+		goto err;++	err = vsc7385_write(vsc, VSC73XX_BLOCK_MAC, VSC73XX_SUBBLOCK_PORT_MAC,+			    VSC73XX_MAC_CFG, VSC7385_MAC_CFG_RESET);+	if (err)+		goto err;++	t = VSC73XX_MAC_CFG_INIT;+	t |= VSC73XX_MAC_CFG_TX_IPG(pdata->mac_cfg.tx_ipg);+	t |= VSC73XX_MAC_CFG_CLK_SEL(pdata->mac_cfg.clk_sel);+	if (pdata->mac_cfg.bit2)+		t |= VSC73XX_MAC_CFG_BIT2;++	err = vsc7385_write(vsc, VSC73XX_BLOCK_MAC, VSC73XX_SUBBLOCK_PORT_MAC,+			    VSC73XX_MAC_CFG, t);+	if (err)+		goto err;++	return 0;++ err:+	return err;+}++static int vsc7385_detect(struct vsc7385 *vsc)+{+	struct spi_device *spi = vsc->spi;+	u32 t;+	u32 id;+	u32 rev;+	int err;++	err = vsc7385_read(vsc, VSC73XX_BLOCK_SYSTEM, 0,+				VSC73XX_ICPU_MBOX_VAL, &t);+	if (err) {+		dev_err(&spi->dev, "unable to read mailbox, err=%d\n", err);+		return err;+	}++	if (t == 0xffffffff) {+		dev_dbg(&spi->dev, "assert chip reset\n");+		if (vsc->pdata->reset)+			vsc->pdata->reset();++	}++	err = vsc7385_read(vsc, VSC73XX_BLOCK_SYSTEM, 0,+				VSC73XX_ICPU_CHIPID, &t);+	if (err) {+		dev_err(&spi->dev, "unable to read chip id, err=%d\n", err);+		return err;+	}++	id = (t >> VSC73XX_ICPU_CHIPID_ID_SHIFT) & VSC73XX_ICPU_CHIPID_ID_MASK;+	switch (id) {+	case VSC73XX_ICPU_CHIPID_ID_7385:+	case VSC73XX_ICPU_CHIPID_ID_7395:+		break;+	default:+		dev_err(&spi->dev, "unsupported chip, id=%04x\n", id);+		return -ENODEV;+	}++	rev = (t >> VSC73XX_ICPU_CHIPID_REV_SHIFT) &+	      VSC73XX_ICPU_CHIPID_REV_MASK;+	dev_info(&spi->dev, "VSC%04X (rev. %d) switch found \n", id, rev);++	return 0;+}++static int __devinit vsc7385_probe(struct spi_device *spi)+{+	struct vsc7385 *vsc;+	struct vsc7385_platform_data *pdata;+	int	err;++	printk(KERN_INFO DRV_DESC " version " DRV_VERSION"\n");++	pdata = spi->dev.platform_data;+	if (!pdata) {+		dev_err(&spi->dev, "no platform data specified\n");+		return-ENODEV;+	}++	vsc = kzalloc(sizeof(*vsc), GFP_KERNEL);+	if (!vsc) {+		dev_err(&spi->dev, "no memory for private data\n");+		return-ENOMEM;+	}++	mutex_init(&vsc->lock);+	vsc->pdata = pdata;+	vsc->spi = spi_dev_get(spi);+	dev_set_drvdata(&spi->dev, vsc);++	spi->mode = SPI_MODE_0;+	spi->bits_per_word = 8;+	err = spi_setup(spi);+	if (err) {+		dev_err(&spi->dev, "spi_setup failed, err=%d \n", err);+		goto err_drvdata;+	}++	err = vsc7385_detect(vsc);+	if (err) {+		dev_err(&spi->dev, "no chip found, err=%d \n", err);+		goto err_drvdata;+	}++	err = vsc7385_upload_ucode(vsc);+	if (err)+		goto err_drvdata;++	err = vsc7385_setup(vsc);+	if (err)+		goto err_drvdata;++	return 0;++ err_drvdata:+	dev_set_drvdata(&spi->dev, NULL);+	kfree(vsc);+	return err;+}++static int __devexit vsc7385_remove(struct spi_device *spi)+{+	struct vsc7385_data	*vsc;++	vsc = dev_get_drvdata(&spi->dev);+	dev_set_drvdata(&spi->dev, NULL);+	kfree(vsc);++	return 0;+}++static struct spi_driver vsc7385_driver = {+	.driver = {+		.name		= DRV_NAME,+		.bus		= &spi_bus_type,+		.owner		= THIS_MODULE,+	},+	.probe		= vsc7385_probe,+	.remove		= __devexit_p(vsc7385_remove),+};++static int __init vsc7385_init(void)+{+	return spi_register_driver(&vsc7385_driver);+}+module_init(vsc7385_init);++static void __exit vsc7385_exit(void)+{+	spi_unregister_driver(&vsc7385_driver);+}+module_exit(vsc7385_exit);++MODULE_DESCRIPTION(DRV_DESC);+MODULE_VERSION(DRV_VERSION);+MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");+MODULE_LICENSE("GPL v2");+diff -Nur linux-2.6.37.orig/drivers/usb/host/Kconfig linux-2.6.37/drivers/usb/host/Kconfig--- linux-2.6.37.orig/drivers/usb/host/Kconfig	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/usb/host/Kconfig	2011-01-11 20:25:48.000000000 +0100@@ -118,6 +118,13 @@ config USB_FSL_MPH_DR_OF 	tristate +config USB_EHCI_AR71XX+	bool "USB EHCI support for AR71xx"+	depends on USB_EHCI_HCD && ATHEROS_AR71XX+	default y+	help+	  Support for Atheros AR71xx built-in EHCI controller+ config USB_EHCI_FSL 	bool "Support for Freescale on-chip EHCI USB controller" 	depends on USB_EHCI_HCD && FSL_SOC@@ -232,6 +239,13 @@ 	  Enables support for the on-chip OHCI controller on 	  OMAP3 and later chips. +config USB_OHCI_AR71XX+	bool "USB OHCI support for Atheros AR71xx"+	depends on USB_OHCI_HCD && ATHEROS_AR71XX+	default y+	help+	  Support for Atheros AR71xx built-in OHCI controller+ config USB_OHCI_HCD_PPC_SOC 	bool "OHCI support for on-chip PPC USB controller" 	depends on USB_OHCI_HCD && (STB03xxx || PPC_MPC52xx)diff -Nur linux-2.6.37.orig/drivers/usb/host/ehci-ar71xx.c linux-2.6.37/drivers/usb/host/ehci-ar71xx.c--- linux-2.6.37.orig/drivers/usb/host/ehci-ar71xx.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/usb/host/ehci-ar71xx.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,242 @@+/*+ *  Bus Glue for Atheros AR71xx built-in EHCI controller.+ *+ *  Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Parts of this file are based on Atheros' 2.6.15 BSP+ *	Copyright (C) 2007 Atheros Communications, Inc.+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/platform_device.h>+#include <linux/delay.h>++#include <asm/mach-ar71xx/platform.h>++extern int usb_disabled(void);++static int ehci_ar71xx_init(struct usb_hcd *hcd)+{+	struct ehci_hcd *ehci = hcd_to_ehci(hcd);+	int ret;++	ehci->caps = hcd->regs;+	ehci->regs = hcd->regs ++			HC_LENGTH(ehci_readl(ehci, &ehci->caps->hc_capbase));+	ehci->hcs_params = ehci_readl(ehci, &ehci->caps->hcs_params);++	ehci->sbrn = 0x20;+	ehci->has_synopsys_hc_bug = 1;++	ehci_reset(ehci);++	ret = ehci_init(hcd);+	if (ret)+		return ret;++	ehci_port_power(ehci, 0);++	return 0;+}++static int ehci_ar91xx_init(struct usb_hcd *hcd)+{+	struct ehci_hcd *ehci = hcd_to_ehci(hcd);+	int ret;++	ehci->caps = hcd->regs + 0x100;+	ehci->regs = hcd->regs + 0x100 ++			HC_LENGTH(ehci_readl(ehci, &ehci->caps->hc_capbase));+	ehci->hcs_params = ehci_readl(ehci, &ehci->caps->hcs_params);++	hcd->has_tt = 1;+	ehci->sbrn = 0x20;++	ehci_reset(ehci);++	ret = ehci_init(hcd);+	if (ret)+		return ret;++	ehci_port_power(ehci, 0);++	return 0;+}++static int ehci_ar71xx_probe(const struct hc_driver *driver,+			     struct usb_hcd **hcd_out,+			     struct platform_device *pdev)+{+	struct usb_hcd *hcd;+	struct resource *res;+	int irq;+	int ret;++	res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);+	if (!res) {+		dev_dbg(&pdev->dev, "no IRQ specified for %s\n",+			dev_name(&pdev->dev));+		return -ENODEV;+	}+	irq = res->start;++	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);+	if (!res) {+		dev_dbg(&pdev->dev, "no base address specified for %s\n",+			dev_name(&pdev->dev));+		return -ENODEV;+	}++	hcd = usb_create_hcd(driver, &pdev->dev, dev_name(&pdev->dev));+	if (!hcd)+		return -ENOMEM;++	hcd->rsrc_start	= res->start;+	hcd->rsrc_len	= res->end - res->start + 1;++	if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, hcd_name)) {+		dev_dbg(&pdev->dev, "controller already in use\n");+		ret = -EBUSY;+		goto err_put_hcd;+	}++	hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len);+	if (!hcd->regs) {+		dev_dbg(&pdev->dev, "error mapping memory\n");+		ret = -EFAULT;+		goto err_release_region;+	}++	ret = usb_add_hcd(hcd, irq, IRQF_DISABLED | IRQF_SHARED);+	if (ret)+		goto err_iounmap;++	return 0;++ err_iounmap:+	iounmap(hcd->regs);++ err_release_region:+	release_mem_region(hcd->rsrc_start, hcd->rsrc_len);+ err_put_hcd:+	usb_put_hcd(hcd);+	return ret;+}++static void ehci_ar71xx_remove(struct usb_hcd *hcd,+			       struct platform_device *pdev)+{+	usb_remove_hcd(hcd);+	iounmap(hcd->regs);+	release_mem_region(hcd->rsrc_start, hcd->rsrc_len);+	usb_put_hcd(hcd);+}++static const struct hc_driver ehci_ar71xx_hc_driver = {+	.description		= hcd_name,+	.product_desc		= "Atheros AR71xx built-in EHCI controller",+	.hcd_priv_size		= sizeof(struct ehci_hcd),++	.irq			= ehci_irq,+	.flags			= HCD_MEMORY | HCD_USB2,++	.reset			= ehci_ar71xx_init,+	.start			= ehci_run,+	.stop			= ehci_stop,+	.shutdown		= ehci_shutdown,++	.urb_enqueue		= ehci_urb_enqueue,+	.urb_dequeue		= ehci_urb_dequeue,+	.endpoint_disable	= ehci_endpoint_disable,+	.endpoint_reset		= ehci_endpoint_reset,++	.get_frame_number	= ehci_get_frame,++	.hub_status_data	= ehci_hub_status_data,+	.hub_control		= ehci_hub_control,+#ifdef CONFIG_PM+	.hub_suspend		= ehci_hub_suspend,+	.hub_resume		= ehci_hub_resume,+#endif+	.relinquish_port	= ehci_relinquish_port,+	.port_handed_over	= ehci_port_handed_over,++	.clear_tt_buffer_complete = ehci_clear_tt_buffer_complete,+};++static const struct hc_driver ehci_ar91xx_hc_driver = {+	.description		= hcd_name,+	.product_desc		= "Atheros AR91xx built-in EHCI controller",+	.hcd_priv_size		= sizeof(struct ehci_hcd),+	.irq			= ehci_irq,+	.flags			= HCD_MEMORY | HCD_USB2,++	.reset			= ehci_ar91xx_init,+	.start			= ehci_run,+	.stop			= ehci_stop,+	.shutdown		= ehci_shutdown,++	.urb_enqueue		= ehci_urb_enqueue,+	.urb_dequeue		= ehci_urb_dequeue,+	.endpoint_disable	= ehci_endpoint_disable,+	.endpoint_reset		= ehci_endpoint_reset,++	.get_frame_number	= ehci_get_frame,++	.hub_status_data	= ehci_hub_status_data,+	.hub_control		= ehci_hub_control,+#ifdef CONFIG_PM+	.hub_suspend		= ehci_hub_suspend,+	.hub_resume		= ehci_hub_resume,+#endif+	.relinquish_port	= ehci_relinquish_port,+	.port_handed_over	= ehci_port_handed_over,++	.clear_tt_buffer_complete = ehci_clear_tt_buffer_complete,+};++static int ehci_ar71xx_driver_probe(struct platform_device *pdev)+{+	struct ar71xx_ehci_platform_data *pdata;+	struct usb_hcd *hcd = NULL;+	int ret;++	if (usb_disabled())+		return -ENODEV;++	pdata = pdev->dev.platform_data;+	if (!pdata) {+		dev_err(&pdev->dev, "no platform data specified for %s\n",+			dev_name(&pdev->dev));+		return -ENODEV;+	}++	if (pdata->is_ar91xx)+		ret = ehci_ar71xx_probe(&ehci_ar91xx_hc_driver, &hcd, pdev);+	else+		ret = ehci_ar71xx_probe(&ehci_ar71xx_hc_driver, &hcd, pdev);++	return ret;+}++static int ehci_ar71xx_driver_remove(struct platform_device *pdev)+{+	struct usb_hcd *hcd = platform_get_drvdata(pdev);++	ehci_ar71xx_remove(hcd, pdev);+	return 0;+}++MODULE_ALIAS("platform:ar71xx-ehci");++static struct platform_driver ehci_ar71xx_driver = {+	.probe		= ehci_ar71xx_driver_probe,+	.remove		= ehci_ar71xx_driver_remove,+	.driver = {+		.name	= "ar71xx-ehci",+	}+};diff -Nur linux-2.6.37.orig/drivers/usb/host/ehci-hcd.c linux-2.6.37/drivers/usb/host/ehci-hcd.c--- linux-2.6.37.orig/drivers/usb/host/ehci-hcd.c	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/usb/host/ehci-hcd.c	2011-01-11 20:25:48.000000000 +0100@@ -1216,6 +1216,11 @@ #define PLATFORM_DRIVER		ehci_octeon_driver #endif +#ifdef CONFIG_USB_EHCI_AR71XX+#include "ehci-ar71xx.c"+#define PLATFORM_DRIVER		ehci_ar71xx_driver+#endif+ #if !defined(PCI_DRIVER) && !defined(PLATFORM_DRIVER) && \     !defined(PS3_SYSTEM_BUS_DRIVER) && !defined(OF_PLATFORM_DRIVER) && \     !defined(XILINX_OF_PLATFORM_DRIVER)diff -Nur linux-2.6.37.orig/drivers/usb/host/ohci-ar71xx.c linux-2.6.37/drivers/usb/host/ohci-ar71xx.c--- linux-2.6.37.orig/drivers/usb/host/ohci-ar71xx.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/usb/host/ohci-ar71xx.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,165 @@+/*+ *  OHCI HCD (Host Controller Driver) for USB.+ *+ *  Bus Glue for Atheros AR71xx built-in OHCI controller.+ *+ *  Copyright (C) 2008 Gabor Juhos <juhosg@openwrt.org>+ *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ *  Parts of this file are based on Atheros' 2.6.15 BSP+ *	Copyright (C) 2007 Atheros Communications, Inc.+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ */++#include <linux/platform_device.h>+#include <linux/delay.h>++extern int usb_disabled(void);++static int usb_hcd_ar71xx_probe(const struct hc_driver *driver,+				struct platform_device *pdev)+{+	struct usb_hcd *hcd;+	struct resource *res;+	int irq;+	int ret;++	res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);+	if (!res) {+		dev_dbg(&pdev->dev, "no IRQ specified for %s\n",+			dev_name(&pdev->dev));+		return -ENODEV;+	}+	irq = res->start;++	hcd = usb_create_hcd(driver, &pdev->dev, dev_name(&pdev->dev));+	if (!hcd)+		return -ENOMEM;++	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);+	if (!res) {+		dev_dbg(&pdev->dev, "no base address specified for %s\n",+			dev_name(&pdev->dev));+		ret = -ENODEV;+		goto err_put_hcd;+	}+	hcd->rsrc_start	= res->start;+	hcd->rsrc_len	= res->end - res->start + 1;++	if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, hcd_name)) {+		dev_dbg(&pdev->dev, "controller already in use\n");+		ret = -EBUSY;+		goto err_put_hcd;+	}++	hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len);+	if (!hcd->regs) {+		dev_dbg(&pdev->dev, "error mapping memory\n");+		ret = -EFAULT;+		goto err_release_region;+	}++	ohci_hcd_init(hcd_to_ohci(hcd));++	ret = usb_add_hcd(hcd, irq, IRQF_DISABLED);+	if (ret)+		goto err_stop_hcd;++	return 0;++ err_stop_hcd:+	iounmap(hcd->regs);+ err_release_region:+	release_mem_region(hcd->rsrc_start, hcd->rsrc_len);+ err_put_hcd:+	usb_put_hcd(hcd);+	return ret;+}++void usb_hcd_ar71xx_remove(struct usb_hcd *hcd, struct platform_device *pdev)+{+	usb_remove_hcd(hcd);+	iounmap(hcd->regs);+	release_mem_region(hcd->rsrc_start, hcd->rsrc_len);+	usb_put_hcd(hcd);+}++static int __devinit ohci_ar71xx_start(struct usb_hcd *hcd)+{+	struct ohci_hcd	*ohci = hcd_to_ohci(hcd);+	int ret;++	ret = ohci_init(ohci);+	if (ret < 0)+		return ret;++	ret = ohci_run(ohci);+	if (ret < 0)+		goto err;++	return 0;++ err:+	ohci_stop(hcd);+	return ret;+}++static const struct hc_driver ohci_ar71xx_hc_driver = {+	.description		= hcd_name,+	.product_desc		= "Atheros AR71xx built-in OHCI controller",+	.hcd_priv_size		= sizeof(struct ohci_hcd),++	.irq			= ohci_irq,+	.flags			= HCD_USB11 | HCD_MEMORY,++	.start			= ohci_ar71xx_start,+	.stop			= ohci_stop,+	.shutdown		= ohci_shutdown,++	.urb_enqueue		= ohci_urb_enqueue,+	.urb_dequeue		= ohci_urb_dequeue,+	.endpoint_disable	= ohci_endpoint_disable,++	/*+	 * scheduling support+	 */+	.get_frame_number	= ohci_get_frame,++	/*+	 * root hub support+	 */+	.hub_status_data	= ohci_hub_status_data,+	.hub_control		= ohci_hub_control,+	.start_port_reset	= ohci_start_port_reset,+};++static int ohci_hcd_ar71xx_drv_probe(struct platform_device *pdev)+{+	if (usb_disabled())+		return -ENODEV;++	return usb_hcd_ar71xx_probe(&ohci_ar71xx_hc_driver, pdev);+}++static int ohci_hcd_ar71xx_drv_remove(struct platform_device *pdev)+{+	struct usb_hcd *hcd = platform_get_drvdata(pdev);++	usb_hcd_ar71xx_remove(hcd, pdev);+	return 0;+}++MODULE_ALIAS("platform:ar71xx-ohci");++static struct platform_driver ohci_hcd_ar71xx_driver = {+	.probe		= ohci_hcd_ar71xx_drv_probe,+	.remove		= ohci_hcd_ar71xx_drv_remove,+	.shutdown	= usb_hcd_platform_shutdown,+	.driver		= {+		.name	= "ar71xx-ohci",+		.owner	= THIS_MODULE,+	},+};diff -Nur linux-2.6.37.orig/drivers/usb/host/ohci-hcd.c linux-2.6.37/drivers/usb/host/ohci-hcd.c--- linux-2.6.37.orig/drivers/usb/host/ohci-hcd.c	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/usb/host/ohci-hcd.c	2011-01-11 20:25:48.000000000 +0100@@ -1111,6 +1111,11 @@ #define PLATFORM_DRIVER		ohci_octeon_driver #endif +#ifdef CONFIG_USB_OHCI_AR71XX+#include "ohci-ar71xx.c"+#define PLATFORM_DRIVER		ohci_hcd_ar71xx_driver+#endif+ #if	!defined(PCI_DRIVER) &&		\ 	!defined(PLATFORM_DRIVER) &&	\ 	!defined(OMAP1_PLATFORM_DRIVER) &&	\diff -Nur linux-2.6.37.orig/drivers/watchdog/Kconfig linux-2.6.37/drivers/watchdog/Kconfig--- linux-2.6.37.orig/drivers/watchdog/Kconfig	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/watchdog/Kconfig	2011-01-11 20:25:48.000000000 +0100@@ -930,6 +930,13 @@ 	  To compile this driver as a loadable module, choose M here. 	  The module will be called bcm63xx_wdt. +config AR71XX_WDT+	tristate "Atheros AR71xx Watchdog Timer"+	depends on ATHEROS_AR71XX+	help+	  Hardware driver for the built-in watchdog timer on the Atheros+	  AR71xx SoCs.+ # PARISC Architecture  # POWERPC Architecturediff -Nur linux-2.6.37.orig/drivers/watchdog/Makefile linux-2.6.37/drivers/watchdog/Makefile--- linux-2.6.37.orig/drivers/watchdog/Makefile	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/drivers/watchdog/Makefile	2011-01-11 20:25:48.000000000 +0100@@ -117,6 +117,7 @@ obj-$(CONFIG_SIBYTE_WDOG) += sb_wdog.o obj-$(CONFIG_AR7_WDT) += ar7_wdt.o obj-$(CONFIG_TXX9_WDT) += txx9wdt.o+obj-$(CONFIG_AR71XX_WDT) += ar71xx_wdt.o obj-$(CONFIG_OCTEON_WDT) += octeon-wdt.o octeon-wdt-y := octeon-wdt-main.o octeon-wdt-nmi.o diff -Nur linux-2.6.37.orig/drivers/watchdog/ar71xx_wdt.c linux-2.6.37/drivers/watchdog/ar71xx_wdt.c--- linux-2.6.37.orig/drivers/watchdog/ar71xx_wdt.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/drivers/watchdog/ar71xx_wdt.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,270 @@+/*+ * Driver for the Atheros AR71xx SoC's built-in hardware watchdog timer.+ *+ * Copyright (C) 2008 Gabor Juhos <juhosg@openwrt.org>+ * Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>+ *+ * This driver was based on: drivers/watchdog/ixp4xx_wdt.c+ *	Author: Deepak Saxena <dsaxena@plexity.net>+ *	Copyright 2004 (c) MontaVista, Software, Inc.+ *+ * which again was based on sa1100 driver,+ *	Copyright (C) 2000 Oleg Drokin <green@crimea.edu>+ *+ * This program is free software; you can redistribute it and/or modify it+ * under the terms of the GNU General Public License version 2 as published+ * by the Free Software Foundation.+ *+ */++#include <linux/bitops.h>+#include <linux/errno.h>+#include <linux/fs.h>+#include <linux/init.h>+#include <linux/kernel.h>+#include <linux/miscdevice.h>+#include <linux/module.h>+#include <linux/moduleparam.h>+#include <linux/platform_device.h>+#include <linux/types.h>+#include <linux/watchdog.h>++#include <asm/mach-ar71xx/ar71xx.h>++#define DRV_NAME	"ar71xx-wdt"+#define DRV_DESC	"Atheros AR71xx hardware watchdog driver"+#define DRV_VERSION	"0.1.0"++#define WDT_TIMEOUT	15	/* seconds */++static int nowayout = WATCHDOG_NOWAYOUT;++#ifdef CONFIG_WATCHDOG_NOWAYOUT+module_param(nowayout, int, 0);+MODULE_PARM_DESC(nowayout, "Watchdog cannot be stopped once started "+			   "(default=" __MODULE_STRING(WATCHDOG_NOWAYOUT) ")");+#endif++static unsigned long wdt_flags;++#define WDT_FLAGS_BUSY		0+#define WDT_FLAGS_EXPECT_CLOSE	1++static int wdt_timeout = WDT_TIMEOUT;+static int boot_status;+static int max_timeout;++static void inline ar71xx_wdt_keepalive(void)+{+	ar71xx_reset_wr(AR71XX_RESET_REG_WDOG, ar71xx_ahb_freq * wdt_timeout);+}++static void inline ar71xx_wdt_enable(void)+{+	printk(KERN_DEBUG DRV_NAME ": enabling watchdog timer\n");+	ar71xx_wdt_keepalive();+	ar71xx_reset_wr(AR71XX_RESET_REG_WDOG_CTRL, WDOG_CTRL_ACTION_FCR);+}++static void inline ar71xx_wdt_disable(void)+{+	printk(KERN_DEBUG DRV_NAME ": disabling watchdog timer\n");+	ar71xx_reset_wr(AR71XX_RESET_REG_WDOG_CTRL, WDOG_CTRL_ACTION_NONE);+}++static int ar71xx_wdt_set_timeout(int val)+{+	if (val < 1 || val > max_timeout)+		return -EINVAL;++	wdt_timeout = val;+	ar71xx_wdt_keepalive();++	printk(KERN_DEBUG DRV_NAME ": timeout=%d secs\n", wdt_timeout);++	return 0;+}++static int ar71xx_wdt_open(struct inode *inode, struct file *file)+{+	if (test_and_set_bit(WDT_FLAGS_BUSY, &wdt_flags))+		return -EBUSY;++	clear_bit(WDT_FLAGS_EXPECT_CLOSE, &wdt_flags);++	ar71xx_wdt_enable();++	return nonseekable_open(inode, file);+}++static int ar71xx_wdt_release(struct inode *inode, struct file *file)+{+	if (test_bit(WDT_FLAGS_EXPECT_CLOSE, &wdt_flags)) {+		ar71xx_wdt_disable();+	} else {+		printk(KERN_CRIT DRV_NAME ": device closed unexpectedly, "+					"watchdog timer will not stop!\n");+	}++	clear_bit(WDT_FLAGS_BUSY, &wdt_flags);+	clear_bit(WDT_FLAGS_EXPECT_CLOSE, &wdt_flags);++	return 0;+}++static ssize_t ar71xx_wdt_write(struct file *file, const char *data,+				size_t len, loff_t *ppos)+{+        if (len) {+		if (!nowayout) {+			size_t i;++			clear_bit(WDT_FLAGS_EXPECT_CLOSE, &wdt_flags);++			for (i = 0; i != len; i++) {+				char c;++				if (get_user(c, data + i))+					return -EFAULT;++				if (c == 'V')+					set_bit(WDT_FLAGS_EXPECT_CLOSE,+						&wdt_flags);+			}+		}++		ar71xx_wdt_keepalive();+	}++	return len;+}++static struct watchdog_info ar71xx_wdt_info = {+	.options		= WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING |+				  WDIOF_MAGICCLOSE | WDIOF_CARDRESET,+	.firmware_version 	= 0,+	.identity		= "AR71XX watchdog",+};++static int ar71xx_wdt_ioctl(struct inode *inode, struct file *file,+			    unsigned int cmd, unsigned long arg)+{+	int t;+	int ret;++	switch (cmd) {+	case WDIOC_GETSUPPORT:+		ret = copy_to_user((struct watchdog_info *)arg,+				   &ar71xx_wdt_info,+				   sizeof(&ar71xx_wdt_info)) ? -EFAULT : 0;+		break;++	case WDIOC_GETSTATUS:+		ret = put_user(0, (int *)arg) ? -EFAULT : 0;+		break;++	case WDIOC_GETBOOTSTATUS:+		ret = put_user(boot_status, (int *)arg) ? -EFAULT : 0;+		break;++	case WDIOC_KEEPALIVE:+		ar71xx_wdt_keepalive();+		ret = 0;+		break;++	case WDIOC_SETTIMEOUT:+		ret = get_user(t, (int *)arg) ? -EFAULT : 0;+		if (ret)+			break;++		ret = ar71xx_wdt_set_timeout(t);+		if (ret)+			break;++		/* fallthrough */+	case WDIOC_GETTIMEOUT:+		ret = put_user(wdt_timeout, (int *)arg) ? -EFAULT : 0;+		break;++	default:+		ret = -ENOTTY;+		break;+	}++	return ret;+}++static const struct file_operations ar71xx_wdt_fops = {+	.owner		= THIS_MODULE,+	.write		= ar71xx_wdt_write,+	.ioctl		= ar71xx_wdt_ioctl,+	.open		= ar71xx_wdt_open,+	.release	= ar71xx_wdt_release,+};++static struct miscdevice ar71xx_wdt_miscdev = {+	.minor = WATCHDOG_MINOR,+	.name = "watchdog",+	.fops = &ar71xx_wdt_fops,+};++static int __devinit ar71xx_wdt_probe(struct platform_device *pdev)+{+	int ret;++	max_timeout = (0xfffffffful / ar71xx_ahb_freq);+	wdt_timeout = (max_timeout < WDT_TIMEOUT) ? max_timeout : WDT_TIMEOUT;++	boot_status =+		(ar71xx_reset_rr(AR71XX_RESET_REG_WDOG_CTRL) & WDOG_CTRL_LAST_RESET) ?+		WDIOF_CARDRESET : 0;++	ret = misc_register(&ar71xx_wdt_miscdev);+	if (ret)+		goto err_out;++	printk(KERN_INFO DRV_DESC " version " DRV_VERSION "\n");++	printk(KERN_DEBUG DRV_NAME ": timeout=%d secs (max=%d)\n",+				 	wdt_timeout, max_timeout);++	return 0;++err_out:+	return ret;+}++static int __devexit ar71xx_wdt_remove(struct platform_device *pdev)+{+	misc_deregister(&ar71xx_wdt_miscdev);+	return 0;+}++static struct platform_driver ar71xx_wdt_driver = {+	.probe		= ar71xx_wdt_probe,+	.remove		= __devexit_p(ar71xx_wdt_remove),+	.driver		= {+		.name	= DRV_NAME,+		.owner	= THIS_MODULE,+	},+};++static int __init ar71xx_wdt_init(void)+{+	return platform_driver_register(&ar71xx_wdt_driver);+}+module_init(ar71xx_wdt_init);++static void __exit ar71xx_wdt_exit(void)+{+	platform_driver_unregister(&ar71xx_wdt_driver);+}+module_exit(ar71xx_wdt_exit);++MODULE_DESCRIPTION(DRV_DESC);+MODULE_VERSION(DRV_VERSION);+MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org");+MODULE_AUTHOR("Imre Kaloz <kaloz@openwrt.org");+MODULE_LICENSE("GPL v2");+MODULE_ALIAS("platform:" DRV_NAME);+MODULE_ALIAS_MISCDEV(WATCHDOG_MINOR);diff -Nur linux-2.6.37.orig/include/linux/ath9k_platform.h linux-2.6.37/include/linux/ath9k_platform.h--- linux-2.6.37.orig/include/linux/ath9k_platform.h	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/include/linux/ath9k_platform.h	2011-01-11 20:25:48.000000000 +0100@@ -1,19 +1,11 @@ /*- * Copyright (c) 2008 Atheros Communications Inc.- * Copyright (c) 2009 Gabor Juhos <juhosg@openwrt.org>- * Copyright (c) 2009 Imre Kaloz <kaloz@openwrt.org>+ * ath9k platform data defines  *- * Permission to use, copy, modify, and/or distribute this software for any- * purpose with or without fee is hereby granted, provided that the above- * copyright notice and this permission notice appear in all copies.+ * Copyright (C) 2008 Gabor Juhos <juhosg@openwrt.org>  *- * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES- * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF- * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR- * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES- * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN- * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF- * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.+ * This program is free software; you can redistribute it and/or modify it+ * under the terms of the GNU General Public License version 2 as published+ * by the Free Software Foundation.  */  #ifndef _LINUX_ATH9K_PLATFORM_H@@ -23,6 +15,9 @@  struct ath9k_platform_data { 	u16 eeprom_data[ATH9K_PLAT_EEP_MAX_WORDS];+	u8 *macaddr;++	unsigned long quirk_wndr3700:1; };  #endif /* _LINUX_ATH9K_PLATFORM_H */diff -Nur linux-2.6.37.orig/include/linux/gpio_buttons.h linux-2.6.37/include/linux/gpio_buttons.h--- linux-2.6.37.orig/include/linux/gpio_buttons.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/include/linux/gpio_buttons.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,33 @@+/*+ *  Definitions for the GPIO buttons interface driver+ *+ *  Copyright (C) 2007-2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This file was based on: /include/linux/gpio_keys.h+ *	The original gpio_keys.h seems not to have a license.+ *+ *  This program is free software; you can redistribute it and/or modify+ *  it under the terms of the GNU General Public License version 2 as+ *  published by the Free Software Foundation.+ *+ */++#ifndef _GPIO_BUTTONS_H_+#define _GPIO_BUTTONS_H_++struct gpio_button {+	int	gpio;		/* GPIO line number */+	int	active_low;+	char	*desc;		/* button description */+	int	type;		/* input event type (EV_KEY, EV_SW) */+	int	code;		/* input event code (KEY_*, SW_*) */+	int	threshold;	/* count threshold */+};++struct gpio_buttons_platform_data {+	struct gpio_button *buttons;+	int	nbuttons;		/* number of buttons */+	int	poll_interval;		/* polling interval */+};++#endif /* _GPIO_BUTTONS_H_ */diff -Nur linux-2.6.37.orig/include/linux/gpio_dev.h linux-2.6.37/include/linux/gpio_dev.h--- linux-2.6.37.orig/include/linux/gpio_dev.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/include/linux/gpio_dev.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,11 @@+#ifndef _GPIODEV_H__+#define _GPIODEV_H__++#define IOC_GPIODEV_MAGIC  'B'+#define GPIO_GET        _IO(IOC_GPIODEV_MAGIC, 10)+#define GPIO_SET        _IO(IOC_GPIODEV_MAGIC, 11)+#define GPIO_CLEAR      _IO(IOC_GPIODEV_MAGIC, 12)+#define GPIO_DIR_IN     _IO(IOC_GPIODEV_MAGIC, 13)+#define GPIO_DIR_OUT    _IO(IOC_GPIODEV_MAGIC, 14)++#endifdiff -Nur linux-2.6.37.orig/include/linux/netdevice.h linux-2.6.37/include/linux/netdevice.h--- linux-2.6.37.orig/include/linux/netdevice.h	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/include/linux/netdevice.h	2011-01-11 20:25:48.000000000 +0100@@ -957,6 +957,7 @@ 	void			*ax25_ptr;	/* AX.25 specific data */ 	struct wireless_dev	*ieee80211_ptr;	/* IEEE 802.11 specific data, 						   assign before registering */+	void			*phy_ptr; /* PHY device specific data */  /*  * Cache lines mostly used on receive path (including eth_type_trans())diff -Nur linux-2.6.37.orig/include/linux/nxp_74hc153.h linux-2.6.37/include/linux/nxp_74hc153.h--- linux-2.6.37.orig/include/linux/nxp_74hc153.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/include/linux/nxp_74hc153.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,24 @@+/*+ *  NXP 74HC153 - Dual 4-input multiplexer defines+ *+ *  Copyright (C) 2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This program is free software; you can redistribute it and/or modify+ *  it under the terms of the GNU General Public License version 2 as+ *  published by the Free Software Foundation.+ */++#ifndef _NXP_74HC153_H+#define _NXP_74HC153_H++#define NXP_74HC153_DRIVER_NAME "nxp-74hc153"++struct nxp_74hc153_platform_data {+	unsigned	gpio_base;+	unsigned	gpio_pin_s0;+	unsigned	gpio_pin_s1;+	unsigned	gpio_pin_1y;+	unsigned	gpio_pin_2y;+};++#endif /* _NXP_74HC153_H */diff -Nur linux-2.6.37.orig/include/linux/phy.h linux-2.6.37/include/linux/phy.h--- linux-2.6.37.orig/include/linux/phy.h	2011-01-05 01:50:19.000000000 +0100+++ linux-2.6.37/include/linux/phy.h	2011-01-11 20:25:48.000000000 +0100@@ -332,6 +332,20 @@ 	void (*adjust_link)(struct net_device *dev);  	void (*adjust_state)(struct net_device *dev);++	/*+	 * By default these point to the original functions+	 * with the same name. adding them to the phy_device+	 * allows the phy driver to override them for packet+	 * mangling if the ethernet driver supports it+	 * This is required to support some really horrible+	 * switches such as the Marvell 88E6060+	 */+	int (*netif_receive_skb)(struct sk_buff *skb);+	int (*netif_rx)(struct sk_buff *skb);++	/* alignment offset for packets */+	int pkt_align; }; #define to_phy_device(d) container_of(d, struct phy_device, dev) @@ -508,6 +522,7 @@ void phy_stop_machine(struct phy_device *phydev); int phy_ethtool_sset(struct phy_device *phydev, struct ethtool_cmd *cmd); int phy_ethtool_gset(struct phy_device *phydev, struct ethtool_cmd *cmd);+int phy_ethtool_ioctl(struct phy_device *phydev, void *useraddr); int phy_mii_ioctl(struct phy_device *phydev, 		struct ifreq *ifr, int cmd); int phy_start_interrupts(struct phy_device *phydev);diff -Nur linux-2.6.37.orig/include/linux/spi/vsc7385.h linux-2.6.37/include/linux/spi/vsc7385.h--- linux-2.6.37.orig/include/linux/spi/vsc7385.h	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/include/linux/spi/vsc7385.h	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,19 @@+/*+ * Platform data definition for the Vitesse VSC7385 ethernet switch driver+ *+ * Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ * This program is free software; you can redistribute it and/or modify it+ * under the terms of the GNU General Public License version 2 as published+ * by the Free Software Foundation.+ */++struct vsc7385_platform_data {+	void		(* reset)(void);+	char		*ucode_name;+	struct {+		u32	tx_ipg:5;+		u32	bit2:1;+		u32	clk_sel:3;+	} mac_cfg;+};diff -Nur linux-2.6.37.orig/net/dsa/ar7240.c linux-2.6.37/net/dsa/ar7240.c--- linux-2.6.37.orig/net/dsa/ar7240.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/net/dsa/ar7240.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,736 @@+/*+ *  DSA driver for the built-in ethernet switch of the Atheros AR7240 SoC+ *  Copyright (c) 2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This file was based on:+ *    net/dsa/mv88e6060.c - Driver for Marvell 88e6060 switch chips+ *    Copyright (c) 2008 Marvell Semiconductor+ *+ *  This program is free software; you can redistribute it and/or modify it+ *  under the terms of the GNU General Public License version 2 as published+ *  by the Free Software Foundation.+ *+ */++#include <linux/etherdevice.h>+#include <linux/list.h>+#include <linux/netdevice.h>+#include <linux/phy.h>+#include <linux/mii.h>+#include <linux/bitops.h>++#include "dsa_priv.h"++#define BITM(_count)	(BIT(_count) - 1)++#define AR7240_REG_MASK_CTRL		0x00+#define AR7240_MASK_CTRL_REVISION_M	BITM(8)+#define AR7240_MASK_CTRL_VERSION_M	BITM(8)+#define AR7240_MASK_CTRL_VERSION_S	8+#define AR7240_MASK_CTRL_SOFT_RESET	BIT(31)++#define AR7240_REG_MAC_ADDR0		0x20+#define AR7240_REG_MAC_ADDR1		0x24++#define AR7240_REG_FLOOD_MASK		0x2c+#define AR7240_FLOOD_MASK_BROAD_TO_CPU	BIT(26)++#define AR7240_REG_GLOBAL_CTRL		0x30+#define AR7240_GLOBAL_CTRL_MTU_M	BITM(12)++#define AR7240_REG_AT_CTRL		0x5c+#define AR7240_AT_CTRL_ARP_EN		BIT(20)++#define AR7240_REG_TAG_PRIORITY		0x70++#define AR7240_REG_SERVICE_TAG		0x74+#define AR7240_SERVICE_TAG_M		BITM(16)++#define AR7240_REG_CPU_PORT		0x78+#define AR7240_MIRROR_PORT_S		4+#define AR7240_CPU_PORT_EN		BIT(8)++#define AR7240_REG_MIB_FUNCTION0	0x80+#define AR7240_MIB_TIMER_M		BITM(16)+#define AR7240_MIB_AT_HALF_EN		BIT(16)+#define AR7240_MIB_BUSY			BIT(17)+#define AR7240_MIB_FUNC_S		24+#define AR7240_MIB_FUNC_NO_OP		0x0+#define AR7240_MIB_FUNC_FLUSH		0x1+#define AR7240_MIB_FUNC_CAPTURE		0x3++#define AR7240_REG_MDIO_CTRL		0x98+#define AR7240_MDIO_CTRL_DATA_M		BITM(16)+#define AR7240_MDIO_CTRL_REG_ADDR_S	16+#define AR7240_MDIO_CTRL_PHY_ADDR_S	21+#define AR7240_MDIO_CTRL_CMD_WRITE	0+#define AR7240_MDIO_CTRL_CMD_READ	BIT(27)+#define AR7240_MDIO_CTRL_MASTER_EN	BIT(30)+#define AR7240_MDIO_CTRL_BUSY		BIT(31)++#define AR7240_REG_PORT_BASE(_port)	(0x100 + (_port) * 0x100)++#define AR7240_REG_PORT_STATUS(_port)	(AR7240_REG_PORT_BASE((_port)) + 0x00)+#define AR7240_PORT_STATUS_SPEED_M	BITM(2)+#define AR7240_PORT_STATUS_SPEED_10	0+#define AR7240_PORT_STATUS_SPEED_100	1+#define AR7240_PORT_STATUS_SPEED_1000	2+#define AR7240_PORT_STATUS_TXMAC	BIT(2)+#define AR7240_PORT_STATUS_RXMAC	BIT(3)+#define AR7240_PORT_STATUS_TXFLOW	BIT(4)+#define AR7240_PORT_STATUS_RXFLOW	BIT(5)+#define AR7240_PORT_STATUS_DUPLEX	BIT(6)+#define AR7240_PORT_STATUS_LINK_UP	BIT(8)+#define AR7240_PORT_STATUS_LINK_AUTO	BIT(9)+#define AR7240_PORT_STATUS_LINK_PAUSE	BIT(10)++#define AR7240_REG_PORT_CTRL(_port)	(AR7240_REG_PORT_BASE((_port)) + 0x04)+#define AR7240_PORT_CTRL_STATE_M	BITM(3)+#define	AR7240_PORT_CTRL_STATE_DISABLED	0+#define AR7240_PORT_CTRL_STATE_BLOCK	1+#define AR7240_PORT_CTRL_STATE_LISTEN	2+#define AR7240_PORT_CTRL_STATE_LEARN	3+#define AR7240_PORT_CTRL_STATE_FORWARD	4+#define AR7240_PORT_CTRL_LEARN_LOCK	BIT(7)+#define AR7240_PORT_CTRL_VLAN_MODE_S	8+#define AR7240_PORT_CTRL_VLAN_MODE_KEEP	0+#define AR7240_PORT_CTRL_VLAN_MODE_STRIP 1+#define AR7240_PORT_CTRL_VLAN_MODE_ADD	2+#define AR7240_PORT_CTRL_VLAN_MODE_DOUBLE_TAG 3+#define AR7240_PORT_CTRL_IGMP_SNOOP	BIT(10)+#define AR7240_PORT_CTRL_HEADER		BIT(11)+#define AR7240_PORT_CTRL_MAC_LOOP	BIT(12)+#define AR7240_PORT_CTRL_SINGLE_VLAN	BIT(13)+#define AR7240_PORT_CTRL_LEARN		BIT(14)+#define AR7240_PORT_CTRL_DOUBLE_TAG	BIT(15)+#define AR7240_PORT_CTRL_MIRROR_TX	BIT(16)+#define AR7240_PORT_CTRL_MIRROR_RX	BIT(17)++#define AR7240_REG_PORT_VLAN(_port)	(AR7240_REG_PORT_BASE((_port)) + 0x08)++#define AR7240_PORT_VLAN_DEFAULT_ID_S	0+#define AR7240_PORT_VLAN_DEST_PORTS_S	16++#define AR7240_REG_STATS_BASE(_port)	(0x20000 + (_port) * 0x100)++#define AR7240_STATS_RXBROAD		0x00+#define AR7240_STATS_RXPAUSE		0x04+#define AR7240_STATS_RXMULTI		0x08+#define AR7240_STATS_RXFCSERR		0x0c+#define AR7240_STATS_RXALIGNERR		0x10+#define AR7240_STATS_RXRUNT		0x14+#define AR7240_STATS_RXFRAGMENT		0x18+#define AR7240_STATS_RX64BYTE		0x1c+#define AR7240_STATS_RX128BYTE		0x20+#define AR7240_STATS_RX256BYTE		0x24+#define AR7240_STATS_RX512BYTE		0x28+#define AR7240_STATS_RX1024BYTE		0x2c+#define AR7240_STATS_RX1518BYTE		0x30+#define AR7240_STATS_RXMAXBYTE		0x34+#define AR7240_STATS_RXTOOLONG		0x38+#define AR7240_STATS_RXGOODBYTE		0x3c+#define AR7240_STATS_RXBADBYTE		0x44+#define AR7240_STATS_RXOVERFLOW		0x4c+#define AR7240_STATS_FILTERED		0x50+#define AR7240_STATS_TXBROAD		0x54+#define AR7240_STATS_TXPAUSE		0x58+#define AR7240_STATS_TXMULTI		0x5c+#define AR7240_STATS_TXUNDERRUN		0x60+#define AR7240_STATS_TX64BYTE		0x64+#define AR7240_STATS_TX128BYTE		0x68+#define AR7240_STATS_TX256BYTE		0x6c+#define AR7240_STATS_TX512BYTE		0x70+#define AR7240_STATS_TX1024BYTE		0x74+#define AR7240_STATS_TX1518BYTE		0x78+#define AR7240_STATS_TXMAXBYTE		0x7c+#define AR7240_STATS_TXOVERSIZE		0x80+#define AR7240_STATS_TXBYTE		0x84+#define AR7240_STATS_TXCOLLISION	0x8c+#define AR7240_STATS_TXABORTCOL		0x90+#define AR7240_STATS_TXMULTICOL		0x94+#define AR7240_STATS_TXSINGLECOL	0x98+#define AR7240_STATS_TXEXCDEFER		0x9c+#define AR7240_STATS_TXDEFER		0xa0+#define AR7240_STATS_TXLATECOL		0xa4++#define AR7240_PORT_CPU		0+#define AR7240_NUM_PORTS	6+#define AR7240_NUM_PHYS		5++#define AR7240_PHY_ID1		0x004d+#define AR7240_PHY_ID2		0xd041++#define AR7240_PORT_MASK(_port)		BIT((_port))+#define AR7240_PORT_MASK_ALL		BITM(AR7240_NUM_PORTS)+#define AR7240_PORT_MASK_BUT(_port)	(AR7240_PORT_MASK_ALL & ~BIT((_port)))++struct ar7240sw {+	struct mii_bus	*mii_bus;+	struct mutex	reg_mutex;+	struct mutex	stats_mutex;+};++struct ar7240sw_hw_stat {+	char string[ETH_GSTRING_LEN];+	int sizeof_stat;+	int reg;+};++static inline struct ar7240sw *dsa_to_ar7240sw(struct dsa_switch *ds)+{+	return (struct ar7240sw *)(ds + 1);+}++static inline void ar7240sw_init(struct ar7240sw *as, struct mii_bus *mii)+{+	as->mii_bus = mii;+	mutex_init(&as->reg_mutex);+	mutex_init(&as->stats_mutex);+}++static inline u16 mk_phy_addr(u32 reg)+{+	return (0x17 & ((reg >> 4) | 0x10));+}++static inline u16 mk_phy_reg(u32 reg)+{+	return ((reg << 1) & 0x1e);+}++static inline u16 mk_high_addr(u32 reg)+{+	return ((reg >> 7) & 0x1ff);+}++static u32 __ar7240sw_reg_read(struct ar7240sw *as, u32 reg)+{+	struct mii_bus *mii = as->mii_bus;+	u16 phy_addr;+	u16 phy_reg;+	u32 hi, lo;++	reg = (reg & 0xfffffffc) >> 2;++	mdiobus_write(mii, 0x1f, 0x10, mk_high_addr(reg));++	phy_addr = mk_phy_addr(reg);+	phy_reg = mk_phy_reg(reg);++	lo = (u32) mdiobus_read(mii, phy_addr, phy_reg);+	hi = (u32) mdiobus_read(mii, phy_addr, phy_reg + 1);++	return ((hi << 16) | lo);+}++static void __ar7240sw_reg_write(struct ar7240sw *as, u32 reg, u32 val)+{+	struct mii_bus *mii = as->mii_bus;+	u16 phy_addr;+	u16 phy_reg;++	reg = (reg & 0xfffffffc) >> 2;++	mdiobus_write(mii, 0x1f, 0x10, mk_high_addr(reg));++	phy_addr = mk_phy_addr(reg);+	phy_reg = mk_phy_reg(reg);++	mdiobus_write(mii, phy_addr, phy_reg + 1, (val >> 16));+	mdiobus_write(mii, phy_addr, phy_reg, (val & 0xffff));+}++static u32 ar7240sw_reg_read(struct ar7240sw *as, u32 reg_addr)+{+	u32 ret;++	mutex_lock(&as->reg_mutex);+	ret = __ar7240sw_reg_read(as, reg_addr);+	mutex_unlock(&as->reg_mutex);++	return ret;+}++static void ar7240sw_reg_write(struct ar7240sw *as, u32 reg_addr, u32 reg_val)+{+	mutex_lock(&as->reg_mutex);+	__ar7240sw_reg_write(as, reg_addr, reg_val);+	mutex_unlock(&as->reg_mutex);+}++static u32 ar7240sw_reg_rmw(struct ar7240sw *as, u32 reg, u32 mask, u32 val)+{+	u32 t;++	mutex_lock(&as->reg_mutex);+	t = __ar7240sw_reg_read(as, reg);+	t &= ~mask;+	t |= val;+	__ar7240sw_reg_write(as, reg, t);+	mutex_unlock(&as->reg_mutex);++	return t;+}++static void ar7240sw_reg_set(struct ar7240sw *as, u32 reg, u32 val)+{+	u32 t;++	mutex_lock(&as->reg_mutex);+	t = __ar7240sw_reg_read(as, reg);+	t |= val;+	__ar7240sw_reg_write(as, reg, t);+	mutex_unlock(&as->reg_mutex);+}++static int ar7240sw_reg_wait(struct ar7240sw *as, u32 reg, u32 mask, u32 val,+			     unsigned timeout)+{+	int i;++	for (i = 0; i < timeout; i++) {+		u32 t;++		t = ar7240sw_reg_read(as, reg);+		if ((t & mask) == val)+			return 0;++		msleep(1);+	}++	return -ETIMEDOUT;+}++static u16 ar7240sw_phy_read(struct ar7240sw *as, unsigned phy_addr,+			     unsigned reg_addr)+{+	u32 t;+	int err;++	if (phy_addr >= AR7240_NUM_PHYS)+		return 0xffff;++	t = (reg_addr << AR7240_MDIO_CTRL_REG_ADDR_S) |+	    (phy_addr << AR7240_MDIO_CTRL_PHY_ADDR_S) |+	    AR7240_MDIO_CTRL_MASTER_EN |+	    AR7240_MDIO_CTRL_BUSY |+	    AR7240_MDIO_CTRL_CMD_READ;++	ar7240sw_reg_write(as, AR7240_REG_MDIO_CTRL, t);+	err = ar7240sw_reg_wait(as, AR7240_REG_MDIO_CTRL,+				AR7240_MDIO_CTRL_BUSY, 0, 5);+	if (err)+		return 0xffff;++	t = ar7240sw_reg_read(as, AR7240_REG_MDIO_CTRL);+	return (t & AR7240_MDIO_CTRL_DATA_M);+}++static int ar7240sw_phy_write(struct ar7240sw *as, unsigned phy_addr,+			      unsigned reg_addr, u16 reg_val)+{+	u32 t;+	int ret;++	if (phy_addr >= AR7240_NUM_PHYS)+		return -EINVAL;++	t = (phy_addr << AR7240_MDIO_CTRL_PHY_ADDR_S) |+	    (reg_addr << AR7240_MDIO_CTRL_REG_ADDR_S) |+	    AR7240_MDIO_CTRL_MASTER_EN |+	    AR7240_MDIO_CTRL_BUSY |+	    AR7240_MDIO_CTRL_CMD_WRITE |+	    reg_val;++	ar7240sw_reg_write(as, AR7240_REG_MDIO_CTRL, t);+	ret = ar7240sw_reg_wait(as, AR7240_REG_MDIO_CTRL,+				AR7240_MDIO_CTRL_BUSY, 0, 5);+	return ret;+}++static int ar7240sw_capture_stats(struct ar7240sw *as)+{+	int ret;++	/* Capture the hardware statistics for all ports */+	ar7240sw_reg_write(as, AR7240_REG_MIB_FUNCTION0,+			   (AR7240_MIB_FUNC_CAPTURE << AR7240_MIB_FUNC_S));++	/* Wait for the capturing to complete. */+	ret = ar7240sw_reg_wait(as, AR7240_REG_MIB_FUNCTION0,+				AR7240_MIB_BUSY, 0, 10);+	return ret;+}++static void ar7240sw_disable_port(struct ar7240sw *as, unsigned port)+{+	ar7240sw_reg_write(as, AR7240_REG_PORT_CTRL(port),+			   AR7240_PORT_CTRL_STATE_DISABLED);+}++static int ar7240sw_reset(struct ar7240sw *as)+{+	int ret;+	int i;++	/* Set all ports to disabled state. */+	for (i = 0; i < AR7240_NUM_PORTS; i++)+		ar7240sw_disable_port(as, i);++	/* Wait for transmit queues to drain. */+	msleep(2);++	/* Reset the switch. */+	ar7240sw_reg_write(as, AR7240_REG_MASK_CTRL,+			   AR7240_MASK_CTRL_SOFT_RESET);++	ret = ar7240sw_reg_wait(as, AR7240_REG_MASK_CTRL,+			        AR7240_MASK_CTRL_SOFT_RESET, 0, 1000);+	return ret;+}++static void ar7240sw_setup(struct ar7240sw *as)+{+	/* Enable CPU port, and disable mirror port */+	ar7240sw_reg_write(as, AR7240_REG_CPU_PORT,+			   AR7240_CPU_PORT_EN |+			   (15 << AR7240_MIRROR_PORT_S));++	/* Setup TAG priority mapping */+	ar7240sw_reg_write(as, AR7240_REG_TAG_PRIORITY, 0xfa50);++	/* Enable ARP frame acknowledge */+	ar7240sw_reg_set(as, AR7240_REG_AT_CTRL, AR7240_AT_CTRL_ARP_EN);++	/* Enable Broadcast frames transmitted to the CPU */+	ar7240sw_reg_set(as, AR7240_REG_FLOOD_MASK,+			 AR7240_FLOOD_MASK_BROAD_TO_CPU);++	/* setup MTU */+	ar7240sw_reg_rmw(as, AR7240_REG_GLOBAL_CTRL, AR7240_GLOBAL_CTRL_MTU_M,+			 1536);++	/* setup Service TAG */+	ar7240sw_reg_rmw(as, AR7240_REG_SERVICE_TAG, AR7240_SERVICE_TAG_M,+			 ETH_P_QINQ);+}++static void ar7240sw_setup_port(struct ar7240sw *as, unsigned port)+{+	u32 ctrl;+	u32 dest_ports;+	u32 vlan;++	ctrl = AR7240_PORT_CTRL_STATE_FORWARD;++	if (port == AR7240_PORT_CPU) {+		ar7240sw_reg_write(as, AR7240_REG_PORT_STATUS(port),+				   AR7240_PORT_STATUS_SPEED_1000 |+				   AR7240_PORT_STATUS_TXFLOW |+				   AR7240_PORT_STATUS_RXFLOW |+				   AR7240_PORT_STATUS_TXMAC |+				   AR7240_PORT_STATUS_RXMAC |+				   AR7240_PORT_STATUS_DUPLEX);++		/* allow the CPU port to talk to each of the 'real' ports */+		dest_ports = AR7240_PORT_MASK_BUT(port);++		/* remove service tag from ingress frames */+		ctrl |= AR7240_PORT_CTRL_DOUBLE_TAG;+	} else {+		ar7240sw_reg_write(as, AR7240_REG_PORT_STATUS(port),+				   AR7240_PORT_STATUS_LINK_AUTO);++		/*+		 * allow each of the 'real' ports to only talk to the CPU+		 * port.+		 */+		dest_ports = AR7240_PORT_MASK(port) |+			     AR7240_PORT_MASK(AR7240_PORT_CPU);++		/* add service tag to egress frames */+		ctrl |= (AR7240_PORT_CTRL_VLAN_MODE_DOUBLE_TAG <<+			 AR7240_PORT_CTRL_VLAN_MODE_S);+	}++	/* set default VID and and destination ports for this VLAN */+	vlan = port;+	vlan |= (dest_ports << AR7240_PORT_VLAN_DEST_PORTS_S);++	ar7240sw_reg_write(as, AR7240_REG_PORT_CTRL(port), ctrl);+	ar7240sw_reg_write(as, AR7240_REG_PORT_VLAN(port), vlan);+}++static char *ar7240_dsa_probe(struct mii_bus *mii, int sw_addr)+{+	struct ar7240sw as;+	u32 ctrl;+	u16 phy_id1;+	u16 phy_id2;+	u8 ver;++	ar7240sw_init(&as, mii);++	ctrl = ar7240sw_reg_read(&as, AR7240_REG_MASK_CTRL);++	ver = (ctrl >> AR7240_MASK_CTRL_VERSION_S) & AR7240_MASK_CTRL_VERSION_M;+	if (ver != 1) {+		pr_err("ar7240_dsa: unsupported chip, ctrl=%08x\n", ctrl);+		return NULL;+	}++	phy_id1 = ar7240sw_phy_read(&as, 0, MII_PHYSID1);+	phy_id2 = ar7240sw_phy_read(&as, 0, MII_PHYSID2);+	if (phy_id1 != AR7240_PHY_ID1 || phy_id2 != AR7240_PHY_ID2) {+		pr_err("ar7240_dsa: unknown phy id '%04x:%04x'\n",+		       phy_id1, phy_id2);+		return NULL;+	}++	return "Atheros AR7240 built-in";+}++static int ar7240_dsa_setup(struct dsa_switch *ds)+{+	struct ar7240sw *as = dsa_to_ar7240sw(ds);+	int i;+	int ret;++	ar7240sw_init(as, ds->master_mii_bus);++	ret = ar7240sw_reset(as);+	if (ret)+		return ret;++	ar7240sw_setup(as);++	for (i = 0; i < AR7240_NUM_PORTS; i++) {+		if (dsa_is_cpu_port(ds, i) || (ds->phys_port_mask & (1 << i)))+			ar7240sw_setup_port(as, i);+		else+			ar7240sw_disable_port(as, i);+	}++	return 0;+}++static int ar7240_dsa_set_addr(struct dsa_switch *ds, u8 *addr)+{+	struct ar7240sw *as = dsa_to_ar7240sw(ds);+	u32 t;++	t = (addr[4] << 8) | addr[5];+	ar7240sw_reg_write(as, AR7240_REG_MAC_ADDR0, t);++	t = (addr[0] << 24) | (addr[1] << 16) | (addr[2] << 8) | addr[3];+	ar7240sw_reg_write(as, AR7240_REG_MAC_ADDR1, t);++	return 0;+}++static int ar7240_iort_to_phy_addr(int port)+{+	if (port > 0 && port < AR7240_NUM_PORTS)+		return port - 1;++	return -EINVAL;+}++static int ar7240_dsa_phy_read(struct dsa_switch *ds, int port, int regnum)+{+	struct ar7240sw *as = dsa_to_ar7240sw(ds);+	int phy_addr;++	phy_addr = ar7240_iort_to_phy_addr(port);+	if (phy_addr < 0)+		return 0xffff;++	return ar7240sw_phy_read(as, phy_addr, regnum);+}++static int ar7240_dsa_phy_write(struct dsa_switch *ds, int port, int regnum,+				u16 val)+{+	struct ar7240sw *as = dsa_to_ar7240sw(ds);+	int phy_addr;++	phy_addr = ar7240_iort_to_phy_addr(port);+	if (phy_addr < 0)+		return 0xffff;++	return ar7240sw_phy_write(as, phy_addr, regnum, val);+}++static const char *ar7240sw_speed_str(unsigned speed)+{+	switch (speed) {+	case AR7240_PORT_STATUS_SPEED_10:+		return "10";+	case AR7240_PORT_STATUS_SPEED_100:+		return "100";+	case AR7240_PORT_STATUS_SPEED_1000:+		return "1000";+	}++	return "????";+}++static void ar7240_dsa_poll_link(struct dsa_switch *ds)+{+	struct ar7240sw *as = dsa_to_ar7240sw(ds);+	int i;++	for (i = 0; i < DSA_MAX_PORTS; i++) {+		struct net_device *dev;+		u32 status;+		int link;+		unsigned speed;+		int duplex;++		dev = ds->ports[i];+		if (dev == NULL)+			continue;++		link = 0;+		if (dev->flags & IFF_UP) {+			status = ar7240sw_reg_read(as,+						   AR7240_REG_PORT_STATUS(i));+			link = !!(status & AR7240_PORT_STATUS_LINK_UP);+		}++		if (!link) {+			if (netif_carrier_ok(dev)) {+				pr_info("%s: link down\n", dev->name);+				netif_carrier_off(dev);+			}+			continue;+		}++		speed = (status & AR7240_PORT_STATUS_SPEED_M);+		duplex = (status & AR7240_PORT_STATUS_DUPLEX) ? 1 : 0;+		if (!netif_carrier_ok(dev)) {+			pr_info("%s: link up, %sMb/s, %s duplex",+				dev->name,+				ar7240sw_speed_str(speed),+				duplex ? "full" : "half");+			netif_carrier_on(dev);+		}+	}+}++static const struct ar7240sw_hw_stat ar7240_hw_stats[] = {+	{ "rx_broadcast"	, 4, AR7240_STATS_RXBROAD, },+	{ "rx_pause"		, 4, AR7240_STATS_RXPAUSE, },+	{ "rx_multicast"	, 4, AR7240_STATS_RXMULTI, },+	{ "rx_fcs_error"	, 4, AR7240_STATS_RXFCSERR, },+	{ "rx_align_error"	, 4, AR7240_STATS_RXALIGNERR, },+	{ "rx_undersize"	, 4, AR7240_STATS_RXRUNT, },+	{ "rx_fragments"	, 4, AR7240_STATS_RXFRAGMENT, },+	{ "rx_64bytes"		, 4, AR7240_STATS_RX64BYTE, },+	{ "rx_65_127bytes"	, 4, AR7240_STATS_RX128BYTE, },+	{ "rx_128_255bytes"	, 4, AR7240_STATS_RX256BYTE, },+	{ "rx_256_511bytes"	, 4, AR7240_STATS_RX512BYTE, },+	{ "rx_512_1023bytes"	, 4, AR7240_STATS_RX1024BYTE, },+	{ "rx_1024_1518bytes"	, 4, AR7240_STATS_RX1518BYTE, },+	{ "rx_1519_max_bytes"	, 4, AR7240_STATS_RXMAXBYTE, },+	{ "rx_oversize"		, 4, AR7240_STATS_RXTOOLONG, },+	{ "rx_good_bytes"	, 8, AR7240_STATS_RXGOODBYTE, },+	{ "rx_bad_bytes"	, 8, AR7240_STATS_RXBADBYTE, },+	{ "rx_overflow"		, 4, AR7240_STATS_RXOVERFLOW, },+	{ "filtered"		, 4, AR7240_STATS_FILTERED, },+	{ "tx_broadcast"	, 4, AR7240_STATS_TXBROAD, },+	{ "tx_pause"		, 4, AR7240_STATS_TXPAUSE, },+	{ "tx_multicast"	, 4, AR7240_STATS_TXMULTI, },+	{ "tx_underrun"		, 4, AR7240_STATS_TXUNDERRUN, },+	{ "tx_64bytes"		, 4, AR7240_STATS_TX64BYTE, },+	{ "tx_65_127bytes"	, 4, AR7240_STATS_TX128BYTE, },+	{ "tx_128_255bytes"	, 4, AR7240_STATS_TX256BYTE, },+	{ "tx_256_511bytes"	, 4, AR7240_STATS_TX512BYTE, },+	{ "tx_512_1023bytes"	, 4, AR7240_STATS_TX1024BYTE, },+	{ "tx_1024_1518bytes"	, 4, AR7240_STATS_TX1518BYTE, },+	{ "tx_1519_max_bytes"	, 4, AR7240_STATS_TXMAXBYTE, },+	{ "tx_oversize"		, 4, AR7240_STATS_TXOVERSIZE, },+	{ "tx_bytes"		, 8, AR7240_STATS_TXBYTE, },+	{ "tx_collisions"	, 4, AR7240_STATS_TXCOLLISION, },+	{ "tx_abort_collisions"	, 4, AR7240_STATS_TXABORTCOL, },+	{ "tx_multi_collisions"	, 4, AR7240_STATS_TXMULTICOL, },+	{ "tx_single_collisions", 4, AR7240_STATS_TXSINGLECOL, },+	{ "tx_excessive_deferred", 4, AR7240_STATS_TXEXCDEFER, },+	{ "tx_deferred"		, 4, AR7240_STATS_TXDEFER, },+	{ "tx_late_collisions"	, 4, AR7240_STATS_TXLATECOL, },+};++static void ar7240_dsa_get_strings(struct dsa_switch *ds, int port,+				   uint8_t *data)+{+	int i;++	for (i = 0; i < ARRAY_SIZE(ar7240_hw_stats); i++) {+		memcpy(data + i * ETH_GSTRING_LEN,+		       ar7240_hw_stats[i].string, ETH_GSTRING_LEN);+	}+}++static void ar7240_dsa_get_ethtool_stats(struct dsa_switch *ds, int port,+					 uint64_t *data)+{+	struct ar7240sw *as = dsa_to_ar7240sw(ds);+	int err;+	int i;++	mutex_lock(&as->stats_mutex);++	err = ar7240sw_capture_stats(as);+	if (err)+		goto unlock;++	for (i = 0; i < ARRAY_SIZE(ar7240_hw_stats); i++) {+		const struct ar7240sw_hw_stat *s = &ar7240_hw_stats[i];+		u32 reg = AR7240_REG_STATS_BASE(port);+		u32 low;+		u32 high;++		low = ar7240sw_reg_read(as, reg + s->reg);+		if (s->sizeof_stat == 8)+			high = ar7240sw_reg_read(as, reg + s->reg);+		else+			high = 0;++		data[i] = (((u64) high) << 32) | low;+	}++ unlock:+	mutex_unlock(&as->stats_mutex);+}++static int ar7240_dsa_get_sset_count(struct dsa_switch *ds)+{+	return ARRAY_SIZE(ar7240_hw_stats);+}++static struct dsa_switch_driver ar7240_dsa_driver = {+	.tag_protocol		= htons(ETH_P_QINQ),+	.priv_size		= sizeof(struct ar7240sw),+	.probe			= ar7240_dsa_probe,+	.setup			= ar7240_dsa_setup,+	.set_addr		= ar7240_dsa_set_addr,+	.phy_read		= ar7240_dsa_phy_read,+	.phy_write		= ar7240_dsa_phy_write,+	.poll_link		= ar7240_dsa_poll_link,+	.get_strings		= ar7240_dsa_get_strings,+	.get_ethtool_stats	= ar7240_dsa_get_ethtool_stats,+	.get_sset_count		= ar7240_dsa_get_sset_count,+};++int __init dsa_ar7240_init(void)+{+	register_switch_driver(&ar7240_dsa_driver);+	return 0;+}+module_init(dsa_ar7240_init);++void __exit dsa_ar7240_cleanup(void)+{+	unregister_switch_driver(&ar7240_dsa_driver);+}+module_exit(dsa_ar7240_cleanup);diff -Nur linux-2.6.37.orig/net/dsa/mv88e6063.c linux-2.6.37/net/dsa/mv88e6063.c--- linux-2.6.37.orig/net/dsa/mv88e6063.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/net/dsa/mv88e6063.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,294 @@+/*+ * net/dsa/mv88e6063.c - Driver for Marvell 88e6063 switch chips+ * Copyright (c) 2009 Gabor Juhos <juhosg@openwrt.org>+ *+ * This driver was base on: net/dsa/mv88e6060.c+ *   net/dsa/mv88e6063.c - Driver for Marvell 88e6060 switch chips+ *   Copyright (c) 2008-2009 Marvell Semiconductor+ *+ * This program is free software; you can redistribute it and/or modify+ * it under the terms of the GNU General Public License as published by+ * the Free Software Foundation; either version 2 of the License, or+ * (at your option) any later version.+ */++#include <linux/list.h>+#include <linux/netdevice.h>+#include <linux/phy.h>+#include "dsa_priv.h"++#define REG_BASE		0x10+#define REG_PHY(p)		(REG_BASE + (p))+#define REG_PORT(p)		(REG_BASE + 8 + (p))+#define REG_GLOBAL		(REG_BASE + 0x0f)+#define NUM_PORTS		7++static int reg_read(struct dsa_switch *ds, int addr, int reg)+{+	return mdiobus_read(ds->master_mii_bus, addr, reg);+}++#define REG_READ(addr, reg)					\+	({							\+		int __ret;					\+								\+		__ret = reg_read(ds, addr, reg);		\+		if (__ret < 0)					\+			return __ret;				\+		__ret;						\+	})+++static int reg_write(struct dsa_switch *ds, int addr, int reg, u16 val)+{+	return mdiobus_write(ds->master_mii_bus, addr, reg, val);+}++#define REG_WRITE(addr, reg, val)				\+	({							\+		int __ret;					\+								\+		__ret = reg_write(ds, addr, reg, val);		\+		if (__ret < 0)					\+			return __ret;				\+	})++static char *mv88e6063_probe(struct mii_bus *bus, int sw_addr)+{+	int ret;++	ret = mdiobus_read(bus, REG_PORT(0), 0x03);+	if (ret >= 0) {+		ret &= 0xfff0;+		if (ret == 0x1530)+			return "Marvell 88E6063";+	}++	return NULL;+}++static int mv88e6063_switch_reset(struct dsa_switch *ds)+{+	int i;+	int ret;++	/*+	 * Set all ports to the disabled state.+	 */+	for (i = 0; i < NUM_PORTS; i++) {+		ret = REG_READ(REG_PORT(i), 0x04);+		REG_WRITE(REG_PORT(i), 0x04, ret & 0xfffc);+	}++	/*+	 * Wait for transmit queues to drain.+	 */+	msleep(2);++	/*+	 * Reset the switch.+	 */+	REG_WRITE(REG_GLOBAL, 0x0a, 0xa130);++	/*+	 * Wait up to one second for reset to complete.+	 */+	for (i = 0; i < 1000; i++) {+		ret = REG_READ(REG_GLOBAL, 0x00);+		if ((ret & 0x8000) == 0x0000)+			break;++		msleep(1);+	}+	if (i == 1000)+		return -ETIMEDOUT;++	return 0;+}++static int mv88e6063_setup_global(struct dsa_switch *ds)+{+	/*+	 * Disable discarding of frames with excessive collisions,+	 * set the maximum frame size to 1536 bytes, and mask all+	 * interrupt sources.+	 */+	REG_WRITE(REG_GLOBAL, 0x04, 0x0800);++	/*+	 * Enable automatic address learning, set the address+	 * database size to 1024 entries, and set the default aging+	 * time to 5 minutes.+	 */+	REG_WRITE(REG_GLOBAL, 0x0a, 0x2130);++	return 0;+}++static int mv88e6063_setup_port(struct dsa_switch *ds, int p)+{+	int addr = REG_PORT(p);++	/*+	 * Do not force flow control, disable Ingress and Egress+	 * Header tagging, disable VLAN tunneling, and set the port+	 * state to Forwarding.  Additionally, if this is the CPU+	 * port, enable Ingress and Egress Trailer tagging mode.+	 */+	REG_WRITE(addr, 0x04, dsa_is_cpu_port(ds, p) ?  0x4103 : 0x0003);++	/*+	 * Port based VLAN map: give each port its own address+	 * database, allow the CPU port to talk to each of the 'real'+	 * ports, and allow each of the 'real' ports to only talk to+	 * the CPU port.+	 */+	REG_WRITE(addr, 0x06,+			((p & 0xf) << 12) |+			 (dsa_is_cpu_port(ds, p) ?+				ds->phys_port_mask :+				(1 << ds->dst->cpu_port)));++	/*+	 * Port Association Vector: when learning source addresses+	 * of packets, add the address to the address database using+	 * a port bitmap that has only the bit for this port set and+	 * the other bits clear.+	 */+	REG_WRITE(addr, 0x0b, 1 << p);++	return 0;+}++static int mv88e6063_setup(struct dsa_switch *ds)+{+	int i;+	int ret;++	ret = mv88e6063_switch_reset(ds);+	if (ret < 0)+		return ret;++	/* @@@ initialise atu */++	ret = mv88e6063_setup_global(ds);+	if (ret < 0)+		return ret;++	for (i = 0; i < NUM_PORTS; i++) {+		ret = mv88e6063_setup_port(ds, i);+		if (ret < 0)+			return ret;+	}++	return 0;+}++static int mv88e6063_set_addr(struct dsa_switch *ds, u8 *addr)+{+	REG_WRITE(REG_GLOBAL, 0x01, (addr[0] << 8) | addr[1]);+	REG_WRITE(REG_GLOBAL, 0x02, (addr[2] << 8) | addr[3]);+	REG_WRITE(REG_GLOBAL, 0x03, (addr[4] << 8) | addr[5]);++	return 0;+}++static int mv88e6063_port_to_phy_addr(int port)+{+	if (port >= 0 && port <= NUM_PORTS)+		return REG_PHY(port);+	return -1;+}++static int mv88e6063_phy_read(struct dsa_switch *ds, int port, int regnum)+{+	int addr;++	addr = mv88e6063_port_to_phy_addr(port);+	if (addr == -1)+		return 0xffff;++	return reg_read(ds, addr, regnum);+}++static int+mv88e6063_phy_write(struct dsa_switch *ds, int port, int regnum, u16 val)+{+	int addr;++	addr = mv88e6063_port_to_phy_addr(port);+	if (addr == -1)+		return 0xffff;++	return reg_write(ds, addr, regnum, val);+}++static void mv88e6063_poll_link(struct dsa_switch *ds)+{+	int i;++	for (i = 0; i < DSA_MAX_PORTS; i++) {+		struct net_device *dev;+		int uninitialized_var(port_status);+		int link;+		int speed;+		int duplex;+		int fc;++		dev = ds->ports[i];+		if (dev == NULL)+			continue;++		link = 0;+		if (dev->flags & IFF_UP) {+			port_status = reg_read(ds, REG_PORT(i), 0x00);+			if (port_status < 0)+				continue;++			link = !!(port_status & 0x1000);+		}++		if (!link) {+			if (netif_carrier_ok(dev)) {+				printk(KERN_INFO "%s: link down\n", dev->name);+				netif_carrier_off(dev);+			}+			continue;+		}++		speed = (port_status & 0x0100) ? 100 : 10;+		duplex = (port_status & 0x0200) ? 1 : 0;+		fc = ((port_status & 0xc000) == 0xc000) ? 1 : 0;++		if (!netif_carrier_ok(dev)) {+			printk(KERN_INFO "%s: link up, %d Mb/s, %s duplex, "+					 "flow control %sabled\n", dev->name,+					 speed, duplex ? "full" : "half",+					 fc ? "en" : "dis");+			netif_carrier_on(dev);+		}+	}+}++static struct dsa_switch_driver mv88e6063_switch_driver = {+	.tag_protocol	= htons(ETH_P_TRAILER),+	.probe		= mv88e6063_probe,+	.setup		= mv88e6063_setup,+	.set_addr	= mv88e6063_set_addr,+	.phy_read	= mv88e6063_phy_read,+	.phy_write	= mv88e6063_phy_write,+	.poll_link	= mv88e6063_poll_link,+};++static int __init mv88e6063_init(void)+{+	register_switch_driver(&mv88e6063_switch_driver);+	return 0;+}+module_init(mv88e6063_init);++static void __exit mv88e6063_cleanup(void)+{+	unregister_switch_driver(&mv88e6063_switch_driver);+}+module_exit(mv88e6063_cleanup);diff -Nur linux-2.6.37.orig/net/dsa/tag_qinq.c linux-2.6.37/net/dsa/tag_qinq.c--- linux-2.6.37.orig/net/dsa/tag_qinq.c	1970-01-01 01:00:00.000000000 +0100+++ linux-2.6.37/net/dsa/tag_qinq.c	2011-01-11 20:25:48.000000000 +0100@@ -0,0 +1,127 @@+/*+ * net/dsa/tag_qinq.c - QinQ tag format handling+ * Copyright (c) 2010 Gabor Juhos <juhosg@openwrt.org>+ *+ *  This file was based on:+ *    net/dsa/tag_edsa.c - Ethertype DSA tagging+ *    Copyright (c) 2008-2009 Marvell Semiconductor+ *+ * This program is free software; you can redistribute it and/or modify+ * it under the terms of the GNU General Public License as published by+ * the Free Software Foundation; either version 2 of the License, or+ * (at your option) any later version.+ */++#include <linux/etherdevice.h>+#include <linux/list.h>+#include <linux/netdevice.h>+#include <linux/if_vlan.h>++#include "dsa_priv.h"++netdev_tx_t qinq_xmit(struct sk_buff *skb, struct net_device *dev)+{+	struct dsa_slave_priv *p = netdev_priv(dev);+	struct vlan_ethhdr *veth;+	unsigned int len;+	int ret;++	if (skb_cow_head(skb, VLAN_HLEN) < 0)+		goto out_free_skb;++	veth = (struct vlan_ethhdr *)skb_push(skb, VLAN_HLEN);++	/* Move the mac addresses to the beginning of the new header. */+	memmove(skb->data, skb->data + VLAN_HLEN, 2 * VLAN_ETH_ALEN);+	skb->mac_header -= VLAN_HLEN;++	/* setup VLAN header fields */+	veth->h_vlan_proto = htons(ETH_P_QINQ);+	veth->h_vlan_TCI = htons(p->port);++	len = skb->len;+	skb->protocol = htons(ETH_P_QINQ);+	skb->dev = p->parent->dst->master_netdev;++	ret = dev_queue_xmit(skb);+	if (unlikely(ret != NET_XMIT_SUCCESS))+		goto out_dropped;++	dev->stats.tx_packets++;+	dev->stats.tx_bytes += len;++	return NETDEV_TX_OK;++ out_free_skb:+	kfree_skb(skb);+ out_dropped:+	dev->stats.tx_dropped++;+	return NETDEV_TX_OK;+}++static int qinq_rcv(struct sk_buff *skb, struct net_device *dev,+		    struct packet_type *pt, struct net_device *orig_dev)+{+	struct dsa_switch_tree *dst;+	struct dsa_switch *ds;+	struct vlan_hdr *vhdr;+	int source_port;++	dst = dev->dsa_ptr;+	if (unlikely(dst == NULL))+		goto out_drop;+	ds = dst->ds[0];++	skb = skb_unshare(skb, GFP_ATOMIC);+	if (skb == NULL)+		goto out;++	if (unlikely(!pskb_may_pull(skb, VLAN_HLEN)))+		goto out_drop;++	vhdr = (struct vlan_hdr *)skb->data;+	source_port = ntohs(vhdr->h_vlan_TCI) & VLAN_VID_MASK;+	if (source_port >= DSA_MAX_PORTS || ds->ports[source_port] == NULL)+		goto out_drop;++	/* Remove the outermost VLAN tag and update checksum. */+	skb_pull_rcsum(skb, VLAN_HLEN);+	memmove(skb->data - ETH_HLEN,+		skb->data - ETH_HLEN - VLAN_HLEN,+		2 * ETH_ALEN);++	skb->dev = ds->ports[source_port];+	skb_push(skb, ETH_HLEN);+	skb->pkt_type = PACKET_HOST;+	skb->protocol = eth_type_trans(skb, skb->dev);++	skb->dev->stats.rx_packets++;+	skb->dev->stats.rx_bytes += skb->len;++	netif_receive_skb(skb);++	return 0;++ out_drop:+	kfree_skb(skb);+ out:+	return 0;+}++static struct packet_type qinq_packet_type __read_mostly = {+	.type	= cpu_to_be16(ETH_P_QINQ),+	.func	= qinq_rcv,+};++static int __init qinq_init_module(void)+{+	dev_add_pack(&qinq_packet_type);+	return 0;+}+module_init(qinq_init_module);++static void __exit qinq_cleanup_module(void)+{+	dev_remove_pack(&qinq_packet_type);+}+module_exit(qinq_cleanup_module);
 |