amazon_mei.c 257 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862386338643865386638673868386938703871387238733874387538763877387838793880388138823883388438853886388738883889389038913892389338943895389638973898389939003901390239033904390539063907390839093910391139123913391439153916391739183919392039213922392339243925392639273928392939303931393239333934393539363937393839393940394139423943394439453946394739483949395039513952395339543955395639573958395939603961396239633964396539663967396839693970397139723973397439753976397739783979398039813982398339843985398639873988398939903991399239933994399539963997399839994000400140024003400440054006400740084009401040114012401340144015401640174018401940204021402240234024402540264027402840294030403140324033403440354036403740384039404040414042404340444045404640474048404940504051405240534054405540564057405840594060406140624063406440654066406740684069407040714072407340744075407640774078407940804081408240834084408540864087408840894090409140924093409440954096409740984099410041014102410341044105410641074108410941104111411241134114411541164117411841194120412141224123412441254126412741284129413041314132413341344135413641374138413941404141414241434144414541464147414841494150415141524153415441554156415741584159416041614162416341644165416641674168416941704171417241734174417541764177417841794180418141824183418441854186418741884189419041914192419341944195419641974198419942004201420242034204420542064207420842094210421142124213421442154216421742184219422042214222422342244225422642274228422942304231423242334234423542364237423842394240424142424243424442454246424742484249425042514252425342544255425642574258425942604261426242634264426542664267426842694270427142724273427442754276427742784279428042814282428342844285428642874288428942904291429242934294429542964297429842994300430143024303430443054306430743084309431043114312431343144315431643174318431943204321432243234324432543264327432843294330433143324333433443354336433743384339434043414342434343444345434643474348434943504351435243534354435543564357435843594360436143624363436443654366436743684369437043714372437343744375437643774378437943804381438243834384438543864387438843894390439143924393439443954396439743984399440044014402440344044405440644074408440944104411441244134414441544164417441844194420442144224423442444254426442744284429443044314432443344344435443644374438443944404441444244434444444544464447444844494450445144524453445444554456445744584459446044614462446344644465446644674468446944704471447244734474447544764477447844794480448144824483448444854486448744884489449044914492449344944495449644974498449945004501450245034504450545064507450845094510451145124513451445154516451745184519452045214522452345244525452645274528452945304531453245334534453545364537453845394540454145424543454445454546454745484549455045514552455345544555455645574558455945604561456245634564456545664567456845694570457145724573457445754576457745784579458045814582458345844585458645874588458945904591459245934594459545964597459845994600460146024603460446054606460746084609461046114612461346144615461646174618461946204621462246234624462546264627462846294630463146324633463446354636463746384639464046414642464346444645464646474648464946504651465246534654465546564657465846594660466146624663466446654666466746684669467046714672467346744675467646774678467946804681468246834684468546864687468846894690469146924693469446954696469746984699470047014702470347044705470647074708470947104711471247134714471547164717471847194720472147224723472447254726472747284729473047314732473347344735473647374738473947404741474247434744474547464747474847494750475147524753475447554756475747584759476047614762476347644765476647674768476947704771477247734774477547764777477847794780478147824783478447854786478747884789479047914792479347944795479647974798479948004801480248034804480548064807480848094810481148124813481448154816481748184819482048214822482348244825482648274828482948304831483248334834483548364837483848394840484148424843484448454846484748484849485048514852485348544855485648574858485948604861486248634864486548664867486848694870487148724873487448754876487748784879488048814882488348844885488648874888488948904891489248934894489548964897489848994900490149024903490449054906490749084909491049114912491349144915491649174918491949204921492249234924492549264927492849294930493149324933493449354936493749384939494049414942494349444945494649474948494949504951495249534954495549564957495849594960496149624963496449654966496749684969497049714972497349744975497649774978497949804981498249834984498549864987498849894990499149924993499449954996499749984999500050015002500350045005500650075008500950105011501250135014501550165017501850195020502150225023502450255026502750285029503050315032503350345035503650375038503950405041504250435044504550465047504850495050505150525053505450555056505750585059506050615062506350645065506650675068506950705071507250735074507550765077507850795080508150825083508450855086508750885089509050915092509350945095509650975098509951005101510251035104510551065107510851095110511151125113511451155116511751185119512051215122512351245125512651275128512951305131513251335134513551365137513851395140514151425143514451455146514751485149515051515152515351545155515651575158515951605161516251635164516551665167516851695170517151725173517451755176517751785179518051815182518351845185518651875188518951905191519251935194519551965197519851995200520152025203520452055206520752085209521052115212521352145215521652175218521952205221522252235224522552265227522852295230523152325233523452355236523752385239524052415242524352445245524652475248524952505251525252535254525552565257525852595260526152625263526452655266526752685269527052715272527352745275527652775278527952805281528252835284528552865287528852895290529152925293529452955296529752985299530053015302530353045305530653075308530953105311531253135314531553165317531853195320532153225323532453255326532753285329533053315332533353345335533653375338533953405341534253435344534553465347534853495350535153525353535453555356535753585359536053615362536353645365536653675368536953705371537253735374537553765377537853795380538153825383538453855386538753885389539053915392539353945395539653975398539954005401540254035404540554065407540854095410541154125413541454155416541754185419542054215422542354245425542654275428542954305431543254335434543554365437543854395440544154425443544454455446544754485449545054515452545354545455545654575458545954605461546254635464546554665467546854695470547154725473547454755476547754785479548054815482548354845485548654875488548954905491549254935494549554965497549854995500550155025503550455055506550755085509551055115512551355145515551655175518551955205521552255235524552555265527552855295530553155325533553455355536553755385539554055415542554355445545554655475548554955505551555255535554555555565557555855595560556155625563556455655566556755685569557055715572557355745575557655775578557955805581558255835584558555865587558855895590559155925593559455955596559755985599560056015602560356045605560656075608560956105611561256135614561556165617561856195620562156225623562456255626562756285629563056315632563356345635563656375638563956405641564256435644564556465647564856495650565156525653565456555656565756585659566056615662566356645665566656675668566956705671567256735674567556765677567856795680568156825683568456855686568756885689569056915692569356945695569656975698569957005701570257035704570557065707570857095710571157125713571457155716571757185719572057215722572357245725572657275728572957305731573257335734573557365737573857395740574157425743574457455746574757485749575057515752575357545755575657575758575957605761576257635764576557665767576857695770577157725773577457755776577757785779578057815782578357845785578657875788578957905791579257935794579557965797579857995800580158025803580458055806580758085809581058115812581358145815581658175818581958205821582258235824582558265827582858295830583158325833583458355836583758385839584058415842584358445845584658475848584958505851585258535854585558565857585858595860586158625863586458655866586758685869587058715872587358745875587658775878587958805881588258835884588558865887588858895890589158925893589458955896589758985899590059015902590359045905590659075908590959105911591259135914591559165917591859195920592159225923592459255926592759285929593059315932593359345935593659375938593959405941594259435944594559465947594859495950595159525953595459555956595759585959596059615962596359645965596659675968596959705971597259735974597559765977597859795980598159825983598459855986598759885989599059915992599359945995599659975998599960006001600260036004600560066007600860096010601160126013601460156016601760186019602060216022602360246025602660276028602960306031603260336034603560366037603860396040604160426043604460456046604760486049605060516052605360546055605660576058605960606061606260636064606560666067606860696070607160726073607460756076607760786079608060816082608360846085608660876088608960906091609260936094609560966097609860996100610161026103610461056106610761086109611061116112611361146115611661176118611961206121612261236124612561266127612861296130613161326133613461356136613761386139614061416142614361446145614661476148614961506151615261536154615561566157615861596160616161626163616461656166616761686169617061716172617361746175617661776178617961806181618261836184618561866187618861896190619161926193619461956196619761986199620062016202620362046205620662076208620962106211621262136214621562166217621862196220622162226223622462256226622762286229623062316232623362346235623662376238623962406241624262436244624562466247624862496250625162526253625462556256625762586259626062616262626362646265626662676268626962706271627262736274627562766277627862796280628162826283628462856286628762886289629062916292629362946295629662976298629963006301630263036304630563066307630863096310631163126313631463156316631763186319632063216322632363246325632663276328632963306331633263336334633563366337633863396340634163426343634463456346634763486349635063516352635363546355635663576358635963606361636263636364636563666367636863696370637163726373637463756376637763786379638063816382638363846385638663876388638963906391639263936394639563966397639863996400640164026403640464056406640764086409641064116412641364146415641664176418641964206421642264236424642564266427642864296430643164326433643464356436643764386439644064416442644364446445644664476448644964506451645264536454645564566457645864596460646164626463646464656466646764686469647064716472647364746475647664776478647964806481648264836484648564866487648864896490649164926493649464956496649764986499650065016502650365046505650665076508650965106511651265136514651565166517651865196520652165226523652465256526652765286529653065316532653365346535653665376538653965406541654265436544654565466547654865496550655165526553655465556556655765586559656065616562656365646565656665676568656965706571657265736574657565766577657865796580658165826583658465856586658765886589659065916592659365946595659665976598659966006601660266036604660566066607660866096610661166126613661466156616661766186619662066216622662366246625662666276628662966306631663266336634663566366637663866396640664166426643664466456646664766486649665066516652665366546655665666576658665966606661666266636664666566666667666866696670667166726673667466756676667766786679668066816682668366846685668666876688668966906691669266936694669566966697669866996700670167026703670467056706670767086709671067116712671367146715671667176718671967206721672267236724672567266727672867296730673167326733673467356736673767386739674067416742674367446745674667476748674967506751675267536754675567566757675867596760676167626763676467656766676767686769677067716772677367746775677667776778677967806781678267836784678567866787678867896790679167926793679467956796679767986799680068016802680368046805680668076808680968106811681268136814681568166817681868196820682168226823682468256826682768286829683068316832683368346835683668376838683968406841684268436844684568466847684868496850685168526853685468556856685768586859686068616862686368646865686668676868686968706871687268736874687568766877687868796880688168826883688468856886688768886889689068916892689368946895689668976898689969006901690269036904690569066907690869096910691169126913691469156916691769186919692069216922692369246925692669276928692969306931693269336934693569366937693869396940694169426943694469456946694769486949695069516952695369546955695669576958695969606961696269636964696569666967696869696970697169726973697469756976697769786979698069816982698369846985698669876988698969906991699269936994699569966997699869997000700170027003700470057006700770087009701070117012701370147015701670177018701970207021702270237024702570267027702870297030703170327033703470357036703770387039704070417042704370447045704670477048704970507051705270537054705570567057705870597060706170627063706470657066706770687069707070717072707370747075707670777078707970807081708270837084708570867087708870897090709170927093709470957096709770987099710071017102710371047105710671077108710971107111711271137114711571167117711871197120712171227123712471257126712771287129713071317132713371347135713671377138713971407141714271437144714571467147714871497150715171527153715471557156715771587159716071617162716371647165716671677168716971707171717271737174717571767177717871797180718171827183718471857186718771887189719071917192719371947195719671977198719972007201720272037204720572067207720872097210721172127213721472157216721772187219722072217222722372247225722672277228722972307231723272337234723572367237723872397240724172427243724472457246724772487249725072517252725372547255725672577258725972607261726272637264726572667267726872697270727172727273727472757276727772787279728072817282728372847285728672877288728972907291729272937294729572967297729872997300730173027303730473057306730773087309731073117312731373147315731673177318731973207321732273237324732573267327732873297330733173327333733473357336733773387339734073417342734373447345734673477348734973507351735273537354735573567357735873597360736173627363736473657366736773687369737073717372737373747375737673777378737973807381738273837384738573867387738873897390739173927393739473957396739773987399740074017402740374047405740674077408740974107411741274137414741574167417741874197420742174227423742474257426742774287429743074317432743374347435743674377438743974407441744274437444744574467447744874497450745174527453745474557456745774587459746074617462746374647465746674677468746974707471747274737474747574767477747874797480748174827483748474857486748774887489749074917492749374947495749674977498749975007501750275037504750575067507750875097510751175127513751475157516751775187519752075217522752375247525752675277528752975307531753275337534753575367537753875397540754175427543754475457546754775487549755075517552755375547555755675577558755975607561756275637564756575667567756875697570757175727573757475757576757775787579758075817582758375847585758675877588758975907591759275937594759575967597759875997600760176027603760476057606760776087609761076117612761376147615761676177618761976207621762276237624762576267627762876297630763176327633763476357636763776387639764076417642764376447645764676477648764976507651765276537654765576567657765876597660766176627663766476657666766776687669767076717672767376747675767676777678767976807681768276837684768576867687768876897690769176927693769476957696769776987699770077017702770377047705770677077708770977107711771277137714771577167717771877197720772177227723772477257726772777287729773077317732773377347735773677377738773977407741774277437744774577467747774877497750775177527753775477557756775777587759776077617762776377647765776677677768776977707771777277737774777577767777777877797780778177827783778477857786778777887789779077917792779377947795779677977798779978007801780278037804780578067807780878097810781178127813781478157816781778187819782078217822782378247825782678277828782978307831783278337834783578367837783878397840784178427843784478457846784778487849785078517852785378547855785678577858785978607861786278637864786578667867786878697870787178727873787478757876787778787879788078817882788378847885788678877888788978907891789278937894789578967897789878997900790179027903790479057906790779087909791079117912791379147915791679177918
  1. /* ============================================================================
  2. * Copyright (C) 2004 -Infineon Technologies AG.
  3. *
  4. * All rights reserved.
  5. * ============================================================================
  6. *
  7. *============================================================================
  8. * Licensed under GNU GPL v2
  9. * ============================================================================
  10. */
  11. /* ===========================================================================
  12. *
  13. * File Name: amazon_mei.c
  14. * Author : Ou Ke
  15. *
  16. * ===========================================================================
  17. *
  18. * Project: Amazon
  19. *
  20. * ===========================================================================
  21. * Contents:This file implements the MEI driver for Amazon ADSL/ADSL2+
  22. * controller.
  23. *
  24. * ===========================================================================
  25. * References:
  26. *
  27. */
  28. /* ===========================================================================
  29. * Revision History:
  30. * 12/1/2005 : Ritesh Banerjee
  31. * - Create a kernel thread kmibpoll to poll for periodic RFC 2662
  32. * and RFC 3440 counters. Removes the need for user space
  33. * adsl_mibpoll_daemon and saves atleast 30KB of RAM.
  34. *
  35. * $Log$
  36. * ===========================================================================
  37. */
  38. /*
  39. * ===========================================================================
  40. * INCLUDE FILES
  41. * ===========================================================================
  42. */
  43. //000002:fchang 2005/6/2 joelin 04/27/2005 for pcm clock
  44. //000003:fchang 2005/6/2 Henry added for Amazon-E support
  45. //165001:henryhsu 2005/9/6 Modify for adsl firmware version 1.2.1.2.0.1 DATA_LED can't flash.
  46. // 509221:tc.chen 2005/09/22 Reset DFE added when MEI_TO_ARC_CS_DONE not cleared by ARC
  47. // 603221:tc.chen 2006/03/21 added APIs to support the WEB related parameters for ADSL Statistics
  48. #ifndef EXPORT_SYMTAB
  49. #define EXPORT_SYMTAB
  50. #endif
  51. #define AMAZON_MEI_MIB_RFC3440
  52. #include <linux/config.h>
  53. #include <linux/kernel.h>
  54. #include <linux/module.h>
  55. #include <linux/version.h>
  56. #include <linux/types.h>
  57. #include <linux/fs.h>
  58. #include <linux/mm.h>
  59. #include <linux/errno.h>
  60. #include <linux/interrupt.h>
  61. #include <linux/netdevice.h>
  62. #include <linux/etherdevice.h>
  63. #include <asm/irq.h>
  64. #include <asm/segment.h>
  65. #include <asm/semaphore.h>
  66. #include <linux/init.h>
  67. #include <linux/ioport.h>
  68. #include <asm/uaccess.h>
  69. #include <linux/proc_fs.h>
  70. #include <asm/io.h>
  71. #include <linux/vmalloc.h>
  72. #include <linux/delay.h>
  73. #include <linux/poll.h>
  74. #include <linux/list.h>
  75. #include <linux/time.h>
  76. #include <asm/amazon/amazon.h>
  77. #include <asm/irq.h>
  78. #include <asm/amazon/irq.h>
  79. #include <asm/amazon/amazon_mei.h>
  80. #include <asm/amazon/amazon_mei_app.h>
  81. #include <asm/amazon/amazon_mei_ioctl.h>
  82. #include <asm/amazon/amazon_mei_app_ioctl.h>
  83. #define SET_BIT(reg, mask) reg |= (mask)
  84. #define CLEAR_BIT(reg, mask) reg &= (~mask)
  85. #define CLEAR_BITS(reg, mask) CLEAR_BIT(reg, mask)
  86. #define SET_BITS(reg, mask) SET_BIT(reg, mask)
  87. #define SET_BITFIELD(reg, mask, off, val) {reg &= (~mask); reg |= (val << off);}
  88. extern void mask_and_ack_amazon_irq(unsigned int irq_nr);
  89. #ifdef AMAZON_CHECK_LINK
  90. //amazon_tpe.c
  91. extern int (*adsl_link_notify)(int);
  92. #endif //AMAZON_CHECK_LINK
  93. // for ARC memory access
  94. #define WHILE_DELAY 20000
  95. #define AMAZON_DMA_DEBUG_MUTEX
  96. //TODO
  97. #undef DFE_LOOPBACK
  98. #define ARC_READY_ACK
  99. static amazon_mei_mib * current_intvl;
  100. static struct list_head interval_list;
  101. static amazon_mei_mib * mei_mib;
  102. static int reboot_firsttime=1;//000002:fchang
  103. //PCM
  104. #define PCM_CHANNEL_NUM 2 //1 rx, 1 tx
  105. static pcm_data_struct pcm_data[PCM_CHANNEL_NUM]__attribute__ ((aligned(4))); //0=tx0, 1=rx0, 2=tx1, 3=rx1
  106. static u32 pcm_start_addr;
  107. //#define PCM_HRT_TIME_HZ 4000 //?us
  108. #define PCM_ACCESS_DEBUG
  109. static int irqtimes=0;
  110. #undef DATA_LED_ON_MODE
  111. #define ADSL_LED_SUPPORT //joelin for adsl led
  112. #ifdef ADSL_LED_SUPPORT
  113. static int firmware_support_led=0; //joelin version check for adsl led
  114. static int stop_led_module=0; //wakeup and clean led module
  115. static int led_support_check=0; //1.1.2.7.1.1
  116. #endif //ADSL_LED_SUPPORT
  117. #define IFX_DYING_GASP
  118. #ifdef IFX_DYING_GASP
  119. static wait_queue_head_t wait_queue_dying_gasp; //dying gasp
  120. //struct tq_struct dying_gasp_task; //dying gasp
  121. static wait_queue_head_t wait_queue_uas_poll; //joelin 04/16/2005
  122. static u16 unavailable_seconds=0; //joelin 04/16/2005
  123. static meidebug lop_debugwr; //dying gasp
  124. #endif //IFX_DYING_GASP
  125. static int dbg_int=0;
  126. //#define DEBUG_ACCESS_DELAY for(dbg_int=0;dbg_int<100;dbg_int++){;}
  127. #define DEBUG_ACCESS_DELAY
  128. static u8 sampledata[512];
  129. static int firsttime[PCM_CHANNEL_NUM]={0,1};
  130. static int num_cmp[PCM_CHANNEL_NUM]={0,0};
  131. static int pcm_start_loc[PCM_CHANNEL_NUM]={0,0};
  132. // for clearEoC
  133. //#define MEI_CLREOC_BUFF_SIZE 512 //double the receive fifo size, bytes
  134. //static u8 clreoc[MEI_CLREOC_BUFF_SIZE]__attribute__ ((aligned(4))); //buffer to hold clearEoC data in bytes
  135. #undef AMAZON_CLEAR_EOC
  136. #ifdef AMAZON_CLEAR_EOC
  137. extern void ifx_push_eoc(struct sk_buff * pkt);
  138. #endif
  139. static int meiResetArc(void);
  140. #define IFX_POP_EOC_DONE 0
  141. #define IFX_POP_EOC_FAIL -1
  142. static struct list_head clreoc_list;
  143. static amazon_clreoc_pkt * clreoc_pkt;
  144. #define CLREOC_BUFF_SIZE 12 //number of clreoc commands being buffered
  145. //static int clreoc_wr=0;
  146. //static int clreoc_rd=0; //used to control clreoc circular buffer
  147. static wait_queue_head_t wait_queue_clreoc;
  148. #ifdef ADSL_LED_SUPPORT
  149. static wait_queue_head_t wait_queue_led; //adsl led
  150. static wait_queue_head_t wait_queue_led_polling;// adsl led
  151. struct tq_struct led_task; // adsl led
  152. static DECLARE_TASK_QUEUE(tq_ifx_led); // task
  153. int adsl_led_flash_task(void *ptr); // adsl led
  154. #endif //ADSL_LED_SUPPORT
  155. static void * clreoc_command_pkt=NULL;
  156. static int clreoc_max_tx_len=0;
  157. // 603221:tc.chen start
  158. #define ME_HDLC_IDLE 0
  159. #define ME_HDLC_INVALID_MSG 1
  160. #define ME_HDLC_MSG_QUEUED 2
  161. #define ME_HDLC_MSG_SENT 3
  162. #define ME_HDLC_RESP_RCVD 4
  163. #define ME_HDLC_RESP_TIMEOUT 5
  164. #define ME_HDLC_RX_BUF_OVERFLOW 6
  165. #define ME_HDLC_UNRESOLVED 1
  166. #define ME_HDLC_RESOLVED 2
  167. // 603221:tc.chen end
  168. #ifdef LOCK_RETRY
  169. static int reboot_lock=0;
  170. #endif
  171. static mib_previous_read mib_pread={0,0,0,0,0,0,0,0,0,0,0,0};
  172. static mib_flags_pretime mib_pflagtime;// initialized when module loaded
  173. static u32 ATUC_PERF_LOFS=0;
  174. static u32 ATUC_PERF_LOSS=0;
  175. static u32 ATUC_PERF_ESS=0;
  176. static u32 ATUC_PERF_INITS=0;
  177. static u32 ATUR_PERF_LOFS=0;
  178. static u32 ATUR_PERF_LOSS=0;
  179. static u32 ATUR_PERF_LPR=0;
  180. static u32 ATUR_PERF_ESS=0;
  181. static u32 ATUR_CHAN_RECV_BLK=0;
  182. static u32 ATUR_CHAN_TX_BLK=0;
  183. static u32 ATUR_CHAN_CORR_BLK=0;
  184. static u32 ATUR_CHAN_UNCORR_BLK=0;
  185. //RFC-3440
  186. static u32 ATUC_PERF_STAT_FASTR=0;
  187. static u32 ATUC_PERF_STAT_FAILED_FASTR=0;
  188. static u32 ATUC_PERF_STAT_SESL=0;
  189. static u32 ATUC_PERF_STAT_UASL=0;
  190. static u32 ATUR_PERF_STAT_SESL=0;
  191. static u32 ATUR_PERF_STAT_UASL=0;
  192. static adslChanPrevTxRate PrevTxRate={0,0};
  193. static adslPhysCurrStatus CurrStatus={0,0};
  194. static ChanType chantype={0,0};
  195. static adslLineAlarmConfProfileEntry AlarmConfProfile={"No Name\0",0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,1};
  196. // 603221:tc.chen start
  197. static adslFarEndPerfStats FarendStatsData;
  198. struct timeval FarendData_acquire_time={0};
  199. static u32 adsl_mode,adsl_mode_extend; // adsl mode : adsl/ 2/ 2+
  200. static adslInitStats AdslInitStatsData;
  201. //603221:tc.chen end
  202. static u32 loop_diagnostics_mode=0;
  203. static wait_queue_head_t wait_queue_loop_diagnostic;
  204. #ifdef AMAZON_MEI_MIB_RFC3440
  205. static adslLineAlarmConfProfileExtEntry AlarmConfProfileExt={"No Name\0",0,0,0,0,0,0};
  206. #endif
  207. static int showtime=0;
  208. static int loop_diagnostics_completed=0;
  209. //////////////////////////////////////////////////////////////////////////////////
  210. static int phy_mei_net_init(struct net_device * dev);
  211. static int interleave_mei_net_init(struct net_device * dev);
  212. static int fast_mei_net_init(struct net_device * dev);
  213. static struct net_device_stats * phy_mei_net_get_stats(struct net_device * dev);
  214. static struct net_device_stats * interleave_mei_net_get_stats(struct net_device * dev);
  215. static struct net_device_stats * fast_mei_net_get_stats(struct net_device * dev);
  216. typedef struct mei_priv{
  217. struct net_device_stats stats;
  218. }mei_priv;
  219. static struct net_device phy_mei_net = { init: phy_mei_net_init, name: "MEI_PHY"};
  220. static struct net_device interleave_mei_net = { init: interleave_mei_net_init, name: "MEI_INTL"};
  221. static struct net_device fast_mei_net = { init: fast_mei_net_init, name: "MEI_FAST"};
  222. ///////////////////////////////////////////////////////////////////////////////////
  223. static int major=AMAZON_MEI_MAJOR;
  224. static struct semaphore mei_sema;
  225. // Mei to ARC CMV count, reply count, ARC Indicator count
  226. static int indicator_count=0;
  227. static int cmv_count=0;
  228. static int reply_count=0;
  229. static u16 Recent_indicator[MSG_LENGTH];
  230. // Used in interrupt handler as flags
  231. static int arcmsgav=0;
  232. static int cmv_reply=0;
  233. static int cmv_waiting=0;
  234. #define PROC_ITEMS 8
  235. long mei_debug_mode = 0; //509221:tc.chen for adsl firmware debug
  236. // to wait for arc cmv reply, sleep on wait_queue_arcmsgav;
  237. static wait_queue_head_t wait_queue_arcmsgav;
  238. static wait_queue_head_t wait_queue_codeswap;
  239. static wait_queue_head_t wait_queue_mibdaemon;
  240. static wait_queue_head_t wait_queue_reboot;
  241. static u32 * image_buffer=NULL; // holding adsl firmware image
  242. static u16 RxMessage[MSG_LENGTH]__attribute__ ((aligned(4)));
  243. static u16 TxMessage[MSG_LENGTH]__attribute__ ((aligned(4)));
  244. static u32 * mei_arc_swap_buff=NULL; // holding swap pages
  245. static ARC_IMG_HDR * img_hdr;
  246. static int reboot_flag;
  247. #ifdef DFE_LOOPBACK
  248. #include "arc_pm.h"
  249. #endif
  250. ///////////////// net device ///////////////////////////////////////////////////
  251. static int phy_mei_net_init(struct net_device * dev)
  252. {
  253. //ether_setup(dev);
  254. dev->get_stats = phy_mei_net_get_stats;
  255. dev->ip_ptr = NULL;
  256. dev->type = 94;
  257. // dev->mtu=12345;
  258. dev->flags=IFF_UP;
  259. dev->priv = kmalloc(sizeof(struct mei_priv), GFP_KERNEL);
  260. if(dev->priv == NULL)
  261. return -ENOMEM;
  262. memset(dev->priv, 0, sizeof(struct mei_priv));
  263. return 0;
  264. }
  265. static int interleave_mei_net_init(struct net_device * dev)
  266. {
  267. //ether_setup(dev);
  268. dev->get_stats = interleave_mei_net_get_stats;
  269. dev->ip_ptr = NULL;
  270. dev->type = 124;
  271. dev->flags=IFF_UP;
  272. dev->priv = kmalloc(sizeof(struct mei_priv), GFP_KERNEL);
  273. if(dev->priv == NULL)
  274. return -ENOMEM;
  275. memset(dev->priv, 0, sizeof(struct mei_priv));
  276. return 0;
  277. }
  278. static int fast_mei_net_init(struct net_device * dev)
  279. {
  280. //ether_setup(dev);
  281. dev->get_stats = fast_mei_net_get_stats;
  282. dev->ip_ptr = NULL;
  283. dev->type = 125;
  284. dev->flags=IFF_UP;
  285. dev->priv = kmalloc(sizeof(struct mei_priv), GFP_KERNEL);
  286. if(dev->priv == NULL)
  287. return -ENOMEM;
  288. memset(dev->priv, 0, sizeof(struct mei_priv));
  289. return 0;
  290. }
  291. static struct net_device_stats * phy_mei_net_get_stats(struct net_device * dev)
  292. {
  293. struct mei_priv * priv;
  294. priv = (struct mei_priv *)dev->priv;
  295. // update statistics
  296. (priv->stats).rx_packets = ATUR_CHAN_RECV_BLK;
  297. (priv->stats).tx_packets = ATUR_CHAN_TX_BLK;
  298. (priv->stats).rx_errors = ATUR_CHAN_CORR_BLK + ATUR_CHAN_UNCORR_BLK;
  299. (priv->stats).rx_dropped = ATUR_CHAN_UNCORR_BLK;
  300. return &(priv->stats);
  301. }
  302. static struct net_device_stats * interleave_mei_net_get_stats(struct net_device * dev)
  303. {
  304. struct mei_priv * priv;
  305. priv = (struct mei_priv *)dev->priv;
  306. // update statistics
  307. (priv->stats).rx_packets = ATUR_CHAN_RECV_BLK;
  308. (priv->stats).tx_packets = ATUR_CHAN_TX_BLK;
  309. (priv->stats).rx_errors = ATUR_CHAN_CORR_BLK + ATUR_CHAN_UNCORR_BLK;
  310. (priv->stats).rx_dropped = ATUR_CHAN_UNCORR_BLK;
  311. return &(priv->stats);
  312. }
  313. static struct net_device_stats * fast_mei_net_get_stats(struct net_device * dev)
  314. {
  315. struct mei_priv * priv;
  316. priv = (struct mei_priv *)dev->priv;
  317. // update statistics
  318. (priv->stats).rx_packets = ATUR_CHAN_RECV_BLK;
  319. (priv->stats).tx_packets = ATUR_CHAN_TX_BLK;
  320. (priv->stats).rx_errors = ATUR_CHAN_CORR_BLK + ATUR_CHAN_UNCORR_BLK;
  321. (priv->stats).rx_dropped = ATUR_CHAN_UNCORR_BLK;
  322. return &(priv->stats);
  323. }
  324. ///////////////// mei access Rd/Wr methods ///////////////////////////////////////////////////
  325. void meiLongwordWrite(u32 ul_address, u32 ul_data)
  326. {
  327. *((volatile u32 *)ul_address) = ul_data;
  328. asm("SYNC");
  329. return;
  330. } // end of "meiLongwordWrite(..."
  331. void meiLongwordRead(u32 ul_address, u32 *pul_data)
  332. {
  333. *pul_data = *((volatile u32 *)ul_address);
  334. asm("SYNC");
  335. return;
  336. } // end of "meiLongwordRead(..."
  337. MEI_ERROR meiDMAWrite(u32 destaddr, u32 *databuff, u32 databuffsize)
  338. {
  339. u32 *p = databuff;
  340. u32 temp;
  341. u32 flags;
  342. if( destaddr & 3)
  343. return MEI_FAILURE;
  344. #ifdef AMAZON_DMA_DEBUG_MUTEX
  345. save_flags(flags);
  346. cli();
  347. #endif
  348. // Set the write transfer address
  349. meiLongwordWrite(MEI_XFR_ADDR, destaddr);
  350. // Write the data pushed across DMA
  351. while (databuffsize--)
  352. {
  353. temp = *p;
  354. if(databuff==(u32 *)TxMessage) // swap half word
  355. temp = ((temp & 0xffff)<<16) + ((temp & 0xffff0000)>>16);
  356. meiLongwordWrite(MEI_DATA_XFR, temp);
  357. p++;
  358. } // end of "while(..."
  359. #ifdef AMAZON_DMA_DEBUG_MUTEX
  360. restore_flags(flags);
  361. #endif
  362. return MEI_SUCCESS;
  363. } // end of "meiDMAWrite(..."
  364. MEI_ERROR meiDMAWrite_16(u32 destaddr, u32 *databuff, u32 databuffsize)
  365. {
  366. u32 *p = databuff;
  367. u32 temp;
  368. u32 flags;
  369. if( destaddr & 3)
  370. return MEI_FAILURE;
  371. #ifdef AMAZON_DMA_DEBUG_MUTEX
  372. save_flags(flags);
  373. cli();
  374. #endif
  375. // Set the write transfer address
  376. meiLongwordWrite(MEI_XFR_ADDR, destaddr);
  377. // Write the data pushed across DMA
  378. while (databuffsize--)
  379. {
  380. temp = *p;
  381. temp = ((temp & 0xffff)<<16) + ((temp & 0xffff0000)>>16);//swap half word
  382. meiLongwordWrite(MEI_DATA_XFR, temp);
  383. p++;
  384. } // end of "while(..."
  385. #ifdef AMAZON_DMA_DEBUG_MUTEX
  386. restore_flags(flags);
  387. #endif
  388. return MEI_SUCCESS;
  389. } // end of "meiDMAWrite_16(..."
  390. MEI_ERROR meiDMAWrite_8(u32 destaddr, u32 *databuff, u32 databuffsize)
  391. {
  392. u32 *p = databuff;
  393. u32 temp;
  394. u32 flags;
  395. if( destaddr & 3)
  396. return MEI_FAILURE;
  397. #ifdef AMAZON_DMA_DEBUG_MUTEX
  398. save_flags(flags);
  399. cli();
  400. #endif
  401. // Set the write transfer address
  402. meiLongwordWrite(MEI_XFR_ADDR, destaddr);
  403. // Write the data pushed across DMA
  404. while (databuffsize--)
  405. {
  406. temp = *p;
  407. temp = ((temp & 0xff)<<24) + ((temp & 0xff00)<<8)+ ((temp & 0xff0000)>>8)+ ((temp & 0xff000000)>>24);//swap byte
  408. meiLongwordWrite(MEI_DATA_XFR, temp);
  409. p++;
  410. } // end of "while(..."
  411. #ifdef AMAZON_DMA_DEBUG_MUTEX
  412. restore_flags(flags);
  413. #endif
  414. return MEI_SUCCESS;
  415. } // end of "meiDMAWrite_8(..."
  416. MEI_ERROR meiDMARead(u32 srcaddr, u32 *databuff, u32 databuffsize)
  417. {
  418. u32 *p = databuff;
  419. u32 temp;
  420. u32 flags;
  421. if( srcaddr & 3)
  422. return MEI_FAILURE;
  423. #ifdef AMAZON_DMA_DEBUG_MUTEX
  424. save_flags(flags);
  425. cli();
  426. #endif
  427. // Set the read transfer address
  428. meiLongwordWrite(MEI_XFR_ADDR, srcaddr);
  429. // Read the data popped across DMA
  430. while (databuffsize--)
  431. {
  432. meiLongwordRead(MEI_DATA_XFR, &temp);
  433. if(databuff==(u32 *)RxMessage) // swap half word
  434. temp = ((temp & 0xffff)<<16) + ((temp & 0xffff0000)>>16);
  435. *p=temp;
  436. p++;
  437. } // end of "while(..."
  438. #ifdef AMAZON_DMA_DEBUG_MUTEX
  439. restore_flags(flags);
  440. #endif
  441. return MEI_SUCCESS;
  442. } // end of "meiDMARead(..."
  443. MEI_ERROR meiDMARead_16(u32 srcaddr, u32 *databuff, u32 databuffsize)
  444. {
  445. u32 *p = databuff;
  446. u32 temp;
  447. u32 flags;
  448. if( srcaddr & 3)
  449. return MEI_FAILURE;
  450. #ifdef AMAZON_DMA_DEBUG_MUTEX
  451. save_flags(flags);
  452. cli();
  453. #endif
  454. // Set the read transfer address
  455. meiLongwordWrite(MEI_XFR_ADDR, srcaddr);
  456. // Read the data popped across DMA
  457. while (databuffsize--)
  458. {
  459. meiLongwordRead(MEI_DATA_XFR, &temp);
  460. temp = ((temp & 0xffff)<<16) + ((temp & 0xffff0000)>>16);
  461. *p=temp;
  462. p++;
  463. } // end of "while(..."
  464. #ifdef AMAZON_DMA_DEBUG_MUTEX
  465. restore_flags(flags);
  466. #endif
  467. return MEI_SUCCESS;
  468. } // end of "meiDMARead_16(..."
  469. MEI_ERROR meiDMARead_8(u32 srcaddr, u32 *databuff, u32 databuffsize)
  470. {
  471. u32 *p = databuff;
  472. u32 temp;
  473. u32 flags;
  474. if( srcaddr & 3)
  475. return MEI_FAILURE;
  476. #ifdef AMAZON_DMA_DEBUG_MUTEX
  477. save_flags(flags);
  478. cli();
  479. #endif
  480. // Set the read transfer address
  481. meiLongwordWrite(MEI_XFR_ADDR, srcaddr);
  482. // Read the data popped across DMA
  483. while (databuffsize--)
  484. {
  485. meiLongwordRead(MEI_DATA_XFR, &temp);
  486. temp = ((temp & 0xff)<<24) + ((temp & 0xff00)<<8)+ ((temp & 0xff0000)>>8)+ ((temp & 0xff000000)>>24);//swap byte
  487. *p=temp;
  488. p++;
  489. } // end of "while(..."
  490. #ifdef AMAZON_DMA_DEBUG_MUTEX
  491. restore_flags(flags);
  492. #endif
  493. return MEI_SUCCESS;
  494. } // end of "meiDMARead_8(..."
  495. void meiPollForDbgDone(void)
  496. {
  497. u32 query = 0;
  498. int i=0;
  499. while (i<WHILE_DELAY)
  500. {
  501. meiLongwordRead(ARC_TO_MEI_INT, &query);
  502. query &= (ARC_TO_MEI_DBG_DONE);
  503. if(query)
  504. break;
  505. i++;
  506. if(i==WHILE_DELAY){
  507. #ifdef AMAZON_MEI_DEBUG_ON
  508. printk("\n\n PollforDbg fail");
  509. #endif
  510. }
  511. DEBUG_ACCESS_DELAY;
  512. }
  513. meiLongwordWrite(ARC_TO_MEI_INT, ARC_TO_MEI_DBG_DONE); // to clear this interrupt
  514. } // end of "meiPollForDbgDone(..."
  515. MEI_ERROR meiDebugWrite_8(u32 destaddr, u32 *databuff, u32 databuffsize)
  516. {
  517. u32 i;
  518. u32 temp = 0x0;
  519. u32 address = 0x0;
  520. u32 *buffer = 0x0;
  521. u32 flags;
  522. #ifdef AMAZON_DMA_DEBUG_MUTEX
  523. save_flags(flags);
  524. cli();
  525. #endif
  526. // Open the debug port before DMP memory write
  527. meiLongwordRead(MEI_CONTROL, &temp);
  528. DEBUG_ACCESS_DELAY;
  529. temp |= (HOST_MSTR);
  530. meiLongwordWrite(MEI_CONTROL, temp);
  531. DEBUG_ACCESS_DELAY;
  532. meiLongwordWrite(MEI_DEBUG_DEC, MEI_DEBUG_DEC_DMP1_MASK);
  533. DEBUG_ACCESS_DELAY;
  534. // For the requested length, write the address and write the data
  535. address = destaddr;
  536. buffer = databuff;
  537. for (i=0; i < databuffsize; i++)
  538. {
  539. meiLongwordWrite(MEI_DEBUG_WAD, address);
  540. DEBUG_ACCESS_DELAY;
  541. temp=*buffer;
  542. temp = ((temp & 0xff)<<24) + ((temp & 0xff00)<<8)+ ((temp & 0xff0000)>>8)+ ((temp & 0xff000000)>>24);//swap byte
  543. meiLongwordWrite(MEI_DEBUG_DATA, temp);
  544. DEBUG_ACCESS_DELAY;
  545. meiPollForDbgDone();
  546. address += 4;
  547. buffer++;
  548. } // end of "for(..."
  549. // Close the debug port after DMP memory write
  550. meiLongwordRead(MEI_CONTROL, &temp);
  551. DEBUG_ACCESS_DELAY;
  552. temp &= ~(HOST_MSTR);
  553. meiLongwordWrite(MEI_CONTROL, temp);
  554. DEBUG_ACCESS_DELAY;
  555. #ifdef AMAZON_DMA_DEBUG_MUTEX
  556. restore_flags(flags);
  557. #endif
  558. // Return
  559. return MEI_SUCCESS;
  560. } // end of "meiDebugWrite_8(..."
  561. MEI_ERROR meiDebugRead_8(u32 srcaddr, u32 *databuff, u32 databuffsize)
  562. {
  563. u32 i;
  564. u32 temp = 0x0;
  565. u32 address = 0x0;
  566. u32 *buffer = 0x0;
  567. u32 flags;
  568. #ifdef AMAZON_DMA_DEBUG_MUTEX
  569. save_flags(flags);
  570. cli();
  571. #endif
  572. // Open the debug port before DMP memory read
  573. meiLongwordRead(MEI_CONTROL, &temp);
  574. DEBUG_ACCESS_DELAY;
  575. temp |= (HOST_MSTR);
  576. meiLongwordWrite(MEI_CONTROL, temp);
  577. DEBUG_ACCESS_DELAY;
  578. meiLongwordWrite(MEI_DEBUG_DEC, MEI_DEBUG_DEC_DMP2_MASK);
  579. DEBUG_ACCESS_DELAY;
  580. // For the requested length, write the address and read the data
  581. address = srcaddr;
  582. buffer = databuff;
  583. for (i=0; i<databuffsize; i++)
  584. {
  585. meiLongwordWrite(MEI_DEBUG_RAD, address);
  586. DEBUG_ACCESS_DELAY;
  587. meiPollForDbgDone();
  588. meiLongwordRead(MEI_DEBUG_DATA, &temp);
  589. DEBUG_ACCESS_DELAY;
  590. temp = ((temp & 0xff)<<24) + ((temp & 0xff00)<<8)+ ((temp & 0xff0000)>>8)+ ((temp & 0xff000000)>>24);//swap byte
  591. *buffer=temp;
  592. address += 4;
  593. buffer++;
  594. } // end of "for(..."
  595. // Close the debug port after DMP memory read
  596. meiLongwordRead(MEI_CONTROL, &temp);
  597. DEBUG_ACCESS_DELAY;
  598. temp &= ~(HOST_MSTR);
  599. meiLongwordWrite(MEI_CONTROL, temp);
  600. DEBUG_ACCESS_DELAY;
  601. #ifdef AMAZON_DMA_DEBUG_MUTEX
  602. restore_flags(flags);
  603. #endif
  604. // Return
  605. return MEI_SUCCESS;
  606. } // end of "meiDebugRead_8(..."
  607. MEI_ERROR meiDebugWrite_16(u32 destaddr, u32 *databuff, u32 databuffsize)
  608. {
  609. u32 i;
  610. u32 temp = 0x0;
  611. u32 address = 0x0;
  612. u32 *buffer = 0x0;
  613. u32 flags;
  614. #ifdef AMAZON_DMA_DEBUG_MUTEX
  615. save_flags(flags);
  616. cli();
  617. #endif
  618. // Open the debug port before DMP memory write
  619. meiLongwordRead(MEI_CONTROL, &temp);
  620. DEBUG_ACCESS_DELAY;
  621. temp |= (HOST_MSTR);
  622. meiLongwordWrite(MEI_CONTROL, temp);
  623. DEBUG_ACCESS_DELAY;
  624. meiLongwordWrite(MEI_DEBUG_DEC, MEI_DEBUG_DEC_DMP1_MASK);
  625. DEBUG_ACCESS_DELAY;
  626. // For the requested length, write the address and write the data
  627. address = destaddr;
  628. buffer = databuff;
  629. for (i=0; i < databuffsize; i++)
  630. {
  631. meiLongwordWrite(MEI_DEBUG_WAD, address);
  632. DEBUG_ACCESS_DELAY;
  633. temp=*buffer;
  634. temp = ((temp & 0xffff)<<16) + ((temp & 0xffff0000)>>16);//swap half word
  635. meiLongwordWrite(MEI_DEBUG_DATA, temp);
  636. DEBUG_ACCESS_DELAY;
  637. meiPollForDbgDone();
  638. address += 4;
  639. buffer++;
  640. } // end of "for(..."
  641. // Close the debug port after DMP memory write
  642. meiLongwordRead(MEI_CONTROL, &temp);
  643. DEBUG_ACCESS_DELAY;
  644. temp &= ~(HOST_MSTR);
  645. meiLongwordWrite(MEI_CONTROL, temp);
  646. DEBUG_ACCESS_DELAY;
  647. #ifdef AMAZON_DMA_DEBUG_MUTEX
  648. restore_flags(flags);
  649. #endif
  650. // Return
  651. return MEI_SUCCESS;
  652. } // end of "meiDebugWrite_16(..."
  653. MEI_ERROR meiDebugRead_16(u32 srcaddr, u32 *databuff, u32 databuffsize)
  654. {
  655. u32 i;
  656. u32 temp = 0x0;
  657. u32 address = 0x0;
  658. u32 *buffer = 0x0;
  659. u32 flags;
  660. #ifdef AMAZON_DMA_DEBUG_MUTEX
  661. save_flags(flags);
  662. cli();
  663. #endif
  664. // Open the debug port before DMP memory read
  665. meiLongwordRead(MEI_CONTROL, &temp);
  666. DEBUG_ACCESS_DELAY;
  667. temp |= (HOST_MSTR);
  668. meiLongwordWrite(MEI_CONTROL, temp);
  669. DEBUG_ACCESS_DELAY;
  670. meiLongwordWrite(MEI_DEBUG_DEC, MEI_DEBUG_DEC_DMP2_MASK);
  671. DEBUG_ACCESS_DELAY;
  672. // For the requested length, write the address and read the data
  673. address = srcaddr;
  674. buffer = databuff;
  675. for (i=0; i<databuffsize; i++)
  676. {
  677. meiLongwordWrite(MEI_DEBUG_RAD, address);
  678. DEBUG_ACCESS_DELAY;
  679. meiPollForDbgDone();
  680. meiLongwordRead(MEI_DEBUG_DATA, &temp);
  681. DEBUG_ACCESS_DELAY;
  682. temp = ((temp & 0xffff)<<16) + ((temp & 0xffff0000)>>16);//swap half word
  683. *buffer=temp;
  684. address += 4;
  685. buffer++;
  686. } // end of "for(..."
  687. // Close the debug port after DMP memory read
  688. meiLongwordRead(MEI_CONTROL, &temp);
  689. DEBUG_ACCESS_DELAY;
  690. temp &= ~(HOST_MSTR);
  691. meiLongwordWrite(MEI_CONTROL, temp);
  692. DEBUG_ACCESS_DELAY;
  693. #ifdef AMAZON_DMA_DEBUG_MUTEX
  694. restore_flags(flags);
  695. #endif
  696. // Return
  697. return MEI_SUCCESS;
  698. } // end of "meiDebugRead_16(..."
  699. MEI_ERROR meiDebugWrite(u32 destaddr, u32 *databuff, u32 databuffsize)
  700. {
  701. u32 i;
  702. u32 temp = 0x0;
  703. u32 address = 0x0;
  704. u32 *buffer = 0x0;
  705. u32 flags;
  706. #ifdef AMAZON_DMA_DEBUG_MUTEX
  707. save_flags(flags);
  708. cli();
  709. #endif
  710. // Open the debug port before DMP memory write
  711. meiLongwordRead(MEI_CONTROL, &temp);
  712. DEBUG_ACCESS_DELAY;
  713. temp |= (HOST_MSTR);
  714. meiLongwordWrite(MEI_CONTROL, temp);
  715. DEBUG_ACCESS_DELAY;
  716. meiLongwordWrite(MEI_DEBUG_DEC, MEI_DEBUG_DEC_DMP1_MASK);
  717. DEBUG_ACCESS_DELAY;
  718. // For the requested length, write the address and write the data
  719. address = destaddr;
  720. buffer = databuff;
  721. for (i=0; i < databuffsize; i++)
  722. {
  723. meiLongwordWrite(MEI_DEBUG_WAD, address);
  724. DEBUG_ACCESS_DELAY;
  725. temp=*buffer;
  726. meiLongwordWrite(MEI_DEBUG_DATA, temp);
  727. DEBUG_ACCESS_DELAY;
  728. meiPollForDbgDone();
  729. address += 4;
  730. buffer++;
  731. } // end of "for(..."
  732. // Close the debug port after DMP memory write
  733. meiLongwordRead(MEI_CONTROL, &temp);
  734. DEBUG_ACCESS_DELAY;
  735. temp &= ~(HOST_MSTR);
  736. meiLongwordWrite(MEI_CONTROL, temp);
  737. DEBUG_ACCESS_DELAY;
  738. #ifdef AMAZON_DMA_DEBUG_MUTEX
  739. restore_flags(flags);
  740. #endif
  741. // Return
  742. return MEI_SUCCESS;
  743. } // end of "meiDebugWrite(..."
  744. MEI_ERROR meiDebugRead(u32 srcaddr, u32 *databuff, u32 databuffsize)
  745. {
  746. u32 i;
  747. u32 temp = 0x0;
  748. u32 address = 0x0;
  749. u32 *buffer = 0x0;
  750. u32 flags;
  751. #ifdef AMAZON_DMA_DEBUG_MUTEX
  752. save_flags(flags);
  753. cli();
  754. #endif
  755. // Open the debug port before DMP memory read
  756. meiLongwordRead(MEI_CONTROL, &temp);
  757. DEBUG_ACCESS_DELAY;
  758. temp |= (HOST_MSTR);
  759. meiLongwordWrite(MEI_CONTROL, temp);
  760. DEBUG_ACCESS_DELAY;
  761. meiLongwordWrite(MEI_DEBUG_DEC, MEI_DEBUG_DEC_DMP2_MASK);
  762. DEBUG_ACCESS_DELAY;
  763. // For the requested length, write the address and read the data
  764. address = srcaddr;
  765. buffer = databuff;
  766. for (i=0; i<databuffsize; i++)
  767. {
  768. meiLongwordWrite(MEI_DEBUG_RAD, address);
  769. DEBUG_ACCESS_DELAY;
  770. meiPollForDbgDone();
  771. meiLongwordRead(MEI_DEBUG_DATA, &temp);
  772. DEBUG_ACCESS_DELAY;
  773. *buffer=temp;
  774. address += 4;
  775. buffer++;
  776. } // end of "for(..."
  777. // Close the debug port after DMP memory read
  778. meiLongwordRead(MEI_CONTROL, &temp);
  779. DEBUG_ACCESS_DELAY;
  780. temp &= ~(HOST_MSTR);
  781. meiLongwordWrite(MEI_CONTROL, temp);
  782. DEBUG_ACCESS_DELAY;
  783. #ifdef AMAZON_DMA_DEBUG_MUTEX
  784. restore_flags(flags);
  785. #endif
  786. // Return
  787. return MEI_SUCCESS;
  788. } // end of "meiDebugRead(..."
  789. EXPORT_SYMBOL(meiDebugRead);
  790. void meiMailboxInterruptsDisable(void)
  791. {
  792. meiLongwordWrite(ARC_TO_MEI_INT_MASK, 0x0);
  793. } // end of "meiMailboxInterruptsDisable(..."
  794. void meiMailboxInterruptsEnable(void)
  795. {
  796. meiLongwordWrite(ARC_TO_MEI_INT_MASK, MSGAV_EN);
  797. } // end of "meiMailboxInterruptsEnable(..."
  798. MEI_ERROR meiMailboxWrite(u16 *msgsrcbuffer, u16 msgsize)
  799. {
  800. int i;
  801. u32 arc_mailbox_status = 0x0;
  802. u32 temp=0;
  803. MEI_ERROR meiMailboxError = MEI_SUCCESS;
  804. // Check arc if mailbox write can be initiated
  805. /* meiLongwordRead(MEI_TO_ARC_INT, &arc_mailbox_status);
  806. if ((arc_mailbox_status & MEI_TO_ARC_MSGAV))
  807. {
  808. return MEI_MAILBOX_FULL;
  809. }
  810. */
  811. // Write to mailbox
  812. meiMailboxError = meiDMAWrite(MEI_TO_ARC_MAILBOX, (u32*)msgsrcbuffer, msgsize/2);
  813. meiMailboxError = meiDMAWrite(MEI_TO_ARC_MAILBOXR, (u32 *)(&temp), 1);
  814. // Notify arc that mailbox write completed
  815. cmv_waiting=1;
  816. meiLongwordWrite(MEI_TO_ARC_INT, MEI_TO_ARC_MSGAV);
  817. i=0;
  818. while(i<WHILE_DELAY){ // wait for ARC to clear the bit
  819. meiLongwordRead(MEI_TO_ARC_INT, &arc_mailbox_status);
  820. if((arc_mailbox_status & MEI_TO_ARC_MSGAV) != MEI_TO_ARC_MSGAV)
  821. break;
  822. i++;
  823. if(i==WHILE_DELAY){
  824. #ifdef AMAZON_MEI_DEBUG_ON
  825. printk("\n\n MEI_TO_ARC_MSGAV not cleared by ARC");
  826. #endif
  827. meiMailboxError = MEI_FAILURE;
  828. #if 0
  829. for(i=0;i<msgsize;i++)
  830. printk("\n %8x", (*(msgsrcbuffer+i)));
  831. #endif
  832. }
  833. }
  834. // Return
  835. return meiMailboxError;
  836. } // end of "meiMailboxWrite(..."
  837. MEI_ERROR meiMailboxRead(u16 *msgdestbuffer, u16 msgsize)
  838. {
  839. //u32 arc_mailbox_status = 0x0;
  840. //u32 *mei_arc_msgbuff = 0x0;
  841. MEI_ERROR meiMailboxError = MEI_SUCCESS;
  842. /*
  843. // Check arc if mailbox read can be initiated
  844. meiLongwordRead(ARC_TO_MEI_INT, &arc_mailbox_status);
  845. if ((arc_mailbox_status & ARC_TO_MEI_MSGAV) == 0)
  846. {
  847. return MEI_MAILBOX_EMPTY;
  848. } // end of "if(..."
  849. */
  850. // Read from mailbox
  851. meiMailboxError = meiDMARead(ARC_TO_MEI_MAILBOX, (u32*)msgdestbuffer, msgsize/2);
  852. // Notify arc that mailbox read completed
  853. meiLongwordWrite(ARC_TO_MEI_INT, ARC_TO_MEI_MSGAV);
  854. // Return
  855. return meiMailboxError;
  856. } // end of "meiMailboxRead(..."
  857. MEI_ERROR meiHaltArc(void)
  858. {
  859. u32 arc_control_mode = 0x0;
  860. u32 arc_debug_addr = 0x5;
  861. u32 arc_debug_data = 0x0;
  862. // Switch arc control from JTAG mode to MEI mode- write '1' to bit0
  863. meiLongwordRead(MEI_CONTROL, &arc_control_mode);
  864. arc_control_mode |= (HOST_MSTR);
  865. meiLongwordWrite(MEI_CONTROL, arc_control_mode);
  866. // Write arc aux reg access mask (0x0) into debug addr decode reg
  867. meiLongwordWrite(MEI_DEBUG_DEC, MEI_DEBUG_DEC_AUX_MASK);
  868. // Write arc debug reg addr (0x5) into debug read addr reg
  869. meiLongwordWrite(MEI_DEBUG_RAD, arc_debug_addr);
  870. meiPollForDbgDone();
  871. // Read debug data reg and save content
  872. meiLongwordRead(MEI_DEBUG_DATA, &arc_debug_data);
  873. // Write arc debug reg addr (0x5) into debug write addr reg
  874. meiLongwordWrite(MEI_DEBUG_WAD, arc_debug_addr);
  875. // Write debug data reg with content ORd with 0x2 (halt bit set)
  876. arc_debug_data |= (BIT1);
  877. meiLongwordWrite(MEI_DEBUG_DATA, arc_debug_data);
  878. meiPollForDbgDone();
  879. // Switch arc control from MEI mode to JTAG mode- write '0' to bit0
  880. meiLongwordRead(MEI_CONTROL, &arc_control_mode);
  881. arc_control_mode &= ~(HOST_MSTR);
  882. meiLongwordWrite(MEI_CONTROL, arc_control_mode);
  883. // Return
  884. return MEI_SUCCESS;
  885. } // end of "meiHalt(..."
  886. MEI_ERROR meiDownloadBootCode(void)
  887. {
  888. u32 arc_control_mode;
  889. u32 boot_loop;
  890. u32 page_size;
  891. u32 dest_addr;
  892. u32 arc_debug_addr = 0x31F00;
  893. u32 arc_debug_data = 0x10;
  894. u32 temp;
  895. // int i;
  896. //MEI_ERROR meiDMAError = MEI_SUCCESS;
  897. // Disable mask for arc codeswap interrupts
  898. meiMailboxInterruptsDisable();
  899. // Switch arc control from JTAG mode to MEI mode- write '1' to bit0
  900. meiLongwordRead(MEI_CONTROL, &arc_control_mode);
  901. arc_control_mode |= (HOST_MSTR);
  902. meiLongwordWrite(MEI_CONTROL, arc_control_mode);
  903. // Write (0x10) to CRI_CCR0(0x31F00) to enable ac_clk signal
  904. meiLongwordWrite(MEI_DEBUG_DEC, MEI_DEBUG_DEC_DMP1_MASK);
  905. meiLongwordWrite(MEI_DEBUG_RAD, arc_debug_addr);
  906. meiPollForDbgDone();
  907. meiLongwordRead(MEI_DEBUG_DATA, &temp);
  908. temp |=arc_debug_data;
  909. meiLongwordWrite(MEI_DEBUG_WAD, arc_debug_addr);
  910. meiLongwordWrite(MEI_DEBUG_DATA, temp);
  911. meiPollForDbgDone();
  912. //meiLongwordWrite(MEI_DEBUG_DEC, MEI_DEBUG_DEC_AUX_MASK);
  913. // Switch arc control from MEI mode to JTAG mode- write '0' to bit0
  914. meiLongwordRead(MEI_CONTROL, &arc_control_mode);
  915. arc_control_mode &= ~(HOST_MSTR);
  916. meiLongwordWrite(MEI_CONTROL, arc_control_mode);
  917. #ifdef AMAZON_MEI_DEBUG_ON //to test ac_clk setting correctness
  918. meiLongwordRead(MEI_CONTROL, &arc_control_mode);
  919. arc_control_mode |= (HOST_MSTR);
  920. meiLongwordWrite(MEI_CONTROL, arc_control_mode);
  921. meiLongwordWrite(MEI_DEBUG_DEC, MEI_DEBUG_DEC_DMP1_MASK);
  922. meiLongwordWrite(MEI_DEBUG_RAD, arc_debug_addr);
  923. meiPollForDbgDone();
  924. meiLongwordRead(MEI_DEBUG_DATA, &arc_debug_data);
  925. meiLongwordRead(MEI_CONTROL, &arc_control_mode);
  926. arc_control_mode &= ~(HOST_MSTR);
  927. meiLongwordWrite(MEI_CONTROL, arc_control_mode);
  928. // printk("\n\n ac_clk is %8x\n", arc_debug_data);
  929. #endif
  930. /*
  931. ** DMA the boot code page(s)
  932. */
  933. #ifdef AMAZON_MEI_DEBUG_ON
  934. // printk("\n\n start download pages");
  935. #endif
  936. for( boot_loop = 0; boot_loop < img_hdr->count; boot_loop++)
  937. {
  938. if( img_hdr->page[boot_loop].p_size & BOOT_FLAG)
  939. {
  940. page_size = meiGetPage( boot_loop, GET_PROG, MAXSWAPSIZE, mei_arc_swap_buff, &dest_addr);
  941. if( page_size > 0)
  942. {
  943. meiDMAWrite(dest_addr, mei_arc_swap_buff, page_size);
  944. }
  945. }
  946. if( img_hdr->page[boot_loop].d_size & BOOT_FLAG)
  947. {
  948. page_size = meiGetPage( boot_loop, GET_DATA, MAXSWAPSIZE, mei_arc_swap_buff, &dest_addr);
  949. if( page_size > 0)
  950. {
  951. meiDMAWrite( dest_addr, mei_arc_swap_buff, page_size);
  952. }
  953. }
  954. }
  955. #ifdef AMAZON_MEI_DEBUG_ON
  956. // printk("\n\n pages downloaded");
  957. #endif
  958. return MEI_SUCCESS;
  959. } // end of "meiDownloadBootCode(..."
  960. MEI_ERROR meiRunArc(void)
  961. {
  962. u32 arc_control_mode = 0x0;
  963. u32 arc_debug_addr = 0x0;
  964. u32 arc_debug_data = 0x0;
  965. // Switch arc control from JTAG mode to MEI mode- write '1' to bit0
  966. meiLongwordRead(MEI_CONTROL, &arc_control_mode);
  967. arc_control_mode |= (HOST_MSTR);
  968. meiLongwordWrite(MEI_CONTROL, arc_control_mode);
  969. // Write arc aux reg access mask (0x0) into debug addr decode reg
  970. meiLongwordWrite(MEI_DEBUG_DEC, MEI_DEBUG_DEC_AUX_MASK);
  971. // Write arc status aux reg addr (0x0) into debug read addr reg
  972. meiLongwordWrite(MEI_DEBUG_RAD, arc_debug_addr);
  973. meiPollForDbgDone();
  974. // Read debug data reg and save content
  975. meiLongwordRead(MEI_DEBUG_DATA, &arc_debug_data);
  976. // Write arc status aux reg addr (0x0) into debug write addr reg
  977. meiLongwordWrite(MEI_DEBUG_WAD, arc_debug_addr);
  978. // Write debug data reg with content ANDd with 0xFDFFFFFF (halt bit cleared)
  979. arc_debug_data &= ~(BIT25);
  980. meiLongwordWrite(MEI_DEBUG_DATA, arc_debug_data);
  981. meiPollForDbgDone();
  982. // Switch arc control from MEI mode to JTAG mode- write '0' to bit0
  983. meiLongwordRead(MEI_CONTROL, &arc_control_mode);
  984. arc_control_mode &= ~(HOST_MSTR);
  985. meiLongwordWrite(MEI_CONTROL, arc_control_mode);
  986. // Enable mask for arc codeswap interrupts
  987. meiMailboxInterruptsEnable();
  988. // Return
  989. return MEI_SUCCESS;
  990. } // end of "meiActivate(..."
  991. int meiGetPage( u32 Page, u32 data, u32 MaxSize, u32 *Buffer, u32 *Dest)
  992. {
  993. u32 size;
  994. u32 i;
  995. u32 *p;
  996. if( Page > img_hdr->count)
  997. return -2;
  998. /*
  999. ** Get program or data size, depending on "data" flag
  1000. */
  1001. size = (data == GET_DATA) ? img_hdr->page[ Page].d_size : img_hdr->page[ Page].p_size;
  1002. size &= BOOT_FLAG_MASK; // Clear boot bit!
  1003. if( size > MaxSize)
  1004. return -1;
  1005. if( size == 0)
  1006. return 0;
  1007. /*
  1008. ** Get program or data offset, depending on "data" flag
  1009. */
  1010. i = data ? img_hdr->page[ Page].d_offset : img_hdr->page[ Page].p_offset;
  1011. /*
  1012. ** Copy data/program to buffer
  1013. */
  1014. i /= 4; // Adjust offset for byte-to-UINT for array operation
  1015. p = (u32 *)img_hdr + i;
  1016. for(i = 0; i < size; i++)
  1017. Buffer[i] = *p++;
  1018. /*
  1019. ** Pass back data/program destination address
  1020. */
  1021. *Dest = data ? img_hdr->page[Page].d_dest : img_hdr->page[Page].p_dest;
  1022. return size;
  1023. }
  1024. MEI_ERROR meiCMV(u16 * request, int reply) // write cmv to arc, if reply needed, wait for reply
  1025. {
  1026. MEI_ERROR meierror;
  1027. wait_queue_t wait;
  1028. cmv_reply=reply;
  1029. meierror = meiMailboxWrite(request, MSG_LENGTH);
  1030. if(meierror != MEI_SUCCESS){
  1031. #ifdef AMAZON_MEI_DEBUG_ON
  1032. printk("\n\n MailboxWrite Fail.");
  1033. #endif
  1034. return meierror;
  1035. }
  1036. else{
  1037. cmv_count++;
  1038. }
  1039. if(cmv_reply == NO_REPLY)
  1040. return MEI_SUCCESS;
  1041. init_waitqueue_entry(&wait, current);
  1042. add_wait_queue(&wait_queue_arcmsgav, &wait);
  1043. set_current_state(TASK_INTERRUPTIBLE);
  1044. // cmv_waiting=1;
  1045. if(arcmsgav==1){
  1046. set_current_state(TASK_RUNNING);
  1047. remove_wait_queue(&wait_queue_arcmsgav, &wait);
  1048. }
  1049. else{
  1050. schedule_timeout(CMV_TIMEOUT);
  1051. remove_wait_queue(&wait_queue_arcmsgav, &wait);
  1052. }
  1053. if(arcmsgav==0){//CMV_timeout
  1054. cmv_waiting=0;
  1055. arcmsgav=0;
  1056. #ifdef AMAZON_MEI_DEBUG_ON
  1057. printk("\nmeiCMV: MEI_MAILBOX_TIMEOUT\n");
  1058. #endif
  1059. return MEI_MAILBOX_TIMEOUT;
  1060. }
  1061. else{
  1062. arcmsgav=0;
  1063. reply_count++;
  1064. return MEI_SUCCESS;
  1065. }
  1066. }
  1067. //TODO, for loopback test
  1068. #ifdef DFE_LOOPBACK
  1069. #define mte_reg_base (0x4800*4+0x20000)
  1070. /* Iridia Registers Address Constants */
  1071. #define MTE_Reg(r) (int)(mte_reg_base + (r*4))
  1072. #define IT_AMODE MTE_Reg(0x0004)
  1073. #define OMBOX_BASE 0x15F80
  1074. #define IMBOX_BASE 0x15FC0
  1075. #define TIMER_DELAY (1024)
  1076. #define BC0_BYTES (32)
  1077. #define BC1_BYTES (30)
  1078. #define NUM_MB (12)
  1079. #define TIMEOUT_VALUE 2000
  1080. void BFMWait (u32 cycle) {
  1081. u32 i;
  1082. for (i = 0 ; i< cycle ; i++);
  1083. }
  1084. void WriteRegLong(u32 addr, u32 data){
  1085. //printk("[%8x] <= %8x \n\n", addr, data);
  1086. *((volatile u32 *)(addr)) = data;
  1087. }
  1088. u32 ReadRegLong (u32 addr) {
  1089. u32 rd_val;
  1090. rd_val = *((volatile u32 *)(addr));
  1091. //printk("[%8x] => %8x \n\n", addr, rd_val);
  1092. return rd_val;
  1093. }
  1094. /* This routine writes the mailbox with the data in an input array */
  1095. void WriteMbox(u32 *mboxarray,u32 size) {
  1096. u32 i;
  1097. WriteRegLong(MEI_XFR_ADDR,IMBOX_BASE);
  1098. for (i=0;i<size;i++) {
  1099. WriteRegLong(MEI_DATA_XFR,*(mboxarray+i));
  1100. }
  1101. }
  1102. /* This routine reads the output mailbox and places the results into an array */
  1103. void ReadMbox(u32 *mboxarray,u32 size) {
  1104. u32 i;
  1105. WriteRegLong(MEI_XFR_ADDR,OMBOX_BASE);
  1106. for (i=0;i<size;i++) {
  1107. mboxarray[i] = ReadRegLong(MEI_DATA_XFR);
  1108. }
  1109. }
  1110. void MEIWriteARCValue(u32 address, u32 value)
  1111. {
  1112. u32 i,check = 0;
  1113. /* Write address register */
  1114. *((volatile u32 *)MEI_DEBUG_WAD) = address;
  1115. /* Write data register */
  1116. *((volatile u32 *)MEI_DEBUG_DATA) = value;
  1117. /* wait until complete - timeout at 40*/
  1118. for (i=0;i<40;i++) {
  1119. check = *((volatile u32 *)ARC_TO_MEI_INT);
  1120. if ((check & 0x20)) break;
  1121. //printk("MEIWriteARCValue: check:%8x\n\n", check);
  1122. }
  1123. /* clear the flag */
  1124. *((volatile u32 *)ARC_TO_MEI_INT) = 0x20;
  1125. }
  1126. void post_mei_init(void)
  1127. {
  1128. u32 mailbox[NUM_MB];
  1129. mailbox[0] = TIMER_DELAY;
  1130. /* set bytes per bearer channel */
  1131. mailbox[1] = BC0_BYTES;
  1132. mailbox[2] = BC1_BYTES;
  1133. WriteMbox(mailbox, 3);
  1134. WriteRegLong(AAI_ACCESS, 0x00000001);
  1135. /* enable ADSL block clock, ac_clk */
  1136. WriteRegLong(MEI_CONTROL, 0x01);
  1137. WriteRegLong(MEI_DEBUG_DEC, 0x00000001); // select ld/st space
  1138. MEIWriteARCValue(0x31F00, 0x00000010); // write CRI_CCR0 to enable ac_clk
  1139. /* set the MTE to register start */
  1140. MEIWriteARCValue(IT_AMODE, 0xF);
  1141. BFMWait(10);
  1142. }
  1143. int wait_sync(void)
  1144. {
  1145. u32 mailbox[NUM_MB];
  1146. /* wait for ATM sync to be achieved on both BC0 and BC1 */
  1147. u32 timeout=0;
  1148. ReadMbox(mailbox, 1);
  1149. u32 readval = mailbox[0];
  1150. while( ((readval & 0xFFFFFFFF) == 0) && (timeout < TIMEOUT_VALUE) ) {
  1151. BFMWait(1);
  1152. //printk("wait_sync\n\n");
  1153. ReadMbox(mailbox, 1);
  1154. readval = mailbox[0];
  1155. timeout++;
  1156. }
  1157. if(timeout == TIMEOUT_VALUE)return 0;
  1158. else return 1;
  1159. }
  1160. #endif //DFE_LOOPBACK
  1161. //end of TODO, for loopback test
  1162. MEI_ERROR meiForceRebootAdslModem(void)
  1163. {
  1164. #if 0
  1165. //#ifdef ARC_READY_ACK
  1166. if(down_interruptible(&mei_sema)) //disable CMV access until ARC ready
  1167. {
  1168. return -ERESTARTSYS;
  1169. }
  1170. #endif
  1171. if(reboot_firsttime==1){//000002:fchang Start
  1172. // reset ARC
  1173. *((volatile u32 *)0xB0100910) = 0x80; //reset DFE
  1174. asm("SYNC");
  1175. *((volatile u32 *)0xB0100910) = 0x0;
  1176. asm("SYNC");
  1177. if((*((volatile u32 *)0xB0100910))!=0x0)
  1178. #ifdef AMAZON_MEI_DEBUG_ON
  1179. printk("\n reset DFE fail");
  1180. #endif
  1181. // reset ARC
  1182. meiLongwordWrite(MEI_CONTROL, SOFT_RESET);
  1183. asm("SYNC");
  1184. meiLongwordWrite(MEI_CONTROL, 0);
  1185. asm("SYNC");
  1186. } //000002:fchang End
  1187. #ifdef DFE_LOOPBACK
  1188. img_hdr=(ARC_IMG_HDR *)lp_image;
  1189. #else
  1190. img_hdr=(ARC_IMG_HDR *)image_buffer;
  1191. #endif
  1192. // printk("\n\n enter haltarc");
  1193. meiHaltArc();
  1194. // printk("\n\n haltarc done");
  1195. //000002:fchang Start
  1196. if(reboot_firsttime==0){
  1197. printk("\n\n new reboot");
  1198. meiResetArc();
  1199. meiResetCore();
  1200. }
  1201. if(reboot_firsttime==1)
  1202. meiDownloadBootCode();
  1203. else
  1204. mei_ioctl((struct inode *)NULL, (struct file *)NULL, AMAZON_MEI_DOWNLOAD, (unsigned long)NULL);
  1205. //000002:fchang End
  1206. #ifdef AMAZON_MEI_DEBUG_ON
  1207. // printk("\n\n Download Done");
  1208. #endif
  1209. #ifdef DFE_LOOPBACK
  1210. post_mei_init();
  1211. #endif
  1212. // sema_init(&mei_sema, 1);
  1213. //up(&mei_sema);
  1214. // enable_irq(AMAZON_MEI_INT);
  1215. meiRunArc();
  1216. //000002:fchang Start
  1217. if(reboot_firsttime==0){
  1218. meiEnalbeMailboxInt();
  1219. }
  1220. //000002:fchang End
  1221. #ifdef AMAZON_MEI_DEBUG_ON
  1222. // printk("\n\n ARC Running");
  1223. #endif
  1224. #ifdef AMAZON_MEI_DEBUG_ON //to test ac_clk setting correctness
  1225. {
  1226. u32 arc_control_mode;
  1227. u32 arc_debug_addr = 0x31F00;
  1228. u32 arc_debug_data = 0x10;
  1229. meiLongwordRead(MEI_CONTROL, &arc_control_mode);
  1230. arc_control_mode |= (HOST_MSTR);
  1231. meiLongwordWrite(MEI_CONTROL, arc_control_mode);
  1232. meiLongwordWrite(MEI_DEBUG_DEC, MEI_DEBUG_DEC_DMP1_MASK);
  1233. meiLongwordWrite(MEI_DEBUG_RAD, arc_debug_addr);
  1234. meiPollForDbgDone();
  1235. meiLongwordRead(MEI_DEBUG_DATA, &arc_debug_data);
  1236. meiLongwordRead(MEI_CONTROL, &arc_control_mode);
  1237. arc_control_mode &= ~(HOST_MSTR);
  1238. meiLongwordWrite(MEI_CONTROL, arc_control_mode);
  1239. // printk("\n\n ac_clk is %8x\n", arc_debug_data);
  1240. }
  1241. #endif
  1242. #ifdef DFE_LOOPBACK
  1243. if (wait_sync() == 0){
  1244. printk("ARC fails to run: time out\n\n");
  1245. }else{
  1246. // printk("ARC is ready\n\n");
  1247. }
  1248. #endif
  1249. if(reboot_firsttime==1) //000002:fchang
  1250. reboot_firsttime=0; //000002:fchang
  1251. return MEI_SUCCESS;
  1252. }
  1253. //////////////////// procfs debug ////////////////////////////////////////////////////////
  1254. #define MEI_DIRNAME "mei"
  1255. static struct proc_dir_entry *meidir;
  1256. static ssize_t proc_write(struct file *, const char *, size_t, loff_t *);
  1257. static ssize_t proc_read(struct file *, char *, size_t, loff_t *);
  1258. static struct file_operations proc_operations = {
  1259. read: proc_read,
  1260. write: proc_write,
  1261. };
  1262. typedef struct reg_entry {
  1263. int * flag;
  1264. char name[30]; // big enough to hold names
  1265. char description[100]; // big enough to hold description
  1266. unsigned short low_ino;
  1267. } reg_entry_t;
  1268. static reg_entry_t regs[PROC_ITEMS]; // total items to be monitored by /proc/mei
  1269. #define NUM_OF_REG_ENTRY (sizeof(regs)/sizeof(reg_entry_t))
  1270. static int proc_read(struct file * file, char * buf, size_t nbytes, loff_t *ppos)
  1271. {
  1272. int i_ino = (file->f_dentry->d_inode)->i_ino;
  1273. char outputbuf[64];
  1274. int count=0;
  1275. int i;
  1276. u32 version=0;
  1277. reg_entry_t* current_reg=NULL;
  1278. for (i=0;i<NUM_OF_REG_ENTRY;i++) {
  1279. if (regs[i].low_ino==i_ino) {
  1280. current_reg = &regs[i];
  1281. break;
  1282. }
  1283. }
  1284. if (current_reg==NULL)
  1285. return -EINVAL;
  1286. if (current_reg->flag == (int *) 8){
  1287. ///proc/mei/version
  1288. //format:
  1289. //Firmware version: major.minor.sub_version.int_version.rel_state.spl_appl
  1290. //Firmware Date Time Code: date/month min:hour
  1291. if (*ppos>0) /* Assume reading completed in previous read*/
  1292. return 0; // indicates end of file
  1293. if(down_interruptible(&mei_sema))
  1294. return -ERESTARTSYS;
  1295. //if (indicator_count != 1){
  1296. if (indicator_count < 1){
  1297. up(&mei_sema);
  1298. return -EAGAIN;
  1299. }
  1300. //major:bits 0-7
  1301. //minor:bits 8-15
  1302. makeCMV(H2D_CMV_READ, INFO, 54, 0, 1, NULL);
  1303. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1304. #if 0
  1305. #ifdef AMAZON_MEI_DEBUG_ON
  1306. printk("\n\n WINHOST CMV fail");
  1307. #endif
  1308. #endif
  1309. up(&mei_sema);
  1310. return -EIO;
  1311. }
  1312. version = RxMessage[4];
  1313. count = sprintf(outputbuf, "%d.%d.",(version)&0xff,(version>>8)&0xff);
  1314. //sub_version:bits 4-7
  1315. //int_version:bits 0-3
  1316. //spl_appl:bits 8-13
  1317. //rel_state:bits 14-15
  1318. makeCMV(H2D_CMV_READ, INFO, 54, 1, 1, NULL);
  1319. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1320. #if 0
  1321. #ifdef AMAZON_MEI_DEBUG_ON
  1322. printk("\n\n WINHOST CMV fail");
  1323. #endif
  1324. #endif
  1325. up(&mei_sema);
  1326. return -EFAULT;
  1327. }
  1328. version =RxMessage[4];
  1329. count += sprintf(outputbuf+count, "%d.%d.%d.%d",
  1330. (version>>4)&0xf,
  1331. version&0xf,
  1332. (version>>14)&0x3,
  1333. (version>>8)&0x3f);
  1334. #ifdef ADSL_LED_SUPPORT
  1335. // version check -start for adsl led
  1336. if ((((version>>4)&0xf)==2)&&((version&0xf)>=3)&&((version&0xf)<7)) firmware_support_led=1;
  1337. else if ((((version>>4)&0xf)==2)&&((version&0xf)>=7)) firmware_support_led=2;
  1338. else if (((version>>4)&0xf)>2) firmware_support_led=2;
  1339. //165001:henryhsu:20050906:Modify for adsl firmware version 1.2.1.2.0.1 DATA_LED can't flash.
  1340. //else firmware_support_led=0;
  1341. else firmware_support_led=2;
  1342. //165001
  1343. // version check -end
  1344. #endif
  1345. //Date:bits 0-7
  1346. //Month:bits 8-15
  1347. makeCMV(H2D_CMV_READ, INFO, 55, 0, 1, NULL);
  1348. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1349. #if 0
  1350. #ifdef AMAZON_MEI_DEBUG_ON
  1351. printk("\n\n WINHOST CMV fail");
  1352. #endif
  1353. #endif
  1354. up(&mei_sema);
  1355. return -EIO;
  1356. }
  1357. version = RxMessage[4];
  1358. //Hour:bits 0-7
  1359. //Minute:bits 8-15
  1360. makeCMV(H2D_CMV_READ, INFO, 55, 1, 1, NULL);
  1361. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1362. #if 0
  1363. #ifdef AMAZON_MEI_DEBUG_ON
  1364. printk("\n\n WINHOST CMV fail");
  1365. #endif
  1366. #endif
  1367. up(&mei_sema);
  1368. return -EFAULT;
  1369. }
  1370. version += (RxMessage[4]<<16);
  1371. count += sprintf(outputbuf+count, " %d/%d %d:%d\n"
  1372. ,version&0xff
  1373. ,(version>>8)&0xff
  1374. ,(version>>25)&0xff
  1375. ,(version>>16)&0xff);
  1376. up(&mei_sema);
  1377. *ppos+=count;
  1378. }else if(current_reg->flag != (int *)Recent_indicator){
  1379. if (*ppos>0) /* Assume reading completed in previous read*/
  1380. return 0; // indicates end of file
  1381. count = sprintf(outputbuf, "0x%08X\n\n", *(current_reg->flag));
  1382. *ppos+=count;
  1383. if (count>nbytes) /* Assume output can be read at one time */
  1384. return -EINVAL;
  1385. }else{
  1386. if((int)(*ppos)/((int)7)==16)
  1387. return 0; // indicate end of the message
  1388. count = sprintf(outputbuf, "0x%04X\n\n", *(((u16 *)(current_reg->flag))+ (int)(*ppos)/((int)7)));
  1389. *ppos+=count;
  1390. }
  1391. if (copy_to_user(buf, outputbuf, count))
  1392. return -EFAULT;
  1393. return count;
  1394. }
  1395. static ssize_t proc_write(struct file * file, const char * buffer, size_t count, loff_t *ppos)
  1396. {
  1397. int i_ino = (file->f_dentry->d_inode)->i_ino;
  1398. reg_entry_t* current_reg=NULL;
  1399. int i;
  1400. unsigned long newRegValue;
  1401. char *endp;
  1402. for (i=0;i<NUM_OF_REG_ENTRY;i++) {
  1403. if (regs[i].low_ino==i_ino) {
  1404. current_reg = &regs[i];
  1405. break;
  1406. }
  1407. }
  1408. if ((current_reg==NULL) || (current_reg->flag == (int *)Recent_indicator))
  1409. return -EINVAL;
  1410. newRegValue = simple_strtoul(buffer,&endp,0);
  1411. *(current_reg->flag)=(int)newRegValue;
  1412. return (count+endp-buffer);
  1413. }
  1414. ////////////////makeCMV(Opcode, Group, Address, Index, Size, Data), CMV in u16 TxMessage[MSG_LENGTH]///////////////////////////
  1415. void makeCMV(u8 opcode, u8 group, u16 address, u16 index, int size, u16 * data)
  1416. {
  1417. memset(TxMessage, 0, MSG_LENGTH*2);
  1418. TxMessage[0]= (opcode<<4) + (size&0xf);
  1419. TxMessage[1]= (((index==0)?0:1)<<7) + (group&0x7f);
  1420. TxMessage[2]= address;
  1421. TxMessage[3]= index;
  1422. if(opcode == H2D_CMV_WRITE)
  1423. memcpy(TxMessage+4, data, size*2);
  1424. return;
  1425. }
  1426. ////////////////makeCMV(Opcode, Group, Address, Index, Size, Data), CMV in u16 TxMessage[MSG_LENGTH]///////////////////////////
  1427. void makeCMV_local(u8 opcode, u8 group, u16 address, u16 index, int size, u16 * data,u16 *CMVMSG)
  1428. {
  1429. memset(CMVMSG, 0, MSG_LENGTH*2);
  1430. CMVMSG[0]= (opcode<<4) + (size&0xf);
  1431. CMVMSG[1]= (((index==0)?0:1)<<7) + (group&0x7f);
  1432. CMVMSG[2]= address;
  1433. CMVMSG[3]= index;
  1434. if(opcode == H2D_CMV_WRITE)
  1435. memcpy(CMVMSG+4, data, size*2);
  1436. return;
  1437. }
  1438. //////////////// Driver Structure /////////////////////////////////////////////////////////////////////////////
  1439. static ssize_t mei_write(struct file *, const char *, size_t, loff_t *);
  1440. static int mei_ioctl(struct inode *, struct file *, unsigned int, unsigned long);
  1441. static struct file_operations mei_operations = {
  1442. write: mei_write,
  1443. ioctl: mei_ioctl,
  1444. };
  1445. static ssize_t mei_write(struct file * filp, const char * buf, size_t size, loff_t * loff)
  1446. {
  1447. // printk("\n\n mei_write entered");
  1448. // image_buffer = (u32 *)kmalloc(size, GFP_KERNEL);
  1449. image_buffer = (u32 *)vmalloc(size);
  1450. // printk("\n\n image_buffer kmalloc done");
  1451. if(image_buffer == NULL){
  1452. #ifdef AMAZON_MEI_DEBUG_ON
  1453. // printk("\n\n kmalloc for firmware image fail");
  1454. printk("\n\n vmalloc for firmware image fail");
  1455. #endif
  1456. return -1;
  1457. }
  1458. copy_from_user((char *)image_buffer, buf, size);
  1459. // printk("\n\n copy_from_user done");
  1460. return size;
  1461. }
  1462. ////////// ISR GPTU Timer 6 for high resolution timer /////////////
  1463. void amazon_timer6_interrupt_MEI(int irq, void *dev_id, struct pt_regs *regs)
  1464. {
  1465. int i,j;
  1466. u32 temp;
  1467. u16 temp16;
  1468. u16 rdindex, wrindex;
  1469. u16 num_rd=0; //num of byte can be read
  1470. u16 bytes_to_wr=0;
  1471. // printk("\n\nenter timer\n\n");
  1472. irqtimes++;
  1473. // printk("\n%d\n",irqtimes);
  1474. /*
  1475. #ifdef PCM_ACCESS_DEBUG
  1476. meiDebugRead_8(0x30f20, &temp, 1);
  1477. #else
  1478. meiDMARead_8(0x30f20, &temp, 1);
  1479. #endif
  1480. if((temp&0x4000)!=0){
  1481. printk("\nER_ERR");
  1482. #ifdef PCM_ACCESS_DEBUG
  1483. meiDebugWrite_8(0x30f20, &temp, 1);
  1484. #else
  1485. meiDMAWrite_8(0x30f20, &temp, 1);
  1486. #endif
  1487. #ifdef PCM_ACCESS_DEBUG
  1488. meiDebugRead_8(0x30f20, &temp, 1);
  1489. #else
  1490. meiDMARead_8(0x30f20, &temp, 1);
  1491. #endif
  1492. if((temp&0x4000)!=0)
  1493. printk("\nER_ERR not cleared");
  1494. }
  1495. */
  1496. for(i=PCM_CHANNEL_NUM-1;i>=0;i--){// start from last channel, which is rx
  1497. #ifdef PCM_ACCESS_DEBUG
  1498. meiDebugRead_16(pcm_start_addr+i*16+12, &temp, 1);
  1499. #else
  1500. meiDMARead_16(pcm_start_addr+i*16+12, &temp, 1);
  1501. #endif
  1502. wrindex = (u16)((temp & 0xffff0000)>>16);
  1503. // printk(" %d",wrindex);
  1504. #ifdef PCM_ACCESS_DEBUG
  1505. meiDebugRead_16(pcm_start_addr+i*16+8, &temp, 1);
  1506. #else
  1507. meiDMARead_16(pcm_start_addr+i*16+8, &temp, 1);
  1508. #endif
  1509. rdindex = (u16)(temp & 0xffff);
  1510. // printk(" %d",rdindex);
  1511. if(rdindex<=wrindex)
  1512. num_rd=((wrindex-rdindex)/4)*4; //read multiply of 4 bytes
  1513. else
  1514. num_rd=((pcm_data[i].len-(rdindex-wrindex))/4)*4; //read multiply of 4 bytes
  1515. if(i%2!=0){//rx channel
  1516. pcm_data[i].point=0;
  1517. for(j=0;j<num_rd/4;j++){
  1518. if(pcm_data[i].finish!=1){
  1519. if((rdindex+j*4)>=pcm_data[i].len)
  1520. temp16=(rdindex+j*4) - pcm_data[i].len;
  1521. else
  1522. temp16=rdindex+j*4;
  1523. #ifdef PCM_ACCESS_DEBUG
  1524. meiDebugRead_8((((u32)(pcm_data[i].LSW))+(((u32)(pcm_data[i].MSW))<<16))+temp16, (u32*)(pcm_data[i].buff+pcm_data[i].point), 1);
  1525. #else
  1526. meiDMARead_8((((u32)(pcm_data[i].LSW))+(((u32)(pcm_data[i].MSW))<<16))+temp16, (u32*)(pcm_data[i].buff+pcm_data[i].point), 1);
  1527. #endif
  1528. // printk(" %8x", *((u32*)(pcm_data[i].buff+pcm_data[i].point)));
  1529. /* if(pcm_data[i].point==0){
  1530. if(pcm_data[i].buff[0]==0xA5){// start of loopback data
  1531. pcm_data[i].point+=4;
  1532. printk("\nstart receive data");
  1533. }
  1534. }
  1535. else*/
  1536. pcm_data[i].point+=4;
  1537. /* if(pcm_data[i].point==PCM_BUFF_SIZE){ //finish rx
  1538. pcm_data[i].finish=1;
  1539. printk("\nchannel[%d] finished", i);
  1540. } */
  1541. }
  1542. }
  1543. if(firsttime[i]==1){
  1544. for(j=0;j<num_rd;j++){
  1545. if(pcm_data[i].buff[j]==0x1){
  1546. num_cmp[i]=num_rd-j;
  1547. firsttime[i]=0;
  1548. break;
  1549. }
  1550. }
  1551. if(memcmp(sampledata+1, pcm_data[i].buff+j, num_cmp[i])!=0)
  1552. printk("\n\ndata wrong,1st\n\n");
  1553. else
  1554. pcm_start_loc[i] = num_cmp[i]+1;
  1555. }
  1556. else{
  1557. if(memcmp(sampledata+pcm_start_loc[i], pcm_data[i].buff, num_rd)!=0)
  1558. printk("\n\ndata wrong\n\n");
  1559. else{
  1560. pcm_start_loc[i]+=num_rd;
  1561. if(pcm_start_loc[i]>=256)
  1562. pcm_start_loc[i]=pcm_start_loc[i]-256;
  1563. }
  1564. }
  1565. rdindex +=num_rd;
  1566. if(rdindex>=pcm_data[i].len)
  1567. rdindex=rdindex-pcm_data[i].len;
  1568. #ifdef PCM_ACCESS_DEBUG
  1569. meiDebugRead_16(pcm_start_addr+i*16+8, &temp, 1);
  1570. #else
  1571. meiDMARead_16(pcm_start_addr+i*16+8, &temp, 1);
  1572. #endif
  1573. temp= (temp & 0xffff0000) + rdindex;
  1574. #ifdef PCM_ACCESS_DEBUG
  1575. meiDebugWrite_16(pcm_start_addr+i*16+8, &temp, 1); // update rdindex
  1576. #else
  1577. meiDMAWrite_16(pcm_start_addr+i*16+8, &temp, 1); // update rdindex
  1578. #endif
  1579. bytes_to_wr = num_rd;
  1580. // if(bytes_to_wr>0){
  1581. // printk(" %d", num_rd);
  1582. // printk(" %d", rdindex);
  1583. // printk("\n\nrdindex = %d", rdindex);
  1584. //}
  1585. }
  1586. else{ //tx channel
  1587. // if((bytes_to_wr + num_rd) < pcm_data[i].len){
  1588. for(j=0;j<bytes_to_wr/4;j++){
  1589. if(pcm_data[i].finish!=1){
  1590. if((wrindex+j*4)>=pcm_data[i].len)
  1591. temp16=(wrindex+j*4) - pcm_data[i].len;
  1592. else
  1593. temp16=wrindex + j*4;
  1594. /*
  1595. #ifdef PCM_ACCESS_DEBUG
  1596. meiDebugWrite_8((((u32)(pcm_data[i].LSW))+(((u32)(pcm_data[i].MSW))<<16))+temp16,(u32*)(pcm_data[i+1].buff+j*4), 1);
  1597. #else
  1598. meiDMAWrite_8((((u32)(pcm_data[i].LSW))+(((u32)(pcm_data[i].MSW))<<16))+temp16,(u32*)(pcm_data[i+1].buff+j*4), 1);
  1599. #endif*/
  1600. #ifdef PCM_ACCESS_DEBUG
  1601. meiDebugWrite_8((((u32)(pcm_data[i].LSW))+(((u32)(pcm_data[i].MSW))<<16))+temp16,(u32*)(pcm_data[i].buff+pcm_data[i].point), 1);
  1602. // meiDebugWrite_8((((u32)(pcm_data[i].LSW))+(((u32)(pcm_data[i].MSW))<<16))+temp16,(u32*)(pcm_data[i].buff), 1);
  1603. #else
  1604. meiDMAWrite_8((((u32)(pcm_data[i].LSW))+(((u32)(pcm_data[i].MSW))<<16))+temp16,(u32*)(pcm_data[i].buff+pcm_data[i].point), 1);
  1605. #endif
  1606. pcm_data[i].point+=4;
  1607. if(pcm_data[i].point==PCM_BUFF_SIZE){
  1608. // pcm_data[i].finish=1;
  1609. // printk("\nchannel[%d] finished", i);
  1610. pcm_data[i].point=0;
  1611. }
  1612. }
  1613. }
  1614. wrindex+=bytes_to_wr;
  1615. if(wrindex>=pcm_data[i].len)
  1616. wrindex=wrindex-pcm_data[i].len;
  1617. #ifdef PCM_ACCESS_DEBUG
  1618. meiDebugRead_16(pcm_start_addr+i*16+12, &temp, 1);
  1619. #else
  1620. meiDMARead_16(pcm_start_addr+i*16+12, &temp, 1);
  1621. #endif
  1622. temp=(temp&0xffff) + (wrindex<<16);
  1623. #ifdef PCM_ACCESS_DEBUG
  1624. meiDebugWrite_16(pcm_start_addr+i*16+12, &temp, 1); // update wrindex
  1625. #else
  1626. meiDMAWrite_16(pcm_start_addr+i*16+12, &temp, 1); // update wrindex
  1627. #endif
  1628. //if(bytes_to_wr>0){
  1629. // printk(" %d", bytes_to_wr);
  1630. // printk(" %d", wrindex);
  1631. // printk("\n\nwrindex = %d", wrindex);
  1632. //}
  1633. // }
  1634. }
  1635. }
  1636. return;
  1637. }
  1638. //000002:fchang Start
  1639. static int meiResetArc(void)
  1640. {
  1641. u32 auxreg0;
  1642. u32 auxreg5;
  1643. int flshcnt=0;
  1644. int flshcnt1=0;
  1645. int flshcnt2=0;
  1646. meiLongwordWrite(MEI_CONTROL, 1);
  1647. meiLongwordWrite(MEI_DEBUG_DEC, 3);
  1648. meiLongwordWrite(MEI_DEBUG_WAD, 0x3c);
  1649. meiLongwordWrite(MEI_DEBUG_DATA, 0x10);
  1650. meiPollForDbgDone();
  1651. meiLongwordWrite(MEI_DEBUG_DEC, 0x0);
  1652. meiLongwordWrite(MEI_DEBUG_WAD, 0x2);
  1653. meiLongwordWrite(MEI_DEBUG_DATA, 0x0);
  1654. meiPollForDbgDone();
  1655. meiLongwordWrite(MEI_DEBUG_WAD, 0x3);
  1656. meiLongwordWrite(MEI_DEBUG_DATA, 0x0);
  1657. meiPollForDbgDone();
  1658. meiLongwordWrite(MEI_DEBUG_DEC, 0x0);
  1659. meiLongwordWrite(MEI_DEBUG_RAD, 0x0);
  1660. meiPollForDbgDone();
  1661. meiLongwordRead(MEI_DEBUG_DATA, &auxreg0);
  1662. auxreg0 = auxreg0 & 0x03ffffff;
  1663. meiLongwordWrite(MEI_DEBUG_WAD, 0x0);
  1664. meiLongwordWrite(MEI_DEBUG_DATA, auxreg0);
  1665. meiPollForDbgDone();
  1666. meiLongwordWrite(MEI_DEBUG_WAD, 0x10a);
  1667. meiLongwordWrite(MEI_DEBUG_DATA, 0x0);
  1668. meiPollForDbgDone();
  1669. meiLongwordWrite(MEI_DEBUG_DEC, 0x2);
  1670. meiLongwordWrite(MEI_DEBUG_WAD, 0xfffc);
  1671. meiLongwordWrite(MEI_DEBUG_DATA, 0x1fffffff);
  1672. meiPollForDbgDone();
  1673. while(flshcnt<3){
  1674. meiLongwordWrite(MEI_DEBUG_DEC, 0x0);
  1675. meiLongwordWrite(MEI_DEBUG_RAD, 0x0);
  1676. meiPollForDbgDone();
  1677. meiLongwordRead(MEI_DEBUG_DATA, &auxreg0);
  1678. auxreg0 = auxreg0 & 0xff000000;
  1679. auxreg0 = auxreg0 | 0x3fff;
  1680. meiLongwordWrite(MEI_DEBUG_WAD, 0x0);
  1681. meiLongwordWrite(MEI_DEBUG_DATA, auxreg0);
  1682. meiPollForDbgDone();
  1683. meiLongwordWrite(MEI_DEBUG_DEC, 0x0);
  1684. meiLongwordWrite(MEI_DEBUG_RAD, 0x5);
  1685. meiPollForDbgDone();
  1686. meiLongwordRead(MEI_DEBUG_DATA, &auxreg5);
  1687. auxreg5 = auxreg5 | 0x801;
  1688. meiLongwordWrite(MEI_DEBUG_WAD, 0x5);
  1689. meiLongwordWrite(MEI_DEBUG_DATA, auxreg5);
  1690. meiPollForDbgDone();
  1691. meiLongwordWrite(MEI_DEBUG_RAD, 0x0);
  1692. meiPollForDbgDone();
  1693. meiLongwordRead(MEI_DEBUG_DATA, &auxreg0);
  1694. auxreg0 = auxreg0 & 0x00ffffff;
  1695. if(auxreg0 == 0x4000)
  1696. flshcnt = flshcnt+1;
  1697. else{
  1698. if(flshcnt == 0)
  1699. flshcnt1 = flshcnt1 +1;
  1700. else
  1701. flshcnt2 = flshcnt2 +1;
  1702. }
  1703. }
  1704. return 1;
  1705. }
  1706. static int meiResetCore(void)
  1707. {
  1708. meiLongwordWrite(MEI_CONTROL, 0x1);
  1709. meiLongwordWrite(MEI_DEBUG_DEC, 0x2);
  1710. meiLongwordWrite(MEI_DEBUG_WAD, 0x31f10);
  1711. meiLongwordWrite(MEI_DEBUG_DATA, 0xf);
  1712. meiPollForDbgDone();
  1713. meiLongwordWrite(MEI_DEBUG_WAD, 0x31f10);
  1714. meiLongwordWrite(MEI_DEBUG_DATA, 0x0);
  1715. meiPollForDbgDone();
  1716. meiLongwordWrite(MEI_DEBUG_WAD, 0x31f00);
  1717. meiLongwordWrite(MEI_DEBUG_DATA, 0x55);
  1718. meiPollForDbgDone();
  1719. return 1;
  1720. }
  1721. static int meiEnalbeMailboxInt(void)
  1722. {
  1723. u32 arc2meiintmsk;
  1724. meiLongwordRead(ARC_TO_MEI_INT_MASK, &arc2meiintmsk);
  1725. arc2meiintmsk = arc2meiintmsk | 0x1;
  1726. meiLongwordWrite(ARC_TO_MEI_INT_MASK, arc2meiintmsk);
  1727. meiLongwordWrite(MEI_CONTROL, 0x0);
  1728. return 1;
  1729. }
  1730. //000002:fchang End
  1731. static int mei_ioctl(struct inode * ino, struct file * fil, unsigned int command, unsigned long lon)
  1732. {
  1733. int i,k;
  1734. u32 boot_loop;
  1735. u32 page_size;
  1736. u32 dest_addr;
  1737. u32 j;
  1738. u32 temp;
  1739. u32 temp2;
  1740. u16 trapsflag=0;
  1741. amazon_clreoc_pkt * current_clreoc;
  1742. struct timeval time_now;
  1743. struct timeval time_fini;
  1744. struct list_head * ptr;
  1745. amazon_mei_mib * mib_ptr;
  1746. // u16 buff[MSG_LENGTH]__attribute__ ((aligned(4)));
  1747. structpts pts;
  1748. int meierr=MEI_SUCCESS;
  1749. u16 data[12]; //used in makeCMV, to pass in payload when CMV set, ignored when CMV read.
  1750. meireg regrdwr;
  1751. meidebug debugrdwr;
  1752. amazon_mei_mib * temp_intvl;
  1753. struct sk_buff * eoc_skb;
  1754. // 603221:tc.chen start
  1755. u16 hdlc_cmd[2];
  1756. u16 hdlc_rx_buffer[32];
  1757. int hdlc_rx_len=0;
  1758. // 603221:tc.chen end
  1759. int from_kernel = 0;//joelin
  1760. if (ino == (struct inode *)0) from_kernel = 1;//joelin
  1761. // printk("\n switch.command = %i\n", command);
  1762. switch(command){
  1763. case GET_ADSL_LINE_CODE:
  1764. pts.adslLineTableEntry_pt = (adslLineTableEntry *)kmalloc(sizeof(adslLineTableEntry), GFP_KERNEL);
  1765. copy_from_user((char *)pts.adslLineTableEntry_pt, (char *)lon, sizeof(adslLineTableEntry));
  1766. if(IS_FLAG_SET((&(pts.adslLineTableEntry_pt->flags)), LINE_CODE_FLAG)){
  1767. pts.adslLineTableEntry_pt->adslLineCode = 2;
  1768. }
  1769. copy_to_user((char *)lon, (char *)pts.adslLineTableEntry_pt, sizeof(adslLineTableEntry));
  1770. kfree(pts.adslLineTableEntry_pt);
  1771. break;
  1772. #ifdef AMAZON_MEI_MIB_RFC3440
  1773. case GET_ADSL_ATUC_LINE_EXT:
  1774. if(down_interruptible(&mei_sema))
  1775. return -ERESTARTSYS;
  1776. pts.adslLineExtTableEntry_pt = (adslLineExtTableEntry *)kmalloc(sizeof(adslLineExtTableEntry), GFP_KERNEL);
  1777. copy_from_user((char *)pts.adslLineExtTableEntry_pt, (char *)lon, sizeof(adslLineExtTableEntry));
  1778. if(IS_FLAG_SET((&(pts.adslLineExtTableEntry_pt->flags)), ATUC_LINE_TRANS_CAP_FLAG)){
  1779. ATUC_LINE_TRANS_CAP_FLAG_MAKECMV;
  1780. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1781. #ifdef AMAZON_MEI_DEBUG_ON
  1782. printk("\n\nCMV fail, Group 3 Address 67 Index 0");
  1783. #endif
  1784. CLR_FLAG((&(pts.adslLineExtTableEntry_pt->flags)), ATUC_LINE_TRANS_CAP_FLAG);
  1785. }
  1786. else{
  1787. memcpy((&(pts.adslLineExtTableEntry_pt->adslLineTransAtucCap)), RxMessage+4, ((RxMessage[0]&0xf)*2));
  1788. }
  1789. }
  1790. if(IS_FLAG_SET((&(pts.adslLineExtTableEntry_pt->flags)), ATUC_LINE_TRANS_CONFIG_FLAG)){
  1791. ATUC_LINE_TRANS_CONFIG_FLAG_MAKECMV;
  1792. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1793. #ifdef AMAZON_MEI_DEBUG_ON
  1794. printk("\n\nCMV fail, Group 3 Address 67 Index 0");
  1795. #endif
  1796. CLR_FLAG((&(pts.adslLineExtTableEntry_pt->flags)), ATUC_LINE_TRANS_CONFIG_FLAG);
  1797. }
  1798. else{
  1799. memcpy((&(pts.adslLineExtTableEntry_pt->adslLineTransAtucConfig)), RxMessage+4, ((RxMessage[0]&0xf)*2));
  1800. }
  1801. }
  1802. if(IS_FLAG_SET((&(pts.adslLineExtTableEntry_pt->flags)), ATUC_LINE_TRANS_ACTUAL_FLAG)){
  1803. ATUC_LINE_TRANS_ACTUAL_FLAG_MAKECMV;
  1804. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1805. #ifdef AMAZON_MEI_DEBUG_ON
  1806. printk("\n\nCMV fail, Group 2 Address 1 Index 0");
  1807. #endif
  1808. CLR_FLAG((&(pts.adslLineExtTableEntry_pt->flags)), ATUC_LINE_TRANS_ACTUAL_FLAG);
  1809. }
  1810. else{
  1811. memcpy((&(pts.adslLineExtTableEntry_pt->adslLineTransAtucActual)), RxMessage+4, ((RxMessage[0]&0xf)*2));
  1812. }
  1813. }
  1814. if(IS_FLAG_SET((&(pts.adslLineExtTableEntry_pt->flags)), LINE_GLITE_POWER_STATE_FLAG)){ // not supported currently
  1815. /*
  1816. LINE_GLITE_POWER_STATE_FLAG_MAKECMV;
  1817. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1818. #ifdef AMAZON_MEI_DEBUG_ON
  1819. printk("\n\nCMV fail, Group 2 Address 0 Index 0");
  1820. #endif
  1821. CLR_FLAG((&(pts.adslLineExtTableEntry_pt->flags)), LINE_GLITE_POWER_STATE_FLAG);
  1822. }
  1823. else{
  1824. memcpy((&(pts.adslLineExtTableEntry_pt->adslLineGlitePowerState)), RxMessage+4, ((RxMessage[0]&0xf)*2));
  1825. }
  1826. */
  1827. CLR_FLAG((&(pts.adslLineExtTableEntry_pt->flags)), LINE_GLITE_POWER_STATE_FLAG);
  1828. }
  1829. copy_to_user((char *)lon, (char *)pts.adslLineExtTableEntry_pt, sizeof(adslLineExtTableEntry));
  1830. kfree(pts.adslLineTableEntry_pt);
  1831. up(&mei_sema);
  1832. break;
  1833. #endif
  1834. #ifdef AMAZON_MEI_MIB_RFC3440
  1835. case SET_ADSL_ATUC_LINE_EXT:
  1836. if(down_interruptible(&mei_sema))
  1837. return -ERESTARTSYS;
  1838. pts.adslLineExtTableEntry_pt = (adslLineExtTableEntry *)kmalloc(sizeof(adslLineExtTableEntry), GFP_KERNEL);
  1839. copy_from_user((char *)pts.adslLineExtTableEntry_pt, (char *)lon, sizeof(adslLineExtTableEntry));
  1840. //only adslLineTransAtucConfig can be set.
  1841. CLR_FLAG((&(pts.adslLineExtTableEntry_pt->flags)), ATUC_LINE_TRANS_CAP_FLAG);
  1842. if(IS_FLAG_SET((&(pts.adslLineExtTableEntry_pt->flags)), ATUC_LINE_TRANS_CONFIG_FLAG)){
  1843. memcpy(data,(&(pts.adslLineExtTableEntry_pt->adslLineTransAtucConfig)), 2);
  1844. ATUC_LINE_TRANS_CONFIG_FLAG_MAKECMV_WR;
  1845. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1846. #ifdef AMAZON_MEI_DEBUG_ON
  1847. printk("\n\nCMV fail, Group 3 Address 67 Index 0");
  1848. #endif
  1849. CLR_FLAG((&(pts.adslLineExtTableEntry_pt->flags)), ATUC_LINE_TRANS_CONFIG_FLAG);
  1850. }
  1851. }
  1852. CLR_FLAG((&(pts.adslLineExtTableEntry_pt->flags)), ATUC_LINE_TRANS_ACTUAL_FLAG);
  1853. CLR_FLAG((&(pts.adslLineExtTableEntry_pt->flags)), LINE_GLITE_POWER_STATE_FLAG);
  1854. copy_to_user((char *)lon, (char *)pts.adslLineExtTableEntry_pt, sizeof(adslLineExtTableEntry));
  1855. kfree(pts.adslLineTableEntry_pt);
  1856. up(&mei_sema);
  1857. break;
  1858. #endif
  1859. case GET_ADSL_ATUC_PHY:
  1860. if(down_interruptible(&mei_sema))
  1861. return -ERESTARTSYS;
  1862. pts.adslAtucPhysEntry_pt = (adslAtucPhysEntry *)kmalloc(sizeof(adslAtucPhysEntry), GFP_KERNEL);
  1863. copy_from_user((char *)pts.adslAtucPhysEntry_pt, (char *)lon, sizeof(adslAtucPhysEntry));
  1864. if(IS_FLAG_SET((&(pts.adslAtucPhysEntry_pt->flags)), ATUC_PHY_SER_NUM_FLAG)){
  1865. ATUC_PHY_SER_NUM_FLAG_MAKECMV1;
  1866. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1867. #ifdef AMAZON_MEI_DEBUG_ON
  1868. printk("\n\nCMV fail, Group 3 Address 57 Index 0");
  1869. #endif
  1870. CLR_FLAG((&(pts.adslAtucPhysEntry_pt->flags)), ATUC_PHY_SER_NUM_FLAG);
  1871. }
  1872. else{
  1873. memcpy(pts.adslAtucPhysEntry_pt->serial_no, RxMessage+4, ((RxMessage[0]&0xf)*2));
  1874. }
  1875. ATUC_PHY_SER_NUM_FLAG_MAKECMV2;
  1876. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1877. #ifdef AMAZON_MEI_DEBUG_ON
  1878. printk("\n\nCMV fail, Group 3 Address 57 Index 12");
  1879. #endif
  1880. CLR_FLAG((&(pts.adslAtucPhysEntry_pt->flags)), ATUC_PHY_SER_NUM_FLAG);
  1881. }
  1882. else{
  1883. memcpy((pts.adslAtucPhysEntry_pt->serial_no+24), RxMessage+4, ((RxMessage[0]&0xf)*2));
  1884. }
  1885. }
  1886. if(IS_FLAG_SET((&(pts.adslAtucPhysEntry_pt->flags)), ATUC_PHY_VENDOR_ID_FLAG)){
  1887. ATUC_PHY_VENDOR_ID_FLAG_MAKECMV;
  1888. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1889. #ifdef AMAZON_MEI_DEBUG_ON
  1890. printk("\n\nCMV fail, Group 3 Address 64 Index 0");
  1891. #endif
  1892. CLR_FLAG((&(pts.adslAtucPhysEntry_pt->flags)), ATUC_PHY_VENDOR_ID_FLAG);
  1893. }
  1894. else{
  1895. memcpy(pts.adslAtucPhysEntry_pt->vendor_id.vendor_id, RxMessage+4, ((RxMessage[0]&0xf)*2));
  1896. }
  1897. }
  1898. if(IS_FLAG_SET((&(pts.adslAtucPhysEntry_pt->flags)), ATUC_PHY_VER_NUM_FLAG)){
  1899. ATUC_PHY_VER_NUM_FLAG_MAKECMV;
  1900. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1901. #ifdef AMAZON_MEI_DEBUG_ON
  1902. printk("\n\nCMV fail, Group 3 Address 58 Index 0");
  1903. #endif
  1904. CLR_FLAG((&(pts.adslAtucPhysEntry_pt->flags)), ATUC_PHY_VER_NUM_FLAG);
  1905. }
  1906. else{
  1907. memcpy(pts.adslAtucPhysEntry_pt->version_no, RxMessage+4, ((RxMessage[0]&0xf)*2));
  1908. }
  1909. }
  1910. if(IS_FLAG_SET((&(pts.adslAtucPhysEntry_pt->flags)), ATUC_CURR_STAT_FLAG)){
  1911. pts.adslAtucPhysEntry_pt->status = CurrStatus.adslAtucCurrStatus;
  1912. }
  1913. if(IS_FLAG_SET((&(pts.adslAtucPhysEntry_pt->flags)), ATUC_CURR_OUT_PWR_FLAG)){
  1914. ATUC_CURR_OUT_PWR_FLAG_MAKECMV;
  1915. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1916. #ifdef AMAZON_MEI_DEBUG_ON
  1917. printk("\n\nCMV fail, Group 3 Address 68 Index 5");
  1918. #endif
  1919. CLR_FLAG((&(pts.adslAtucPhysEntry_pt->flags)), ATUC_CURR_OUT_PWR_FLAG);
  1920. }
  1921. else{
  1922. memcpy((&(pts.adslAtucPhysEntry_pt->outputPwr)), RxMessage+4, ((RxMessage[0]&0xf)*2));
  1923. }
  1924. }
  1925. if(IS_FLAG_SET((&(pts.adslAtucPhysEntry_pt->flags)), ATUC_CURR_ATTR_FLAG)){
  1926. ATUC_CURR_ATTR_FLAG_MAKECMV;
  1927. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1928. #ifdef AMAZON_MEI_DEBUG_ON
  1929. printk("\n\nCMV fail, Group 3 Address 69 Index 0");
  1930. #endif
  1931. CLR_FLAG((&(pts.adslAtucPhysEntry_pt->flags)), ATUC_CURR_ATTR_FLAG);
  1932. }
  1933. else{
  1934. memcpy((&(pts.adslAtucPhysEntry_pt->attainableRate)), RxMessage+4, ((RxMessage[0]&0xf)*2));
  1935. }
  1936. }
  1937. copy_to_user((char *)lon, (char *)pts.adslAtucPhysEntry_pt, sizeof(adslAtucPhysEntry));
  1938. kfree(pts.adslAtucPhysEntry_pt);
  1939. up(&mei_sema);
  1940. break;
  1941. case GET_ADSL_ATUR_PHY:
  1942. if(down_interruptible(&mei_sema))
  1943. return -ERESTARTSYS;
  1944. pts.adslAturPhysEntry_pt = (adslAturPhysEntry *)kmalloc(sizeof(adslAturPhysEntry), GFP_KERNEL);
  1945. copy_from_user((char *)pts.adslAturPhysEntry_pt, (char *)lon, sizeof(adslAturPhysEntry));
  1946. if(IS_FLAG_SET((&(pts.adslAturPhysEntry_pt->flags)), ATUR_PHY_SER_NUM_FLAG)){
  1947. ATUR_PHY_SER_NUM_FLAG_MAKECMV1;
  1948. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1949. #ifdef AMAZON_MEI_DEBUG_ON
  1950. printk("\n\nCMV fail, Group 3 Address 62 Index 0");
  1951. #endif
  1952. CLR_FLAG((&(pts.adslAturPhysEntry_pt->flags)), ATUR_PHY_SER_NUM_FLAG);
  1953. }
  1954. else{
  1955. memcpy(pts.adslAturPhysEntry_pt->serial_no, RxMessage+4, ((RxMessage[0]&0xf)*2));
  1956. }
  1957. ATUR_PHY_SER_NUM_FLAG_MAKECMV2;
  1958. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1959. #ifdef AMAZON_MEI_DEBUG_ON
  1960. printk("\n\nCMV fail, Group 3 Address 62 Index 12");
  1961. #endif
  1962. CLR_FLAG((&(pts.adslAturPhysEntry_pt->flags)), ATUR_PHY_SER_NUM_FLAG);
  1963. }
  1964. else{
  1965. memcpy((pts.adslAturPhysEntry_pt->serial_no+24), RxMessage+4, ((RxMessage[0]&0xf)*2));
  1966. }
  1967. }
  1968. if(IS_FLAG_SET((&(pts.adslAturPhysEntry_pt->flags)), ATUR_PHY_VENDOR_ID_FLAG)){
  1969. ATUR_PHY_VENDOR_ID_FLAG_MAKECMV;
  1970. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1971. #ifdef AMAZON_MEI_DEBUG_ON
  1972. printk("\n\nCMV fail, Group 3 Address 65 Index 0");
  1973. #endif
  1974. CLR_FLAG((&(pts.adslAturPhysEntry_pt->flags)), ATUR_PHY_VENDOR_ID_FLAG);
  1975. }
  1976. else{
  1977. memcpy(pts.adslAturPhysEntry_pt->vendor_id.vendor_id, RxMessage+4, ((RxMessage[0]&0xf)*2));
  1978. }
  1979. }
  1980. if(IS_FLAG_SET((&(pts.adslAturPhysEntry_pt->flags)), ATUR_PHY_VER_NUM_FLAG)){
  1981. ATUR_PHY_VER_NUM_FLAG_MAKECMV;
  1982. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1983. #ifdef AMAZON_MEI_DEBUG_ON
  1984. printk("\n\nCMV fail, Group 3 Address 61 Index 0");
  1985. #endif
  1986. CLR_FLAG((&(pts.adslAturPhysEntry_pt->flags)), ATUR_PHY_VER_NUM_FLAG);
  1987. }
  1988. else{
  1989. memcpy(pts.adslAturPhysEntry_pt->version_no, RxMessage+4, ((RxMessage[0]&0xf)*2));
  1990. }
  1991. }
  1992. if(IS_FLAG_SET((&(pts.adslAturPhysEntry_pt->flags)), ATUR_SNRMGN_FLAG)){
  1993. ATUR_SNRMGN_FLAG_MAKECMV;
  1994. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  1995. #ifdef AMAZON_MEI_DEBUG_ON
  1996. printk("\n\nCMV fail, Group 3 Address 68 Index 4");
  1997. #endif
  1998. CLR_FLAG((&(pts.adslAturPhysEntry_pt->flags)), ATUR_SNRMGN_FLAG);
  1999. }
  2000. else{
  2001. memcpy((&(pts.adslAturPhysEntry_pt->SnrMgn)), RxMessage+4, ((RxMessage[0]&0xf)*2));
  2002. }
  2003. }
  2004. if(IS_FLAG_SET((&(pts.adslAturPhysEntry_pt->flags)), ATUR_ATTN_FLAG)){
  2005. ATUR_ATTN_FLAG_MAKECMV;
  2006. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  2007. #ifdef AMAZON_MEI_DEBUG_ON
  2008. printk("\n\nCMV fail, Group 3 Address 68 Index 2");
  2009. #endif
  2010. CLR_FLAG((&(pts.adslAturPhysEntry_pt->flags)), ATUR_ATTN_FLAG);
  2011. }
  2012. else{
  2013. memcpy((&(pts.adslAturPhysEntry_pt->Attn)), RxMessage+4, ((RxMessage[0]&0xf)*2));
  2014. }
  2015. }
  2016. if(IS_FLAG_SET((&(pts.adslAturPhysEntry_pt->flags)), ATUR_CURR_STAT_FLAG)){
  2017. pts.adslAturPhysEntry_pt->status = CurrStatus.adslAturCurrStatus;
  2018. }
  2019. if(IS_FLAG_SET((&(pts.adslAturPhysEntry_pt->flags)), ATUR_CURR_OUT_PWR_FLAG)){
  2020. ATUR_CURR_OUT_PWR_FLAG_MAKECMV;
  2021. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  2022. #ifdef AMAZON_MEI_DEBUG_ON
  2023. printk("\n\nCMV fail, Group 3 Address 69 Index 5");
  2024. #endif
  2025. CLR_FLAG((&(pts.adslAturPhysEntry_pt->flags)), ATUR_CURR_OUT_PWR_FLAG);
  2026. }
  2027. else{
  2028. memcpy((&(pts.adslAturPhysEntry_pt->outputPwr)), RxMessage+4, ((RxMessage[0]&0xf)*2));
  2029. }
  2030. }
  2031. if(IS_FLAG_SET((&(pts.adslAturPhysEntry_pt->flags)), ATUR_CURR_ATTR_FLAG)){
  2032. ATUR_CURR_ATTR_FLAG_MAKECMV;
  2033. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  2034. #ifdef AMAZON_MEI_DEBUG_ON
  2035. printk("\n\nCMV fail, Group 3 Address 68 Index 0");
  2036. #endif
  2037. CLR_FLAG((&(pts.adslAturPhysEntry_pt->flags)), ATUR_CURR_ATTR_FLAG);
  2038. }
  2039. else{
  2040. memcpy((&(pts.adslAturPhysEntry_pt->attainableRate)), RxMessage+4, ((RxMessage[0]&0xf)*2));
  2041. }
  2042. }
  2043. copy_to_user((char *)lon, (char *)pts.adslAturPhysEntry_pt, sizeof(adslAturPhysEntry));
  2044. kfree(pts.adslAturPhysEntry_pt);
  2045. up(&mei_sema);
  2046. break;
  2047. case GET_ADSL_ATUC_CHAN_INFO:
  2048. if(down_interruptible(&mei_sema))
  2049. return -ERESTARTSYS;
  2050. pts.adslAtucChanInfo_pt = (adslAtucChanInfo *)kmalloc(sizeof(adslAtucChanInfo), GFP_KERNEL);
  2051. copy_from_user((char *)pts.adslAtucChanInfo_pt, (char *)lon, sizeof(adslAtucChanInfo));
  2052. if(IS_FLAG_SET((&(pts.adslAtucChanInfo_pt->flags)), ATUC_CHAN_INTLV_DELAY_FLAG)){
  2053. if((chantype.interleave!=1) || (chantype.fast==1)){
  2054. CLR_FLAG((&(pts.adslAtucChanInfo_pt->flags)), ATUC_CHAN_INTLV_DELAY_FLAG);
  2055. }
  2056. else{
  2057. ATUC_CHAN_INTLV_DELAY_FLAG_MAKECMV;
  2058. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  2059. #ifdef AMAZON_MEI_DEBUG_ON
  2060. printk("\n\nCMV fail, Group 6 Address 3 Index 1");
  2061. #endif
  2062. CLR_FLAG((&(pts.adslAtucChanInfo_pt->flags)), ATUC_CHAN_INTLV_DELAY_FLAG);
  2063. }
  2064. else{
  2065. memcpy((&(pts.adslAtucChanInfo_pt->interleaveDelay)), RxMessage+4, ((RxMessage[0]&0xf)*2));
  2066. }
  2067. }
  2068. }
  2069. if(IS_FLAG_SET((&(pts.adslAtucChanInfo_pt->flags)), ATUC_CHAN_CURR_TX_RATE_FLAG)){
  2070. ATUC_CHAN_CURR_TX_RATE_FLAG_MAKECMV;
  2071. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  2072. #ifdef AMAZON_MEI_DEBUG_ON
  2073. printk("\n\nCMV fail, Group 6 Address 1 Index 0");
  2074. #endif
  2075. CLR_FLAG((&(pts.adslAtucChanInfo_pt->flags)), ATUC_CHAN_CURR_TX_RATE_FLAG);
  2076. }
  2077. else{
  2078. pts.adslAtucChanInfo_pt->currTxRate = (u32)(RxMessage[4]) + (((u32)(RxMessage[5]))<<16);
  2079. }
  2080. }
  2081. if(IS_FLAG_SET((&(pts.adslAtucChanInfo_pt->flags)), ATUC_CHAN_PREV_TX_RATE_FLAG)){
  2082. pts.adslAtucChanInfo_pt->prevTxRate = PrevTxRate.adslAtucChanPrevTxRate;
  2083. }
  2084. copy_to_user((char *)lon, (char *)pts.adslAtucChanInfo_pt, sizeof(adslAtucChanInfo));
  2085. kfree(pts.adslAtucChanInfo_pt);
  2086. up(&mei_sema);
  2087. break;
  2088. case GET_ADSL_ATUR_CHAN_INFO:
  2089. if(down_interruptible(&mei_sema))
  2090. return -ERESTARTSYS;
  2091. pts.adslAturChanInfo_pt = (adslAturChanInfo *)kmalloc(sizeof(adslAturChanInfo), GFP_KERNEL);
  2092. copy_from_user((char *)pts.adslAturChanInfo_pt, (char *)lon, sizeof(adslAturChanInfo));
  2093. if(IS_FLAG_SET((&(pts.adslAturChanInfo_pt->flags)), ATUR_CHAN_INTLV_DELAY_FLAG)){
  2094. if((chantype.interleave!=1) || (chantype.fast==1)){
  2095. CLR_FLAG((&(pts.adslAturChanInfo_pt->flags)), ATUR_CHAN_INTLV_DELAY_FLAG);
  2096. }
  2097. else{
  2098. ATUR_CHAN_INTLV_DELAY_FLAG_MAKECMV;
  2099. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  2100. #ifdef AMAZON_MEI_DEBUG_ON
  2101. printk("\n\nCMV fail, Group 6 Address 2 Index 1");
  2102. #endif
  2103. CLR_FLAG((&(pts.adslAturChanInfo_pt->flags)), ATUR_CHAN_INTLV_DELAY_FLAG);
  2104. }
  2105. else{
  2106. memcpy((&(pts.adslAturChanInfo_pt->interleaveDelay)), RxMessage+4, ((RxMessage[0]&0xf)*2));
  2107. }
  2108. }
  2109. }
  2110. if(IS_FLAG_SET((&(pts.adslAturChanInfo_pt->flags)), ATUR_CHAN_CURR_TX_RATE_FLAG)){
  2111. ATUR_CHAN_CURR_TX_RATE_FLAG_MAKECMV;
  2112. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  2113. #ifdef AMAZON_MEI_DEBUG_ON
  2114. printk("\n\nCMV fail, Group 6 Address 0 Index 0");
  2115. #endif
  2116. CLR_FLAG((&(pts.adslAturChanInfo_pt->flags)), ATUR_CHAN_CURR_TX_RATE_FLAG);
  2117. }
  2118. else{
  2119. pts.adslAturChanInfo_pt->currTxRate = (u32)(RxMessage[4]) + (((u32)(RxMessage[5]))<<16);
  2120. }
  2121. }
  2122. if(IS_FLAG_SET((&(pts.adslAturChanInfo_pt->flags)), ATUR_CHAN_PREV_TX_RATE_FLAG)){
  2123. pts.adslAturChanInfo_pt->prevTxRate = PrevTxRate.adslAturChanPrevTxRate;
  2124. }
  2125. if(IS_FLAG_SET((&(pts.adslAturChanInfo_pt->flags)), ATUR_CHAN_CRC_BLK_LEN_FLAG)){
  2126. // ? no CMV to update this
  2127. CLR_FLAG((&(pts.adslAturChanInfo_pt->flags)), ATUR_CHAN_CRC_BLK_LEN_FLAG);
  2128. }
  2129. copy_to_user((char *)lon, (char *)pts.adslAturChanInfo_pt, sizeof(adslAturChanInfo));
  2130. kfree(pts.adslAturChanInfo_pt);
  2131. up(&mei_sema);
  2132. break;
  2133. case GET_ADSL_ATUC_PERF_DATA:
  2134. pts.atucPerfDataEntry_pt = (atucPerfDataEntry *)kmalloc(sizeof(atucPerfDataEntry), GFP_KERNEL);
  2135. copy_from_user((char *)pts.atucPerfDataEntry_pt, (char *)lon, sizeof(atucPerfDataEntry));
  2136. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_LOFS_FLAG)){
  2137. pts.atucPerfDataEntry_pt->adslAtucPerfLofs=ATUC_PERF_LOFS;
  2138. }
  2139. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_LOSS_FLAG)){
  2140. pts.atucPerfDataEntry_pt->adslAtucPerfLoss=ATUC_PERF_LOSS;
  2141. }
  2142. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_ESS_FLAG)){
  2143. pts.atucPerfDataEntry_pt->adslAtucPerfESs=ATUC_PERF_ESS;
  2144. }
  2145. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_INITS_FLAG)){
  2146. pts.atucPerfDataEntry_pt->adslAtucPerfInits=ATUC_PERF_INITS;
  2147. }
  2148. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_VALID_INTVLS_FLAG)){
  2149. i=0;
  2150. for(ptr=(current_intvl->list).prev; ptr!=&interval_list; ptr=ptr->prev){
  2151. i++;
  2152. if(i==96)
  2153. break;
  2154. }
  2155. pts.atucPerfDataEntry_pt->adslAtucPerfValidIntervals=i;
  2156. }
  2157. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_INVALID_INTVLS_FLAG)){
  2158. pts.atucPerfDataEntry_pt->adslAtucPerfInvalidIntervals=0;
  2159. }
  2160. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_CURR_15MIN_TIME_ELAPSED_FLAG)){
  2161. do_gettimeofday(&time_now);
  2162. pts.atucPerfDataEntry_pt->adslAtucPerfCurr15MinTimeElapsed=time_now.tv_sec - (current_intvl->start_time).tv_sec;
  2163. }
  2164. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_CURR_15MIN_LOFS_FLAG)){
  2165. pts.atucPerfDataEntry_pt->adslAtucPerfCurr15MinLofs=current_intvl->AtucPerfLof;
  2166. }
  2167. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_CURR_15MIN_LOSS_FLAG)){
  2168. pts.atucPerfDataEntry_pt->adslAtucPerfCurr15MinLoss=current_intvl->AtucPerfLos;
  2169. }
  2170. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_CURR_15MIN_ESS_FLAG)){
  2171. pts.atucPerfDataEntry_pt->adslAtucPerfCurr15MinESs=current_intvl->AtucPerfEs;
  2172. }
  2173. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_CURR_15MIN_INIT_FLAG)){
  2174. pts.atucPerfDataEntry_pt->adslAtucPerfCurr15MinInits=current_intvl->AtucPerfInit;
  2175. }
  2176. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_CURR_1DAY_TIME_ELAPSED_FLAG)){
  2177. i=0;
  2178. for(ptr=(current_intvl->list).prev; ptr!=&interval_list; ptr=ptr->prev){
  2179. i+=900;
  2180. }
  2181. do_gettimeofday(&time_now);
  2182. i+=time_now.tv_sec - (current_intvl->start_time).tv_sec;
  2183. if(i>=86400)
  2184. pts.atucPerfDataEntry_pt->adslAtucPerfCurr1DayTimeElapsed=i-86400;
  2185. else
  2186. pts.atucPerfDataEntry_pt->adslAtucPerfCurr1DayTimeElapsed=i;
  2187. }
  2188. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_CURR_1DAY_LOFS_FLAG)){
  2189. i=0;
  2190. j=0;
  2191. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2192. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2193. j+=mib_ptr->AtucPerfLof;
  2194. i++;
  2195. if(i==96)
  2196. j=0;
  2197. }
  2198. j+=current_intvl->AtucPerfLof;
  2199. pts.atucPerfDataEntry_pt->adslAtucPerfCurr1DayLofs=j;
  2200. }
  2201. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_CURR_1DAY_LOSS_FLAG)){
  2202. i=0;
  2203. j=0;
  2204. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2205. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2206. j+=mib_ptr->AtucPerfLos;
  2207. i++;
  2208. if(i==96)
  2209. j=0;
  2210. }
  2211. j+=current_intvl->AtucPerfLos;
  2212. pts.atucPerfDataEntry_pt->adslAtucPerfCurr1DayLoss=j;
  2213. }
  2214. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_CURR_1DAY_ESS_FLAG)){
  2215. i=0;
  2216. j=0;
  2217. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2218. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2219. j+=mib_ptr->AtucPerfEs;
  2220. i++;
  2221. if(i==96)
  2222. j=0;
  2223. }
  2224. j+=current_intvl->AtucPerfEs;
  2225. pts.atucPerfDataEntry_pt->adslAtucPerfCurr1DayESs=j;
  2226. }
  2227. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_CURR_1DAY_INIT_FLAG)){
  2228. i=0;
  2229. j=0;
  2230. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2231. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2232. j+=mib_ptr->AtucPerfInit;
  2233. i++;
  2234. if(i==96)
  2235. j=0;
  2236. }
  2237. j+=current_intvl->AtucPerfInit;
  2238. pts.atucPerfDataEntry_pt->adslAtucPerfCurr1DayInits=j;
  2239. }
  2240. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_PREV_1DAY_MON_SEC_FLAG)){
  2241. i=0;
  2242. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2243. i++;
  2244. }
  2245. if(i>=96)
  2246. pts.atucPerfDataEntry_pt->adslAtucPerfPrev1DayMoniSecs=86400;
  2247. else
  2248. pts.atucPerfDataEntry_pt->adslAtucPerfPrev1DayMoniSecs=0;
  2249. }
  2250. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_PREV_1DAY_LOFS_FLAG)){
  2251. i=0;
  2252. j=0;
  2253. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2254. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2255. j+=mib_ptr->AtucPerfLof;
  2256. i++;
  2257. if(i==96)
  2258. break;
  2259. }
  2260. if(i==96)
  2261. pts.atucPerfDataEntry_pt->adslAtucPerfPrev1DayLofs=j;
  2262. else
  2263. pts.atucPerfDataEntry_pt->adslAtucPerfPrev1DayLofs=0;
  2264. }
  2265. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_PREV_1DAY_LOSS_FLAG)){
  2266. i=0;
  2267. j=0;
  2268. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2269. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2270. j+=mib_ptr->AtucPerfLos;
  2271. i++;
  2272. if(i==96)
  2273. break;
  2274. }
  2275. if(i==96)
  2276. pts.atucPerfDataEntry_pt->adslAtucPerfPrev1DayLoss=j;
  2277. else
  2278. pts.atucPerfDataEntry_pt->adslAtucPerfPrev1DayLoss=0;
  2279. }
  2280. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_PREV_1DAY_ESS_FLAG)){
  2281. i=0;
  2282. j=0;
  2283. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2284. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2285. j+=mib_ptr->AtucPerfEs;
  2286. i++;
  2287. if(i==96)
  2288. break;
  2289. }
  2290. if(i==96)
  2291. pts.atucPerfDataEntry_pt->adslAtucPerfPrev1DayESs=j;
  2292. else
  2293. pts.atucPerfDataEntry_pt->adslAtucPerfPrev1DayESs=0;
  2294. }
  2295. if(IS_FLAG_SET((&(pts.atucPerfDataEntry_pt->flags)), ATUC_PERF_PREV_1DAY_INITS_FLAG)){
  2296. i=0;
  2297. j=0;
  2298. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2299. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2300. j+=mib_ptr->AtucPerfInit;
  2301. i++;
  2302. if(i==96)
  2303. break;
  2304. }
  2305. if(i==96)
  2306. pts.atucPerfDataEntry_pt->adslAtucPerfPrev1DayInits=j;
  2307. else
  2308. pts.atucPerfDataEntry_pt->adslAtucPerfPrev1DayInits=0;
  2309. }
  2310. copy_to_user((char *)lon, (char *)pts.atucPerfDataEntry_pt, sizeof(atucPerfDataEntry));
  2311. kfree(pts.atucPerfDataEntry_pt);
  2312. break;
  2313. #ifdef AMAZON_MEI_MIB_RFC3440
  2314. case GET_ADSL_ATUC_PERF_DATA_EXT: //??? CMV mapping not available
  2315. pts.atucPerfDataExtEntry_pt = (atucPerfDataExtEntry *)kmalloc(sizeof(atucPerfDataExtEntry), GFP_KERNEL);
  2316. copy_from_user((char *)pts.atucPerfDataExtEntry_pt, (char *)lon, sizeof(atucPerfDataExtEntry));
  2317. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_STAT_FASTR_FLAG)){
  2318. pts.atucPerfDataExtEntry_pt->adslAtucPerfStatFastR=ATUC_PERF_STAT_FASTR;
  2319. }
  2320. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_STAT_FAILED_FASTR_FLAG)){
  2321. pts.atucPerfDataExtEntry_pt->adslAtucPerfStatFailedFastR=ATUC_PERF_STAT_FAILED_FASTR;
  2322. }
  2323. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_STAT_SESL_FLAG)){
  2324. pts.atucPerfDataExtEntry_pt->adslAtucPerfStatSesL=ATUC_PERF_STAT_SESL;
  2325. }
  2326. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_STAT_UASL_FLAG)){
  2327. pts.atucPerfDataExtEntry_pt->adslAtucPerfStatUasL=ATUC_PERF_STAT_UASL;
  2328. }
  2329. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_CURR_15MIN_FASTR_FLAG)){
  2330. pts.atucPerfDataExtEntry_pt->adslAtucPerfCurr15MinFastR=current_intvl->AtucPerfStatFastR;
  2331. }
  2332. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_CURR_15MIN_FAILED_FASTR_FLAG)){
  2333. pts.atucPerfDataExtEntry_pt->adslAtucPerfCurr15MinFailedFastR=current_intvl->AtucPerfStatFailedFastR;
  2334. }
  2335. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_CURR_15MIN_SESL_FLAG)){
  2336. pts.atucPerfDataExtEntry_pt->adslAtucPerfCurr15MinSesL=current_intvl->AtucPerfStatSesL;
  2337. }
  2338. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_CURR_15MIN_UASL_FLAG)){
  2339. pts.atucPerfDataExtEntry_pt->adslAtucPerfCurr15MinUasL=current_intvl->AtucPerfStatUasL;
  2340. }
  2341. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_CURR_1DAY_FASTR_FLAG)){
  2342. i=0;
  2343. j=0;
  2344. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2345. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2346. j+=mib_ptr->AtucPerfStatFastR;
  2347. i++;
  2348. if(i==96)
  2349. j=0;
  2350. }
  2351. j+=current_intvl->AtucPerfStatFastR;
  2352. pts.atucPerfDataExtEntry_pt->adslAtucPerfCurr1DayFastR=j;
  2353. }
  2354. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_CURR_1DAY_FAILED_FASTR_FLAG)){
  2355. i=0;
  2356. j=0;
  2357. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2358. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2359. j+=mib_ptr->AtucPerfStatFailedFastR;
  2360. i++;
  2361. if(i==96)
  2362. j=0;
  2363. }
  2364. j+=current_intvl->AtucPerfStatFailedFastR;
  2365. pts.atucPerfDataExtEntry_pt->adslAtucPerfCurr1DayFailedFastR=j;
  2366. }
  2367. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_CURR_1DAY_SESL_FLAG)){
  2368. i=0;
  2369. j=0;
  2370. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2371. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2372. j+=mib_ptr->AtucPerfStatSesL;
  2373. i++;
  2374. if(i==96)
  2375. j=0;
  2376. }
  2377. j+=current_intvl->AtucPerfStatSesL;
  2378. pts.atucPerfDataExtEntry_pt->adslAtucPerfCurr1DaySesL=j;
  2379. }
  2380. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_CURR_1DAY_UASL_FLAG)){
  2381. i=0;
  2382. j=0;
  2383. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2384. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2385. j+=mib_ptr->AtucPerfStatUasL;
  2386. i++;
  2387. if(i==96)
  2388. j=0;
  2389. }
  2390. j+=current_intvl->AtucPerfStatUasL;
  2391. pts.atucPerfDataExtEntry_pt->adslAtucPerfCurr1DayUasL=j;
  2392. }
  2393. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_PREV_1DAY_FASTR_FLAG)){
  2394. i=0;
  2395. j=0;
  2396. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2397. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2398. j+=mib_ptr->AtucPerfStatFastR;
  2399. i++;
  2400. if(i==96)
  2401. break;
  2402. }
  2403. if(i==96)
  2404. pts.atucPerfDataExtEntry_pt->adslAtucPerfPrev1DayFastR=j;
  2405. else
  2406. pts.atucPerfDataExtEntry_pt->adslAtucPerfPrev1DayFastR=0;
  2407. }
  2408. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_PREV_1DAY_FAILED_FASTR_FLAG)){
  2409. i=0;
  2410. j=0;
  2411. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2412. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2413. j+=mib_ptr->AtucPerfStatFailedFastR;
  2414. i++;
  2415. if(i==96)
  2416. break;
  2417. }
  2418. if(i==96)
  2419. pts.atucPerfDataExtEntry_pt->adslAtucPerfPrev1DayFailedFastR=j;
  2420. else
  2421. pts.atucPerfDataExtEntry_pt->adslAtucPerfPrev1DayFailedFastR=0;
  2422. }
  2423. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_PREV_1DAY_SESL_FLAG)){
  2424. i=0;
  2425. j=0;
  2426. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2427. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2428. j+=mib_ptr->AtucPerfStatSesL;
  2429. i++;
  2430. if(i==96)
  2431. break;
  2432. }
  2433. if(i==96)
  2434. pts.atucPerfDataExtEntry_pt->adslAtucPerfPrev1DaySesL=j;
  2435. else
  2436. pts.atucPerfDataExtEntry_pt->adslAtucPerfPrev1DaySesL=0;
  2437. }
  2438. if(IS_FLAG_SET((&(pts.atucPerfDataExtEntry_pt->flags)), ATUC_PERF_PREV_1DAY_UASL_FLAG)){
  2439. i=0;
  2440. j=0;
  2441. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2442. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2443. j+=mib_ptr->AtucPerfStatUasL;
  2444. i++;
  2445. if(i==96)
  2446. break;
  2447. }
  2448. if(i==96)
  2449. pts.atucPerfDataExtEntry_pt->adslAtucPerfPrev1DayUasL=j;
  2450. else
  2451. pts.atucPerfDataExtEntry_pt->adslAtucPerfPrev1DayUasL=0;
  2452. }
  2453. copy_to_user((char *)lon, (char *)pts.atucPerfDataExtEntry_pt, sizeof(atucPerfDataExtEntry));
  2454. kfree(pts.atucPerfDataExtEntry_pt);
  2455. break;
  2456. #endif
  2457. case GET_ADSL_ATUR_PERF_DATA:
  2458. pts.aturPerfDataEntry_pt = (aturPerfDataEntry *)kmalloc(sizeof(aturPerfDataEntry), GFP_KERNEL);
  2459. copy_from_user((char *)pts.aturPerfDataEntry_pt, (char *)lon, sizeof(aturPerfDataEntry));
  2460. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_LOFS_FLAG)){
  2461. pts.aturPerfDataEntry_pt->adslAturPerfLofs=ATUR_PERF_LOFS;
  2462. }
  2463. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_LOSS_FLAG)){
  2464. pts.aturPerfDataEntry_pt->adslAturPerfLoss=ATUR_PERF_LOSS;
  2465. }
  2466. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_LPR_FLAG)){
  2467. pts.aturPerfDataEntry_pt->adslAturPerfLprs=ATUR_PERF_LPR;
  2468. }
  2469. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_ESS_FLAG)){
  2470. pts.aturPerfDataEntry_pt->adslAturPerfESs=ATUR_PERF_ESS;
  2471. }
  2472. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_VALID_INTVLS_FLAG)){
  2473. i=0;
  2474. for(ptr=(current_intvl->list).prev; ptr!=&interval_list; ptr=ptr->prev){
  2475. i++;
  2476. if(i==96)
  2477. break;
  2478. }
  2479. pts.aturPerfDataEntry_pt->adslAturPerfValidIntervals=i;
  2480. }
  2481. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_INVALID_INTVLS_FLAG)){
  2482. pts.aturPerfDataEntry_pt->adslAturPerfInvalidIntervals=0;
  2483. }
  2484. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_CURR_15MIN_TIME_ELAPSED_FLAG)){
  2485. do_gettimeofday(&time_now);
  2486. pts.aturPerfDataEntry_pt->adslAturPerfCurr15MinTimeElapsed=time_now.tv_sec - (current_intvl->start_time).tv_sec;
  2487. }
  2488. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_CURR_15MIN_LOFS_FLAG)){
  2489. pts.aturPerfDataEntry_pt->adslAturPerfCurr15MinLofs=current_intvl->AturPerfLof;
  2490. }
  2491. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_CURR_15MIN_LOSS_FLAG)){
  2492. pts.aturPerfDataEntry_pt->adslAturPerfCurr15MinLoss=current_intvl->AturPerfLos;
  2493. }
  2494. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_CURR_15MIN_LPR_FLAG)){
  2495. pts.aturPerfDataEntry_pt->adslAturPerfCurr15MinLprs=current_intvl->AturPerfLpr;
  2496. }
  2497. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_CURR_15MIN_ESS_FLAG)){
  2498. pts.aturPerfDataEntry_pt->adslAturPerfCurr15MinESs=current_intvl->AturPerfEs;
  2499. }
  2500. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_CURR_1DAY_TIME_ELAPSED_FLAG)){
  2501. i=0;
  2502. for(ptr=(current_intvl->list).prev; ptr!=&interval_list; ptr=ptr->prev){
  2503. i+=900;
  2504. }
  2505. do_gettimeofday(&time_now);
  2506. i+=time_now.tv_sec - (current_intvl->start_time).tv_sec;
  2507. if(i>=86400)
  2508. pts.aturPerfDataEntry_pt->adslAturPerfCurr1DayTimeElapsed=i-86400;
  2509. else
  2510. pts.aturPerfDataEntry_pt->adslAturPerfCurr1DayTimeElapsed=i;
  2511. }
  2512. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_CURR_1DAY_LOFS_FLAG)){
  2513. i=0;
  2514. j=0;
  2515. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2516. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2517. j+=mib_ptr->AturPerfLof;
  2518. i++;
  2519. if(i==96)
  2520. j=0;
  2521. }
  2522. j+=current_intvl->AturPerfLof;
  2523. pts.aturPerfDataEntry_pt->adslAturPerfCurr1DayLofs=j;
  2524. }
  2525. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_CURR_1DAY_LOSS_FLAG)){
  2526. i=0;
  2527. j=0;
  2528. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2529. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2530. j+=mib_ptr->AturPerfLos;
  2531. i++;
  2532. if(i==96)
  2533. j=0;
  2534. }
  2535. j+=current_intvl->AturPerfLos;
  2536. pts.aturPerfDataEntry_pt->adslAturPerfCurr1DayLoss=j;
  2537. }
  2538. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_CURR_1DAY_LPR_FLAG)){
  2539. i=0;
  2540. j=0;
  2541. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2542. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2543. j+=mib_ptr->AturPerfLpr;
  2544. i++;
  2545. if(i==96)
  2546. j=0;
  2547. }
  2548. j+=current_intvl->AturPerfLpr;
  2549. pts.aturPerfDataEntry_pt->adslAturPerfCurr1DayLprs=j;
  2550. }
  2551. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_CURR_1DAY_ESS_FLAG)){
  2552. i=0;
  2553. j=0;
  2554. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2555. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2556. j+=mib_ptr->AturPerfEs;
  2557. i++;
  2558. if(i==96)
  2559. j=0;
  2560. }
  2561. j+=current_intvl->AturPerfEs;
  2562. pts.aturPerfDataEntry_pt->adslAturPerfCurr1DayESs=j;
  2563. }
  2564. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_PREV_1DAY_MON_SEC_FLAG)){
  2565. i=0;
  2566. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2567. i++;
  2568. }
  2569. if(i>=96)
  2570. pts.aturPerfDataEntry_pt->adslAturPerfPrev1DayMoniSecs=86400;
  2571. else
  2572. pts.aturPerfDataEntry_pt->adslAturPerfPrev1DayMoniSecs=0;
  2573. }
  2574. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_PREV_1DAY_LOFS_FLAG)){
  2575. i=0;
  2576. j=0;
  2577. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2578. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2579. j+=mib_ptr->AturPerfLof;
  2580. i++;
  2581. if(i==96)
  2582. break;
  2583. }
  2584. if(i==96)
  2585. pts.aturPerfDataEntry_pt->adslAturPerfPrev1DayLofs=j;
  2586. else
  2587. pts.aturPerfDataEntry_pt->adslAturPerfPrev1DayLofs=0;
  2588. }
  2589. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_PREV_1DAY_LOSS_FLAG)){
  2590. i=0;
  2591. j=0;
  2592. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2593. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2594. j+=mib_ptr->AturPerfLos;
  2595. i++;
  2596. if(i==96)
  2597. break;
  2598. }
  2599. if(i==96)
  2600. pts.aturPerfDataEntry_pt->adslAturPerfPrev1DayLoss=j;
  2601. else
  2602. pts.aturPerfDataEntry_pt->adslAturPerfPrev1DayLoss=0;
  2603. }
  2604. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_PREV_1DAY_LPR_FLAG)){
  2605. i=0;
  2606. j=0;
  2607. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2608. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2609. j+=mib_ptr->AturPerfLpr;
  2610. i++;
  2611. if(i==96)
  2612. break;
  2613. }
  2614. if(i==96)
  2615. pts.aturPerfDataEntry_pt->adslAturPerfPrev1DayLprs=j;
  2616. else
  2617. pts.aturPerfDataEntry_pt->adslAturPerfPrev1DayLprs=0;
  2618. }
  2619. if(IS_FLAG_SET((&(pts.aturPerfDataEntry_pt->flags)), ATUR_PERF_PREV_1DAY_ESS_FLAG)){
  2620. i=0;
  2621. j=0;
  2622. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2623. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2624. j+=mib_ptr->AturPerfEs;
  2625. i++;
  2626. if(i==96)
  2627. break;
  2628. }
  2629. if(i==96)
  2630. pts.aturPerfDataEntry_pt->adslAturPerfPrev1DayESs=j;
  2631. else
  2632. pts.aturPerfDataEntry_pt->adslAturPerfPrev1DayESs=0;
  2633. }
  2634. copy_to_user((char *)lon, (char *)pts.aturPerfDataEntry_pt, sizeof(aturPerfDataEntry));
  2635. kfree(pts.aturPerfDataEntry_pt);
  2636. break;
  2637. #ifdef AMAZON_MEI_MIB_RFC3440
  2638. case GET_ADSL_ATUR_PERF_DATA_EXT:
  2639. pts.aturPerfDataExtEntry_pt = (aturPerfDataExtEntry *)kmalloc(sizeof(aturPerfDataExtEntry), GFP_KERNEL);
  2640. copy_from_user((char *)pts.aturPerfDataExtEntry_pt, (char *)lon, sizeof(aturPerfDataExtEntry));
  2641. if(IS_FLAG_SET((&(pts.aturPerfDataExtEntry_pt->flags)), ATUR_PERF_STAT_SESL_FLAG)){
  2642. pts.aturPerfDataExtEntry_pt->adslAturPerfStatSesL=ATUR_PERF_STAT_SESL;
  2643. }
  2644. if(IS_FLAG_SET((&(pts.aturPerfDataExtEntry_pt->flags)), ATUR_PERF_STAT_UASL_FLAG)){
  2645. pts.aturPerfDataExtEntry_pt->adslAturPerfStatUasL=ATUR_PERF_STAT_UASL;
  2646. }
  2647. if(IS_FLAG_SET((&(pts.aturPerfDataExtEntry_pt->flags)), ATUR_PERF_CURR_15MIN_SESL_FLAG)){
  2648. pts.aturPerfDataExtEntry_pt->adslAturPerfCurr15MinSesL=current_intvl->AturPerfStatSesL;
  2649. }
  2650. if(IS_FLAG_SET((&(pts.aturPerfDataExtEntry_pt->flags)), ATUR_PERF_CURR_15MIN_UASL_FLAG)){
  2651. pts.aturPerfDataExtEntry_pt->adslAturPerfCurr15MinUasL=current_intvl->AturPerfStatUasL;
  2652. }
  2653. if(IS_FLAG_SET((&(pts.aturPerfDataExtEntry_pt->flags)), ATUR_PERF_CURR_1DAY_SESL_FLAG)){
  2654. i=0;
  2655. j=0;
  2656. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2657. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2658. j+=mib_ptr->AturPerfStatSesL;
  2659. i++;
  2660. if(i==96)
  2661. j=0;
  2662. }
  2663. j+=current_intvl->AturPerfStatSesL;
  2664. pts.aturPerfDataExtEntry_pt->adslAturPerfCurr1DaySesL=j;
  2665. }
  2666. if(IS_FLAG_SET((&(pts.aturPerfDataExtEntry_pt->flags)), ATUR_PERF_CURR_1DAY_UASL_FLAG)){
  2667. i=0;
  2668. j=0;
  2669. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2670. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2671. j+=mib_ptr->AturPerfStatUasL;
  2672. i++;
  2673. if(i==96)
  2674. j=0;
  2675. }
  2676. j+=current_intvl->AturPerfStatUasL;
  2677. pts.aturPerfDataExtEntry_pt->adslAturPerfCurr1DayUasL=j;
  2678. }
  2679. if(IS_FLAG_SET((&(pts.aturPerfDataExtEntry_pt->flags)), ATUR_PERF_PREV_1DAY_SESL_FLAG)){
  2680. i=0;
  2681. j=0;
  2682. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2683. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2684. j+=mib_ptr->AturPerfStatSesL;
  2685. i++;
  2686. if(i==96)
  2687. break;
  2688. }
  2689. if(i==96)
  2690. pts.aturPerfDataExtEntry_pt->adslAturPerfPrev1DaySesL=j;
  2691. else
  2692. pts.aturPerfDataExtEntry_pt->adslAturPerfPrev1DaySesL=0;
  2693. }
  2694. if(IS_FLAG_SET((&(pts.aturPerfDataExtEntry_pt->flags)), ATUR_PERF_PREV_1DAY_UASL_FLAG)){
  2695. i=0;
  2696. j=0;
  2697. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2698. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2699. j+=mib_ptr->AturPerfStatUasL;
  2700. i++;
  2701. if(i==96)
  2702. break;
  2703. }
  2704. if(i==96)
  2705. pts.aturPerfDataExtEntry_pt->adslAturPerfPrev1DayUasL=j;
  2706. else
  2707. pts.aturPerfDataExtEntry_pt->adslAturPerfPrev1DayUasL=0;
  2708. }
  2709. copy_to_user((char *)lon, (char *)pts.aturPerfDataExtEntry_pt, sizeof(aturPerfDataExtEntry));
  2710. kfree(pts.aturPerfDataExtEntry_pt);
  2711. break;
  2712. #endif
  2713. case GET_ADSL_ATUC_INTVL_INFO:
  2714. pts.adslAtucIntvlInfo_pt = (adslAtucIntvlInfo *)kmalloc(sizeof(adslAtucIntvlInfo), GFP_KERNEL);
  2715. copy_from_user((char *)pts.adslAtucIntvlInfo_pt, (char *)lon, sizeof(adslAtucIntvlInfo));
  2716. if(pts.adslAtucIntvlInfo_pt->IntervalNumber <1){
  2717. pts.adslAtucIntvlInfo_pt->intervalLOF = ATUC_PERF_LOFS;
  2718. pts.adslAtucIntvlInfo_pt->intervalLOS = ATUC_PERF_LOSS;
  2719. pts.adslAtucIntvlInfo_pt->intervalES = ATUC_PERF_ESS;
  2720. pts.adslAtucIntvlInfo_pt->intervalInits = ATUC_PERF_INITS;
  2721. pts.adslAtucIntvlInfo_pt->intervalValidData = 1;
  2722. }
  2723. else{
  2724. i=0;
  2725. for(ptr=(current_intvl->list).prev; ptr!=&interval_list; ptr=ptr->prev){
  2726. i++;
  2727. if(i==pts.adslAtucIntvlInfo_pt->IntervalNumber){
  2728. temp_intvl = list_entry(ptr, amazon_mei_mib, list);
  2729. pts.adslAtucIntvlInfo_pt->intervalLOF = temp_intvl->AtucPerfLof;
  2730. pts.adslAtucIntvlInfo_pt->intervalLOS = temp_intvl->AtucPerfLos;
  2731. pts.adslAtucIntvlInfo_pt->intervalES = temp_intvl->AtucPerfEs;
  2732. pts.adslAtucIntvlInfo_pt->intervalInits = temp_intvl->AtucPerfInit;
  2733. pts.adslAtucIntvlInfo_pt->intervalValidData = 1;
  2734. break;
  2735. }
  2736. }
  2737. if(ptr==&interval_list){
  2738. pts.adslAtucIntvlInfo_pt->intervalValidData = 0;
  2739. pts.adslAtucIntvlInfo_pt->flags = 0;
  2740. pts.adslAtucIntvlInfo_pt->intervalLOF = 0;
  2741. pts.adslAtucIntvlInfo_pt->intervalLOS = 0;
  2742. pts.adslAtucIntvlInfo_pt->intervalES = 0;
  2743. pts.adslAtucIntvlInfo_pt->intervalInits = 0;
  2744. }
  2745. }
  2746. copy_to_user((char *)lon, (char *)pts.adslAtucIntvlInfo_pt, sizeof(adslAtucIntvlInfo));
  2747. kfree(pts.adslAtucIntvlInfo_pt);
  2748. break;
  2749. #ifdef AMAZON_MEI_MIB_RFC3440
  2750. case GET_ADSL_ATUC_INTVL_EXT_INFO:
  2751. pts.adslAtucInvtlExtInfo_pt = (adslAtucInvtlExtInfo *)kmalloc(sizeof(adslAtucInvtlExtInfo), GFP_KERNEL);
  2752. copy_from_user((char *)pts.adslAtucInvtlExtInfo_pt, (char *)lon, sizeof(adslAtucInvtlExtInfo));
  2753. if(pts.adslAtucInvtlExtInfo_pt->IntervalNumber <1){
  2754. pts.adslAtucInvtlExtInfo_pt->adslAtucIntervalFastR = ATUC_PERF_STAT_FASTR;
  2755. pts.adslAtucInvtlExtInfo_pt->adslAtucIntervalFailedFastR = ATUC_PERF_STAT_FAILED_FASTR;
  2756. pts.adslAtucInvtlExtInfo_pt->adslAtucIntervalSesL = ATUC_PERF_STAT_SESL;
  2757. pts.adslAtucInvtlExtInfo_pt->adslAtucIntervalUasL = ATUC_PERF_STAT_UASL;
  2758. // pts.adslAtucInvtlExtInfo_pt->intervalValidData = 1;
  2759. }
  2760. else{
  2761. i=0;
  2762. for(ptr=(current_intvl->list).prev; ptr!=&interval_list; ptr=ptr->prev){
  2763. i++;
  2764. if(i==pts.adslAtucInvtlExtInfo_pt->IntervalNumber){
  2765. temp_intvl = list_entry(ptr, amazon_mei_mib, list);
  2766. pts.adslAtucInvtlExtInfo_pt->adslAtucIntervalFastR = temp_intvl->AtucPerfStatFastR;
  2767. pts.adslAtucInvtlExtInfo_pt->adslAtucIntervalFailedFastR = temp_intvl->AtucPerfStatFailedFastR;
  2768. pts.adslAtucInvtlExtInfo_pt->adslAtucIntervalSesL = temp_intvl->AtucPerfStatSesL;
  2769. pts.adslAtucInvtlExtInfo_pt->adslAtucIntervalUasL = temp_intvl->AtucPerfStatUasL;
  2770. // pts.adslAtucInvtlExtInfo_pt->intervalValidData = 1;
  2771. break;
  2772. }
  2773. }
  2774. if(ptr==&interval_list){
  2775. // pts.adslAtucInvtlExtInfo_pt->intervalValidData = 0;
  2776. pts.adslAtucInvtlExtInfo_pt->flags = 0;
  2777. pts.adslAtucInvtlExtInfo_pt->adslAtucIntervalFastR = 0;
  2778. pts.adslAtucInvtlExtInfo_pt->adslAtucIntervalFailedFastR = 0;
  2779. pts.adslAtucInvtlExtInfo_pt->adslAtucIntervalSesL = 0;
  2780. pts.adslAtucInvtlExtInfo_pt->adslAtucIntervalUasL = 0;
  2781. }
  2782. }
  2783. copy_to_user((char *)lon, (char *)pts.adslAtucInvtlExtInfo_pt, sizeof(adslAtucInvtlExtInfo));
  2784. kfree(pts.adslAtucInvtlExtInfo_pt);
  2785. break;
  2786. #endif
  2787. case GET_ADSL_ATUR_INTVL_INFO:
  2788. pts.adslAturIntvlInfo_pt = (adslAturIntvlInfo *)kmalloc(sizeof(adslAturIntvlInfo), GFP_KERNEL);
  2789. copy_from_user((char *)pts.adslAturIntvlInfo_pt, (char *)lon, sizeof(adslAturIntvlInfo));
  2790. if(pts.adslAturIntvlInfo_pt->IntervalNumber <1){
  2791. pts.adslAturIntvlInfo_pt->intervalLOF = ATUR_PERF_LOFS;
  2792. pts.adslAturIntvlInfo_pt->intervalLOS = ATUR_PERF_LOSS;
  2793. pts.adslAturIntvlInfo_pt->intervalES = ATUR_PERF_ESS;
  2794. pts.adslAturIntvlInfo_pt->intervalLPR = ATUR_PERF_LPR;
  2795. pts.adslAturIntvlInfo_pt->intervalValidData = 1;
  2796. }
  2797. else{
  2798. i=0;
  2799. for(ptr=(current_intvl->list).prev; ptr!=&interval_list; ptr=ptr->prev){
  2800. i++;
  2801. if(i==pts.adslAturIntvlInfo_pt->IntervalNumber){
  2802. temp_intvl = list_entry(ptr, amazon_mei_mib, list);
  2803. pts.adslAturIntvlInfo_pt->intervalLOF = temp_intvl->AturPerfLof;
  2804. pts.adslAturIntvlInfo_pt->intervalLOS = temp_intvl->AturPerfLos;
  2805. pts.adslAturIntvlInfo_pt->intervalES = temp_intvl->AturPerfEs;
  2806. pts.adslAturIntvlInfo_pt->intervalLPR = temp_intvl->AturPerfLpr;
  2807. pts.adslAturIntvlInfo_pt->intervalValidData = 1;
  2808. break;
  2809. }
  2810. }
  2811. if(ptr==&interval_list){
  2812. pts.adslAturIntvlInfo_pt->intervalValidData = 0;
  2813. pts.adslAturIntvlInfo_pt->flags = 0;
  2814. pts.adslAturIntvlInfo_pt->intervalLOF = 0;
  2815. pts.adslAturIntvlInfo_pt->intervalLOS = 0;
  2816. pts.adslAturIntvlInfo_pt->intervalES = 0;
  2817. pts.adslAturIntvlInfo_pt->intervalLPR = 0;
  2818. }
  2819. }
  2820. copy_to_user((char *)lon, (char *)pts.adslAturIntvlInfo_pt, sizeof(adslAturIntvlInfo));
  2821. kfree(pts.adslAturIntvlInfo_pt);
  2822. break;
  2823. #ifdef AMAZON_MEI_MIB_RFC3440
  2824. case GET_ADSL_ATUR_INTVL_EXT_INFO:
  2825. pts.adslAturInvtlExtInfo_pt = (adslAturInvtlExtInfo *)kmalloc(sizeof(adslAturInvtlExtInfo), GFP_KERNEL);
  2826. copy_from_user((char *)pts.adslAturInvtlExtInfo_pt, (char *)lon, sizeof(adslAturInvtlExtInfo));
  2827. if(pts.adslAturInvtlExtInfo_pt->IntervalNumber <1){
  2828. pts.adslAturInvtlExtInfo_pt->adslAturIntervalSesL = ATUR_PERF_STAT_SESL;
  2829. pts.adslAturInvtlExtInfo_pt->adslAturIntervalUasL = ATUR_PERF_STAT_UASL;
  2830. // pts.adslAturInvtlExtInfo_pt->intervalValidData = 1;
  2831. }
  2832. else{
  2833. i=0;
  2834. for(ptr=(current_intvl->list).prev; ptr!=&interval_list; ptr=ptr->prev){
  2835. i++;
  2836. if(i==pts.adslAturInvtlExtInfo_pt->IntervalNumber){
  2837. temp_intvl = list_entry(ptr, amazon_mei_mib, list);
  2838. pts.adslAturInvtlExtInfo_pt->adslAturIntervalSesL = temp_intvl->AturPerfStatSesL;
  2839. pts.adslAturInvtlExtInfo_pt->adslAturIntervalUasL = temp_intvl->AturPerfStatUasL;
  2840. // pts.adslAturInvtlExtInfo_pt->intervalValidData = 1;
  2841. break;
  2842. }
  2843. }
  2844. if(ptr==&interval_list){
  2845. // pts.adslAturInvtlExtInfo_pt->intervalValidData = 0;
  2846. pts.adslAturInvtlExtInfo_pt->flags = 0;
  2847. pts.adslAturInvtlExtInfo_pt->adslAturIntervalSesL = 0;
  2848. pts.adslAturInvtlExtInfo_pt->adslAturIntervalUasL = 0;
  2849. }
  2850. }
  2851. copy_to_user((char *)lon, (char *)pts.adslAturInvtlExtInfo_pt, sizeof(adslAturInvtlExtInfo));
  2852. kfree(pts.adslAturInvtlExtInfo_pt);
  2853. break;
  2854. #endif
  2855. case GET_ADSL_ATUC_CHAN_PERF_DATA:
  2856. pts.atucChannelPerfDataEntry_pt = (atucChannelPerfDataEntry *)kmalloc(sizeof(atucChannelPerfDataEntry), GFP_KERNEL);
  2857. copy_from_user((char *)pts.atucChannelPerfDataEntry_pt, (char *)lon, sizeof(atucChannelPerfDataEntry));
  2858. pts.atucChannelPerfDataEntry_pt->flags = 0;
  2859. copy_to_user((char *)lon, (char *)pts.atucChannelPerfDataEntry_pt, sizeof(atucChannelPerfDataEntry));
  2860. kfree(pts.atucChannelPerfDataEntry_pt);
  2861. break;
  2862. case GET_ADSL_ATUR_CHAN_PERF_DATA:
  2863. pts.aturChannelPerfDataEntry_pt = (aturChannelPerfDataEntry *)kmalloc(sizeof(aturChannelPerfDataEntry), GFP_KERNEL);
  2864. copy_from_user((char *)pts.aturChannelPerfDataEntry_pt, (char *)lon, sizeof(aturChannelPerfDataEntry));
  2865. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_RECV_BLK_FLAG)){
  2866. pts.aturChannelPerfDataEntry_pt->adslAturChanReceivedBlks=ATUR_CHAN_RECV_BLK;
  2867. }
  2868. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_TX_BLK_FLAG)){
  2869. pts.aturChannelPerfDataEntry_pt->adslAturChanTransmittedBlks=ATUR_CHAN_TX_BLK;
  2870. }
  2871. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_CORR_BLK_FLAG)){
  2872. pts.aturChannelPerfDataEntry_pt->adslAturChanCorrectedBlks=ATUR_CHAN_CORR_BLK;
  2873. }
  2874. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_UNCORR_BLK_FLAG)){
  2875. pts.aturChannelPerfDataEntry_pt->adslAturChanUncorrectBlks=ATUR_CHAN_UNCORR_BLK;
  2876. }
  2877. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_VALID_INTVL_FLAG)){
  2878. i=0;
  2879. for(ptr=(current_intvl->list).prev; ptr!=&interval_list; ptr=ptr->prev){
  2880. i++;
  2881. if(i==96)
  2882. break;
  2883. }
  2884. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfValidIntervals=i;
  2885. }
  2886. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_INVALID_INTVL_FLAG)){
  2887. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfInvalidIntervals=0;
  2888. }
  2889. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_CURR_15MIN_TIME_ELAPSED_FLAG)){
  2890. do_gettimeofday(&time_now);
  2891. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfCurr15MinTimeElapsed=time_now.tv_sec - (current_intvl->start_time).tv_sec;
  2892. }
  2893. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_CURR_15MIN_RECV_BLK_FLAG)){
  2894. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfCurr15MinReceivedBlks=current_intvl->AturChanPerfRxBlk;
  2895. }
  2896. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_CURR_15MIN_TX_BLK_FLAG)){
  2897. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfCurr15MinTransmittedBlks=current_intvl->AturChanPerfTxBlk;
  2898. }
  2899. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_CURR_15MIN_CORR_BLK_FLAG)){
  2900. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfCurr15MinCorrectedBlks=current_intvl->AturChanPerfCorrBlk;
  2901. }
  2902. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_CURR_15MIN_UNCORR_BLK_FLAG)){
  2903. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfCurr15MinUncorrectBlks=current_intvl->AturChanPerfUncorrBlk;
  2904. }
  2905. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_CURR_1DAY_TIME_ELAPSED_FLAG)){
  2906. i=0;
  2907. for(ptr=(current_intvl->list).prev; ptr!=&interval_list; ptr=ptr->prev){
  2908. i+=900;
  2909. }
  2910. do_gettimeofday(&time_now);
  2911. i+=time_now.tv_sec - (current_intvl->start_time).tv_sec;
  2912. if(i>=86400)
  2913. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfCurr1DayTimeElapsed=i-86400;
  2914. else
  2915. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfCurr1DayTimeElapsed=i;
  2916. }
  2917. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_CURR_1DAY_RECV_BLK_FLAG)){
  2918. i=0;
  2919. j=0;
  2920. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2921. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2922. j+=mib_ptr->AturChanPerfRxBlk;
  2923. i++;
  2924. if(i==96)
  2925. j=0;
  2926. }
  2927. j+=current_intvl->AturChanPerfRxBlk;
  2928. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfCurr1DayReceivedBlks=j;
  2929. }
  2930. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_CURR_1DAY_TX_BLK_FLAG)){
  2931. i=0;
  2932. j=0;
  2933. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2934. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2935. j+=mib_ptr->AturChanPerfTxBlk;
  2936. i++;
  2937. if(i==96)
  2938. j=0;
  2939. }
  2940. j+=current_intvl->AturChanPerfTxBlk;
  2941. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfCurr1DayTransmittedBlks=j;
  2942. }
  2943. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_CURR_1DAY_CORR_BLK_FLAG)){
  2944. i=0;
  2945. j=0;
  2946. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2947. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2948. j+=mib_ptr->AturChanPerfCorrBlk;
  2949. i++;
  2950. if(i==96)
  2951. j=0;
  2952. }
  2953. j+=current_intvl->AturChanPerfCorrBlk;
  2954. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfCurr1DayCorrectedBlks=j;
  2955. }
  2956. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_CURR_1DAY_UNCORR_BLK_FLAG)){
  2957. i=0;
  2958. j=0;
  2959. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2960. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2961. j+=mib_ptr->AturChanPerfUncorrBlk;
  2962. i++;
  2963. if(i==96)
  2964. j=0;
  2965. }
  2966. j+=current_intvl->AturChanPerfUncorrBlk;
  2967. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfCurr1DayUncorrectBlks=j;
  2968. }
  2969. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_PREV_1DAY_MONI_SEC_FLAG)){
  2970. i=0;
  2971. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2972. i++;
  2973. }
  2974. if(i>=96)
  2975. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfPrev1DayMoniSecs=86400;
  2976. else
  2977. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfPrev1DayMoniSecs=0;
  2978. }
  2979. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_PREV_1DAY_RECV_BLK_FLAG)){
  2980. i=0;
  2981. j=0;
  2982. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2983. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2984. j+=mib_ptr->AturChanPerfRxBlk;
  2985. i++;
  2986. if(i==96)
  2987. break;
  2988. }
  2989. if(i==96)
  2990. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfPrev1DayReceivedBlks=j;
  2991. else
  2992. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfPrev1DayReceivedBlks=0;
  2993. }
  2994. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_PREV_1DAY_TRANS_BLK_FLAG)){
  2995. i=0;
  2996. j=0;
  2997. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  2998. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  2999. j+=mib_ptr->AturChanPerfTxBlk;
  3000. i++;
  3001. if(i==96)
  3002. break;
  3003. }
  3004. if(i==96)
  3005. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfPrev1DayTransmittedBlks=j;
  3006. else
  3007. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfPrev1DayTransmittedBlks=0;
  3008. }
  3009. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_PREV_1DAY_CORR_BLK_FLAG)){
  3010. i=0;
  3011. j=0;
  3012. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  3013. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  3014. j+=mib_ptr->AturChanPerfCorrBlk;
  3015. i++;
  3016. if(i==96)
  3017. break;
  3018. }
  3019. if(i==96)
  3020. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfPrev1DayCorrectedBlks=j;
  3021. else
  3022. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfPrev1DayCorrectedBlks=0;
  3023. }
  3024. if(IS_FLAG_SET((&(pts.aturChannelPerfDataEntry_pt->flags)), ATUR_CHAN_PERF_PREV_1DAY_UNCORR_BLK_FLAG)){
  3025. i=0;
  3026. j=0;
  3027. for(ptr=interval_list.next; ptr!=&(current_intvl->list); ptr=ptr->next){
  3028. mib_ptr = list_entry(ptr, amazon_mei_mib, list);
  3029. j+=mib_ptr->AturChanPerfUncorrBlk;
  3030. i++;
  3031. if(i==96)
  3032. break;
  3033. }
  3034. if(i==96)
  3035. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfPrev1DayUncorrectBlks=j;
  3036. else
  3037. pts.aturChannelPerfDataEntry_pt->adslAturChanPerfPrev1DayUncorrectBlks=0;
  3038. }
  3039. copy_to_user((char *)lon, (char *)pts.aturChannelPerfDataEntry_pt, sizeof(aturChannelPerfDataEntry));
  3040. kfree(pts.aturChannelPerfDataEntry_pt);
  3041. break;
  3042. case GET_ADSL_ATUC_CHAN_INTVL_INFO:
  3043. pts.adslAtucChanIntvlInfo_pt = (adslAtucChanIntvlInfo *)kmalloc(sizeof(adslAtucChanIntvlInfo), GFP_KERNEL);
  3044. copy_from_user((char *)pts.adslAtucChanIntvlInfo_pt, (char *)lon, sizeof(adslAtucChanIntvlInfo));
  3045. pts.adslAtucChanIntvlInfo_pt->flags = 0;
  3046. copy_to_user((char *)lon, (char *)pts.adslAtucChanIntvlInfo_pt, sizeof(adslAtucChanIntvlInfo));
  3047. kfree(pts.adslAtucChanIntvlInfo_pt);
  3048. break;
  3049. case GET_ADSL_ATUR_CHAN_INTVL_INFO:
  3050. pts.adslAturChanIntvlInfo_pt = (adslAturChanIntvlInfo *)kmalloc(sizeof(adslAturChanIntvlInfo), GFP_KERNEL);
  3051. copy_from_user((char *)pts.adslAturChanIntvlInfo_pt, (char *)lon, sizeof(adslAturChanIntvlInfo));
  3052. if(pts.adslAturChanIntvlInfo_pt->IntervalNumber <1){
  3053. pts.adslAturChanIntvlInfo_pt->chanIntervalRecvdBlks = ATUR_CHAN_RECV_BLK;
  3054. pts.adslAturChanIntvlInfo_pt->chanIntervalXmitBlks = ATUR_CHAN_TX_BLK;
  3055. pts.adslAturChanIntvlInfo_pt->chanIntervalCorrectedBlks = ATUR_CHAN_CORR_BLK;
  3056. pts.adslAturChanIntvlInfo_pt->chanIntervalUncorrectBlks = ATUR_CHAN_UNCORR_BLK;
  3057. pts.adslAturChanIntvlInfo_pt->intervalValidData = 1;
  3058. }
  3059. else{
  3060. i=0;
  3061. for(ptr=(current_intvl->list).prev; ptr!=&interval_list; ptr=ptr->prev){
  3062. i++;
  3063. if(i==pts.adslAturChanIntvlInfo_pt->IntervalNumber){
  3064. temp_intvl = list_entry(ptr, amazon_mei_mib, list);
  3065. pts.adslAturChanIntvlInfo_pt->chanIntervalRecvdBlks = temp_intvl->AturChanPerfRxBlk;
  3066. pts.adslAturChanIntvlInfo_pt->chanIntervalXmitBlks = temp_intvl->AturChanPerfTxBlk;
  3067. pts.adslAturChanIntvlInfo_pt->chanIntervalCorrectedBlks = temp_intvl->AturChanPerfCorrBlk;
  3068. pts.adslAturChanIntvlInfo_pt->chanIntervalUncorrectBlks = temp_intvl->AturChanPerfUncorrBlk;
  3069. pts.adslAturChanIntvlInfo_pt->intervalValidData = 1;
  3070. break;
  3071. }
  3072. }
  3073. if(ptr==&interval_list){
  3074. pts.adslAturChanIntvlInfo_pt->intervalValidData = 0;
  3075. pts.adslAturChanIntvlInfo_pt->flags = 0;
  3076. }
  3077. }
  3078. copy_to_user((char *)lon, (char *)pts.adslAturChanIntvlInfo_pt, sizeof(adslAturChanIntvlInfo));
  3079. kfree(pts.adslAturChanIntvlInfo_pt);
  3080. break;
  3081. case GET_ADSL_ALRM_CONF_PROF:
  3082. pts.adslLineAlarmConfProfileEntry_pt = (adslLineAlarmConfProfileEntry *)kmalloc(sizeof(adslLineAlarmConfProfileEntry), GFP_KERNEL);
  3083. copy_from_user((char *)pts.adslLineAlarmConfProfileEntry_pt, (char *)lon, sizeof(adslLineAlarmConfProfileEntry));
  3084. strncpy(pts.adslLineAlarmConfProfileEntry_pt->adslLineAlarmConfProfileName, AlarmConfProfile.adslLineAlarmConfProfileName, 32);
  3085. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_THRESH_15MIN_LOFS_FLAG)){
  3086. pts.adslLineAlarmConfProfileEntry_pt->adslAtucThresh15MinLofs=AlarmConfProfile.adslAtucThresh15MinLofs;
  3087. }
  3088. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_THRESH_15MIN_LOSS_FLAG)){
  3089. pts.adslLineAlarmConfProfileEntry_pt->adslAtucThresh15MinLoss=AlarmConfProfile.adslAtucThresh15MinLoss;
  3090. }
  3091. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_THRESH_15MIN_ESS_FLAG)){
  3092. pts.adslLineAlarmConfProfileEntry_pt->adslAtucThresh15MinESs=AlarmConfProfile.adslAtucThresh15MinESs;
  3093. }
  3094. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_THRESH_FAST_RATEUP_FLAG)){
  3095. pts.adslLineAlarmConfProfileEntry_pt->adslAtucThreshFastRateUp=AlarmConfProfile.adslAtucThreshFastRateUp;
  3096. }
  3097. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_THRESH_INTERLEAVE_RATEUP_FLAG)){
  3098. pts.adslLineAlarmConfProfileEntry_pt->adslAtucThreshInterleaveRateUp=AlarmConfProfile.adslAtucThreshInterleaveRateUp;
  3099. }
  3100. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_THRESH_FAST_RATEDOWN_FLAG)){
  3101. pts.adslLineAlarmConfProfileEntry_pt->adslAtucThreshFastRateDown=AlarmConfProfile.adslAtucThreshFastRateDown;
  3102. }
  3103. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_THRESH_INTERLEAVE_RATEDOWN_FLAG)){
  3104. pts.adslLineAlarmConfProfileEntry_pt->adslAtucThreshInterleaveRateDown=AlarmConfProfile.adslAtucThreshInterleaveRateDown;
  3105. }
  3106. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_INIT_FAILURE_TRAP_ENABLE_FLAG)){
  3107. pts.adslLineAlarmConfProfileEntry_pt->adslAtucInitFailureTrapEnable=AlarmConfProfile.adslAtucInitFailureTrapEnable;
  3108. }
  3109. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_15MIN_LOFS_FLAG)){
  3110. pts.adslLineAlarmConfProfileEntry_pt->adslAturThresh15MinLofs=AlarmConfProfile.adslAturThresh15MinLofs;
  3111. }
  3112. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_15MIN_LOSS_FLAG)){
  3113. pts.adslLineAlarmConfProfileEntry_pt->adslAturThresh15MinLoss=AlarmConfProfile.adslAturThresh15MinLoss;
  3114. }
  3115. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_15MIN_LPRS_FLAG)){
  3116. pts.adslLineAlarmConfProfileEntry_pt->adslAturThresh15MinLprs=AlarmConfProfile.adslAturThresh15MinLprs;
  3117. }
  3118. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_15MIN_ESS_FLAG)){
  3119. pts.adslLineAlarmConfProfileEntry_pt->adslAturThresh15MinESs=AlarmConfProfile.adslAturThresh15MinESs;
  3120. }
  3121. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_FAST_RATEUP_FLAG)){
  3122. pts.adslLineAlarmConfProfileEntry_pt->adslAturThreshFastRateUp=AlarmConfProfile.adslAturThreshFastRateUp;
  3123. }
  3124. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_INTERLEAVE_RATEUP_FLAG)){
  3125. pts.adslLineAlarmConfProfileEntry_pt->adslAturThreshInterleaveRateUp=AlarmConfProfile.adslAturThreshInterleaveRateUp;
  3126. }
  3127. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_FAST_RATEDOWN_FLAG)){
  3128. pts.adslLineAlarmConfProfileEntry_pt->adslAturThreshFastRateDown=AlarmConfProfile.adslAturThreshFastRateDown;
  3129. }
  3130. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_INTERLEAVE_RATEDOWN_FLAG)){
  3131. pts.adslLineAlarmConfProfileEntry_pt->adslAturThreshInterleaveRateDown=AlarmConfProfile.adslAturThreshInterleaveRateDown;
  3132. }
  3133. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), LINE_ALARM_CONF_PROFILE_ROWSTATUS_FLAG)){
  3134. pts.adslLineAlarmConfProfileEntry_pt->adslLineAlarmConfProfileRowStatus=AlarmConfProfile.adslLineAlarmConfProfileRowStatus;
  3135. }
  3136. copy_to_user((char *)lon, (char *)pts.adslLineAlarmConfProfileEntry_pt, sizeof(adslLineAlarmConfProfileEntry));
  3137. kfree(pts.adslLineAlarmConfProfileEntry_pt);
  3138. break;
  3139. #ifdef AMAZON_MEI_MIB_RFC3440
  3140. case GET_ADSL_ALRM_CONF_PROF_EXT:
  3141. pts.adslLineAlarmConfProfileExtEntry_pt = (adslLineAlarmConfProfileExtEntry *)kmalloc(sizeof(adslLineAlarmConfProfileExtEntry), GFP_KERNEL);
  3142. copy_from_user((char *)pts.adslLineAlarmConfProfileExtEntry_pt, (char *)lon, sizeof(adslLineAlarmConfProfileExtEntry));
  3143. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileExtEntry_pt->flags)), ATUC_THRESH_15MIN_FAILED_FASTR_FLAG)){
  3144. pts.adslLineAlarmConfProfileExtEntry_pt->adslAtucThreshold15MinFailedFastR=AlarmConfProfileExt.adslAtucThreshold15MinFailedFastR;
  3145. }
  3146. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileExtEntry_pt->flags)), ATUC_THRESH_15MIN_SESL_FLAG)){
  3147. pts.adslLineAlarmConfProfileExtEntry_pt->adslAtucThreshold15MinSesL=AlarmConfProfileExt.adslAtucThreshold15MinSesL;
  3148. }
  3149. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileExtEntry_pt->flags)), ATUC_THRESH_15MIN_UASL_FLAG)){
  3150. pts.adslLineAlarmConfProfileExtEntry_pt->adslAtucThreshold15MinUasL=AlarmConfProfileExt.adslAtucThreshold15MinUasL;
  3151. }
  3152. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileExtEntry_pt->flags)), ATUR_THRESH_15MIN_SESL_FLAG)){
  3153. pts.adslLineAlarmConfProfileExtEntry_pt->adslAturThreshold15MinSesL=AlarmConfProfileExt.adslAturThreshold15MinSesL;
  3154. }
  3155. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileExtEntry_pt->flags)), ATUR_THRESH_15MIN_UASL_FLAG)){
  3156. pts.adslLineAlarmConfProfileExtEntry_pt->adslAturThreshold15MinUasL=AlarmConfProfileExt.adslAturThreshold15MinUasL;
  3157. }
  3158. copy_to_user((char *)lon, (char *)pts.adslLineAlarmConfProfileExtEntry_pt, sizeof(adslLineAlarmConfProfileExtEntry));
  3159. kfree(pts.adslLineAlarmConfProfileExtEntry_pt);
  3160. break;
  3161. #endif
  3162. case SET_ADSL_ALRM_CONF_PROF:
  3163. pts.adslLineAlarmConfProfileEntry_pt = (adslLineAlarmConfProfileEntry *)kmalloc(sizeof(adslLineAlarmConfProfileEntry), GFP_KERNEL);
  3164. copy_from_user((char *)pts.adslLineAlarmConfProfileEntry_pt, (char *)lon, sizeof(adslLineAlarmConfProfileEntry));
  3165. strncpy(AlarmConfProfile.adslLineAlarmConfProfileName, pts.adslLineAlarmConfProfileEntry_pt->adslLineAlarmConfProfileName, 32);
  3166. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_THRESH_15MIN_LOFS_FLAG)){
  3167. AlarmConfProfile.adslAtucThresh15MinLofs=pts.adslLineAlarmConfProfileEntry_pt->adslAtucThresh15MinLofs;
  3168. }
  3169. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_THRESH_15MIN_LOSS_FLAG)){
  3170. AlarmConfProfile.adslAtucThresh15MinLoss=pts.adslLineAlarmConfProfileEntry_pt->adslAtucThresh15MinLoss;
  3171. }
  3172. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_THRESH_15MIN_ESS_FLAG)){
  3173. AlarmConfProfile.adslAtucThresh15MinESs=pts.adslLineAlarmConfProfileEntry_pt->adslAtucThresh15MinESs;
  3174. }
  3175. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_THRESH_FAST_RATEUP_FLAG)){
  3176. AlarmConfProfile.adslAtucThreshFastRateUp=pts.adslLineAlarmConfProfileEntry_pt->adslAtucThreshFastRateUp;
  3177. }
  3178. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_THRESH_INTERLEAVE_RATEUP_FLAG)){
  3179. AlarmConfProfile.adslAtucThreshInterleaveRateUp=pts.adslLineAlarmConfProfileEntry_pt->adslAtucThreshInterleaveRateUp;
  3180. }
  3181. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_THRESH_FAST_RATEDOWN_FLAG)){
  3182. AlarmConfProfile.adslAtucThreshFastRateDown=pts.adslLineAlarmConfProfileEntry_pt->adslAtucThreshFastRateDown;
  3183. }
  3184. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_THRESH_INTERLEAVE_RATEDOWN_FLAG)){
  3185. AlarmConfProfile.adslAtucThreshInterleaveRateDown=pts.adslLineAlarmConfProfileEntry_pt->adslAtucThreshInterleaveRateDown;
  3186. }
  3187. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUC_INIT_FAILURE_TRAP_ENABLE_FLAG)){
  3188. AlarmConfProfile.adslAtucInitFailureTrapEnable=pts.adslLineAlarmConfProfileEntry_pt->adslAtucInitFailureTrapEnable;
  3189. }
  3190. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_15MIN_LOFS_FLAG)){
  3191. AlarmConfProfile.adslAturThresh15MinLofs=pts.adslLineAlarmConfProfileEntry_pt->adslAturThresh15MinLofs;
  3192. }
  3193. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_15MIN_LOSS_FLAG)){
  3194. AlarmConfProfile.adslAturThresh15MinLoss=pts.adslLineAlarmConfProfileEntry_pt->adslAturThresh15MinLoss;
  3195. }
  3196. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_15MIN_LPRS_FLAG)){
  3197. AlarmConfProfile.adslAturThresh15MinLprs=pts.adslLineAlarmConfProfileEntry_pt->adslAturThresh15MinLprs;
  3198. }
  3199. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_15MIN_ESS_FLAG)){
  3200. AlarmConfProfile.adslAturThresh15MinESs=pts.adslLineAlarmConfProfileEntry_pt->adslAturThresh15MinESs;
  3201. }
  3202. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_FAST_RATEUP_FLAG)){
  3203. AlarmConfProfile.adslAturThreshFastRateUp=pts.adslLineAlarmConfProfileEntry_pt->adslAturThreshFastRateUp;
  3204. }
  3205. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_INTERLEAVE_RATEUP_FLAG)){
  3206. AlarmConfProfile.adslAturThreshInterleaveRateUp=pts.adslLineAlarmConfProfileEntry_pt->adslAturThreshInterleaveRateUp;
  3207. }
  3208. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_FAST_RATEDOWN_FLAG)){
  3209. AlarmConfProfile.adslAturThreshFastRateDown=pts.adslLineAlarmConfProfileEntry_pt->adslAturThreshFastRateDown;
  3210. }
  3211. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), ATUR_THRESH_INTERLEAVE_RATEDOWN_FLAG)){
  3212. AlarmConfProfile.adslAturThreshInterleaveRateDown=pts.adslLineAlarmConfProfileEntry_pt->adslAturThreshInterleaveRateDown;
  3213. }
  3214. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileEntry_pt->flags)), LINE_ALARM_CONF_PROFILE_ROWSTATUS_FLAG)){
  3215. AlarmConfProfile.adslLineAlarmConfProfileRowStatus=pts.adslLineAlarmConfProfileEntry_pt->adslLineAlarmConfProfileRowStatus;
  3216. }
  3217. copy_to_user((char *)lon, (char *)pts.adslLineAlarmConfProfileEntry_pt, sizeof(adslLineAlarmConfProfileEntry));
  3218. kfree(pts.adslLineAlarmConfProfileEntry_pt);
  3219. break;
  3220. #ifdef AMAZON_MEI_MIB_RFC3440
  3221. case SET_ADSL_ALRM_CONF_PROF_EXT:
  3222. pts.adslLineAlarmConfProfileExtEntry_pt = (adslLineAlarmConfProfileExtEntry *)kmalloc(sizeof(adslLineAlarmConfProfileExtEntry), GFP_KERNEL);
  3223. copy_from_user((char *)pts.adslLineAlarmConfProfileExtEntry_pt, (char *)lon, sizeof(adslLineAlarmConfProfileExtEntry));
  3224. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileExtEntry_pt->flags)), ATUC_THRESH_15MIN_FAILED_FASTR_FLAG)){
  3225. AlarmConfProfileExt.adslAtucThreshold15MinFailedFastR=pts.adslLineAlarmConfProfileExtEntry_pt->adslAtucThreshold15MinFailedFastR;
  3226. }
  3227. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileExtEntry_pt->flags)), ATUC_THRESH_15MIN_SESL_FLAG)){
  3228. AlarmConfProfileExt.adslAtucThreshold15MinSesL=pts.adslLineAlarmConfProfileExtEntry_pt->adslAtucThreshold15MinSesL;
  3229. }
  3230. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileExtEntry_pt->flags)), ATUC_THRESH_15MIN_UASL_FLAG)){
  3231. AlarmConfProfileExt.adslAtucThreshold15MinUasL=pts.adslLineAlarmConfProfileExtEntry_pt->adslAtucThreshold15MinUasL;
  3232. }
  3233. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileExtEntry_pt->flags)), ATUR_THRESH_15MIN_SESL_FLAG)){
  3234. AlarmConfProfileExt.adslAturThreshold15MinSesL=pts.adslLineAlarmConfProfileExtEntry_pt->adslAturThreshold15MinSesL;
  3235. }
  3236. if(IS_FLAG_SET((&(pts.adslLineAlarmConfProfileExtEntry_pt->flags)), ATUR_THRESH_15MIN_UASL_FLAG)){
  3237. AlarmConfProfileExt.adslAturThreshold15MinUasL=pts.adslLineAlarmConfProfileExtEntry_pt->adslAturThreshold15MinUasL;
  3238. }
  3239. copy_to_user((char *)lon, (char *)pts.adslLineAlarmConfProfileExtEntry_pt, sizeof(adslLineAlarmConfProfileExtEntry));
  3240. kfree(pts.adslLineAlarmConfProfileExtEntry_pt);
  3241. break;
  3242. #endif
  3243. case ADSL_ATUR_TRAPS:
  3244. if(down_interruptible(&mei_sema))
  3245. return -ERESTARTSYS;
  3246. trapsflag=0;
  3247. if(AlarmConfProfile.adslAtucThresh15MinLofs!=0 && current_intvl->AtucPerfLof>=AlarmConfProfile.adslAtucThresh15MinLofs)
  3248. trapsflag|=ATUC_PERF_LOFS_THRESH_FLAG;
  3249. if(AlarmConfProfile.adslAtucThresh15MinLoss!=0 && current_intvl->AtucPerfLos>=AlarmConfProfile.adslAtucThresh15MinLoss)
  3250. trapsflag|=ATUC_PERF_LOSS_THRESH_FLAG;
  3251. if(AlarmConfProfile.adslAtucThresh15MinESs!=0 && current_intvl->AtucPerfEs>=AlarmConfProfile.adslAtucThresh15MinESs)
  3252. trapsflag|=ATUC_PERF_ESS_THRESH_FLAG;
  3253. if(chantype.fast==1){
  3254. if(AlarmConfProfile.adslAtucThreshFastRateUp!=0 || AlarmConfProfile.adslAtucThreshFastRateDown!=0){
  3255. ATUC_CHAN_CURR_TX_RATE_FLAG_MAKECMV;
  3256. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3257. #ifdef AMAZON_MEI_DEBUG_ON
  3258. printk("\n\nCMV fail, Group 6 Address 1 Index 0");
  3259. #endif
  3260. }
  3261. else{
  3262. temp = (u32)(RxMessage[4]) + (((u32)(RxMessage[5]))<<16);
  3263. if((AlarmConfProfile.adslAtucThreshFastRateUp!=0) && (temp>=PrevTxRate.adslAtucChanPrevTxRate+AlarmConfProfile.adslAtucThreshFastRateUp)){
  3264. trapsflag|=ATUC_RATE_CHANGE_FLAG;
  3265. PrevTxRate.adslAtucChanPrevTxRate = temp;
  3266. }
  3267. if((AlarmConfProfile.adslAtucThreshFastRateDown!=0) && (temp<=PrevTxRate.adslAtucChanPrevTxRate-AlarmConfProfile.adslAtucThreshFastRateDown)){
  3268. trapsflag|=ATUC_RATE_CHANGE_FLAG;
  3269. PrevTxRate.adslAtucChanPrevTxRate = temp;
  3270. }
  3271. }
  3272. }
  3273. }
  3274. if(chantype.interleave==1){
  3275. if(AlarmConfProfile.adslAtucThreshInterleaveRateUp!=0 || AlarmConfProfile.adslAtucThreshInterleaveRateDown!=0){
  3276. ATUC_CHAN_CURR_TX_RATE_FLAG_MAKECMV;
  3277. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3278. #ifdef AMAZON_MEI_DEBUG_ON
  3279. printk("\n\nCMV fail, Group 6 Address 1 Index 0");
  3280. #endif
  3281. }
  3282. else{
  3283. temp = (u32)(RxMessage[4]) + (((u32)(RxMessage[5]))<<16);
  3284. if((AlarmConfProfile.adslAtucThreshInterleaveRateUp!=0) && (temp>=PrevTxRate.adslAtucChanPrevTxRate+AlarmConfProfile.adslAtucThreshInterleaveRateUp)){
  3285. trapsflag|=ATUC_RATE_CHANGE_FLAG;
  3286. PrevTxRate.adslAtucChanPrevTxRate = temp;
  3287. }
  3288. if((AlarmConfProfile.adslAtucThreshInterleaveRateDown!=0) && (temp<=PrevTxRate.adslAtucChanPrevTxRate-AlarmConfProfile.adslAtucThreshInterleaveRateDown)){
  3289. trapsflag|=ATUC_RATE_CHANGE_FLAG;
  3290. PrevTxRate.adslAtucChanPrevTxRate = temp;
  3291. }
  3292. }
  3293. }
  3294. }
  3295. if(AlarmConfProfile.adslAturThresh15MinLofs!=0 && current_intvl->AturPerfLof>=AlarmConfProfile.adslAturThresh15MinLofs)
  3296. trapsflag|=ATUR_PERF_LOFS_THRESH_FLAG;
  3297. if(AlarmConfProfile.adslAturThresh15MinLoss!=0 && current_intvl->AturPerfLos>=AlarmConfProfile.adslAturThresh15MinLoss)
  3298. trapsflag|=ATUR_PERF_LOSS_THRESH_FLAG;
  3299. if(AlarmConfProfile.adslAturThresh15MinLprs!=0 && current_intvl->AturPerfLpr>=AlarmConfProfile.adslAturThresh15MinLprs)
  3300. trapsflag|=ATUR_PERF_LPRS_THRESH_FLAG;
  3301. if(AlarmConfProfile.adslAturThresh15MinESs!=0 && current_intvl->AturPerfEs>=AlarmConfProfile.adslAturThresh15MinESs)
  3302. trapsflag|=ATUR_PERF_ESS_THRESH_FLAG;
  3303. if(chantype.fast==1){
  3304. if(AlarmConfProfile.adslAturThreshFastRateUp!=0 || AlarmConfProfile.adslAturThreshFastRateDown!=0){
  3305. ATUR_CHAN_CURR_TX_RATE_FLAG_MAKECMV;
  3306. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3307. #ifdef AMAZON_MEI_DEBUG_ON
  3308. printk("\n\nCMV fail, Group 6 Address 0 Index 0");
  3309. #endif
  3310. }
  3311. else{
  3312. temp = (u32)(RxMessage[4]) + (((u32)(RxMessage[5]))<<16);
  3313. if((AlarmConfProfile.adslAturThreshFastRateUp!=0) && (temp>=PrevTxRate.adslAturChanPrevTxRate+AlarmConfProfile.adslAturThreshFastRateUp)){
  3314. trapsflag|=ATUR_RATE_CHANGE_FLAG;
  3315. PrevTxRate.adslAturChanPrevTxRate = temp;
  3316. }
  3317. if((AlarmConfProfile.adslAturThreshFastRateDown!=0) && (temp<=PrevTxRate.adslAturChanPrevTxRate-AlarmConfProfile.adslAturThreshFastRateDown)){
  3318. trapsflag|=ATUR_RATE_CHANGE_FLAG;
  3319. PrevTxRate.adslAturChanPrevTxRate = temp;
  3320. }
  3321. }
  3322. }
  3323. }
  3324. if(chantype.interleave==1){
  3325. if(AlarmConfProfile.adslAturThreshInterleaveRateUp!=0 || AlarmConfProfile.adslAturThreshInterleaveRateDown!=0){
  3326. ATUR_CHAN_CURR_TX_RATE_FLAG_MAKECMV;
  3327. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3328. #ifdef AMAZON_MEI_DEBUG_ON
  3329. printk("\n\nCMV fail, Group 6 Address 0 Index 0");
  3330. #endif
  3331. }
  3332. else{
  3333. temp = (u32)(RxMessage[4]) + (((u32)(RxMessage[5]))<<16);
  3334. if((AlarmConfProfile.adslAturThreshInterleaveRateUp!=0) && (temp>=PrevTxRate.adslAturChanPrevTxRate+AlarmConfProfile.adslAturThreshInterleaveRateUp)){
  3335. trapsflag|=ATUR_RATE_CHANGE_FLAG;
  3336. PrevTxRate.adslAturChanPrevTxRate = temp;
  3337. }
  3338. if((AlarmConfProfile.adslAturThreshInterleaveRateDown!=0) && (temp<=PrevTxRate.adslAturChanPrevTxRate-AlarmConfProfile.adslAturThreshInterleaveRateDown)){
  3339. trapsflag|=ATUR_RATE_CHANGE_FLAG;
  3340. PrevTxRate.adslAturChanPrevTxRate = temp;
  3341. }
  3342. }
  3343. }
  3344. }
  3345. copy_to_user((char *)lon, (char *)(&trapsflag), 2);
  3346. up(&mei_sema);
  3347. break;
  3348. #ifdef AMAZON_MEI_MIB_RFC3440
  3349. case ADSL_ATUR_EXT_TRAPS:
  3350. trapsflag=0;
  3351. if(AlarmConfProfileExt.adslAtucThreshold15MinFailedFastR!=0 && current_intvl->AtucPerfStatFailedFastR>=AlarmConfProfileExt.adslAtucThreshold15MinFailedFastR)
  3352. trapsflag|=ATUC_15MIN_FAILED_FASTR_TRAP_FLAG;
  3353. if(AlarmConfProfileExt.adslAtucThreshold15MinSesL!=0 && current_intvl->AtucPerfStatSesL>=AlarmConfProfileExt.adslAtucThreshold15MinSesL)
  3354. trapsflag|=ATUC_15MIN_SESL_TRAP_FLAG;
  3355. if(AlarmConfProfileExt.adslAtucThreshold15MinUasL!=0 && current_intvl->AtucPerfStatUasL>=AlarmConfProfileExt.adslAtucThreshold15MinUasL)
  3356. trapsflag|=ATUC_15MIN_UASL_TRAP_FLAG;
  3357. if(AlarmConfProfileExt.adslAturThreshold15MinSesL!=0 && current_intvl->AturPerfStatSesL>=AlarmConfProfileExt.adslAturThreshold15MinSesL)
  3358. trapsflag|=ATUR_15MIN_SESL_TRAP_FLAG;
  3359. if(AlarmConfProfileExt.adslAturThreshold15MinUasL!=0 && current_intvl->AturPerfStatUasL>=AlarmConfProfileExt.adslAturThreshold15MinUasL)
  3360. trapsflag|=ATUR_15MIN_UASL_TRAP_FLAG;
  3361. copy_to_user((char *)lon, (char *)(&trapsflag), 2);
  3362. break;
  3363. #endif
  3364. // 603221:tc.chen start
  3365. case GET_ADSL_LINE_STATUS:
  3366. if(down_interruptible(&mei_sema))
  3367. return -ERESTARTSYS;
  3368. pts.adslLineStatusInfo_pt = (adslLineStatusInfo *)kmalloc(sizeof(adslLineStatusInfo), GFP_KERNEL);
  3369. copy_from_user((char *)pts.adslLineStatusInfo_pt, (char *)lon, sizeof(adslLineStatusInfo));
  3370. if(IS_FLAG_SET((&(pts.adslLineStatusInfo_pt->flags)), LINE_STAT_MODEM_STATUS_FLAG)){
  3371. LINE_STAT_MODEM_STATUS_FLAG_MAKECMV;
  3372. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3373. #ifdef AMAZON_MEI_DEBUG_ON
  3374. printk("\n\nCMV fail, Group STAT Address 0 Index 0");
  3375. #endif
  3376. pts.adslLineStatusInfo_pt->adslModemStatus = 0;
  3377. }
  3378. else{
  3379. pts.adslLineStatusInfo_pt->adslModemStatus = RxMessage[4];
  3380. }
  3381. }
  3382. if(IS_FLAG_SET((&(pts.adslLineStatusInfo_pt->flags)), LINE_STAT_MODE_SEL_FLAG)){
  3383. LINE_STAT_MODE_SEL_FLAG_MAKECMV;
  3384. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3385. #ifdef AMAZON_MEI_DEBUG_ON
  3386. printk("\n\nCMV fail, Group STAT Address 1 Index 0");
  3387. #endif
  3388. pts.adslLineStatusInfo_pt->adslModeSelected = 0;
  3389. }
  3390. else{
  3391. pts.adslLineStatusInfo_pt->adslModeSelected = RxMessage[4];
  3392. }
  3393. }
  3394. if(IS_FLAG_SET((&(pts.adslLineStatusInfo_pt->flags)), LINE_STAT_TRELLCOD_ENABLE_FLAG)){
  3395. LINE_STAT_TRELLCOD_ENABLE_FLAG_MAKECMV;
  3396. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3397. #ifdef AMAZON_MEI_DEBUG_ON
  3398. printk("\n\nCMV fail, Group OPTN Address 2 Index 0");
  3399. #endif
  3400. pts.adslLineStatusInfo_pt->adslTrellisCodeEnable = 0;
  3401. }
  3402. else{
  3403. pts.adslLineStatusInfo_pt->adslTrellisCodeEnable = (RxMessage[4]>>13)&0x1==0x1?0:1;
  3404. }
  3405. }
  3406. if(IS_FLAG_SET((&(pts.adslLineStatusInfo_pt->flags)), LINE_STAT_LATENCY_FLAG)){
  3407. LINE_STAT_LATENCY_FLAG_MAKECMV;
  3408. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3409. #ifdef AMAZON_MEI_DEBUG_ON
  3410. printk("\n\nCMV fail, Group STAT Address 12 Index 0");
  3411. #endif
  3412. pts.adslLineStatusInfo_pt->adslLatency = 0;
  3413. }
  3414. else{
  3415. pts.adslLineStatusInfo_pt->adslLatency = RxMessage[4];
  3416. }
  3417. }
  3418. copy_to_user((char *)lon, (char *)pts.adslLineStatusInfo_pt, sizeof(adslLineStatusInfo));
  3419. kfree(pts.adslLineStatusInfo_pt);
  3420. up(&mei_sema);
  3421. break;
  3422. case GET_ADSL_LINE_RATE:
  3423. if (showtime!=1)
  3424. return -ERESTARTSYS;
  3425. if(down_interruptible(&mei_sema))
  3426. return -ERESTARTSYS;
  3427. pts.adslLineRateInfo_pt = (adslLineRateInfo *)kmalloc(sizeof(adslLineRateInfo), GFP_KERNEL);
  3428. copy_from_user((char *)pts.adslLineRateInfo_pt, (char *)lon, sizeof(adslLineRateInfo));
  3429. if(IS_FLAG_SET((&(pts.adslLineRateInfo_pt->flags)), LINE_RATE_DATA_RATEDS_FLAG)){
  3430. if (adsl_mode <=8 && adsl_mode_extend==0) // adsl mode
  3431. {
  3432. if (chantype.interleave)
  3433. LINE_RATE_DATA_RATEDS_FLAG_ADSL1_LP0_MAKECMV;
  3434. else
  3435. LINE_RATE_DATA_RATEDS_FLAG_ADSL1_LP1_MAKECMV;
  3436. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3437. #ifdef AMAZON_MEI_DEBUG_ON
  3438. printk("\n\nCMV fail, Group RATE Address 1 Index 0");
  3439. #endif
  3440. pts.adslLineRateInfo_pt->adslDataRateds = 0;
  3441. }
  3442. else{
  3443. pts.adslLineRateInfo_pt->adslDataRateds = (u32)(RxMessage[4]) + (((u32)(RxMessage[5]))<<16);
  3444. }
  3445. }else // adsl 2/2+
  3446. {
  3447. unsigned long Mp,Lp,Tp,Rp,Kp,Bpn,DataRate,DataRate_remain;
  3448. Mp=Lp=Tp=Rp=Kp=Bpn=DataRate=DataRate_remain=0;
  3449. //// up stream data rate
  3450. if (chantype.interleave)
  3451. {
  3452. LINE_RATE_DATA_RATEUS_FLAG_ADSL2_LP_LP0_MAKECMV;
  3453. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3454. #ifdef AMAZON_MEI_DEBUG_ON
  3455. printk("\n\nCMV fail, Group CNFG Address 25 Index 0");
  3456. #endif
  3457. Lp = 0;
  3458. }else
  3459. Lp=RxMessage[4];
  3460. LINE_RATE_DATA_RATEUS_FLAG_ADSL2_RP_LP0_MAKECMV;
  3461. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3462. #ifdef AMAZON_MEI_DEBUG_ON
  3463. printk("\n\nCMV fail, Group CNFG Address 23 Index 0");
  3464. #endif
  3465. Rp = 0;
  3466. }else
  3467. Rp=RxMessage[4];
  3468. LINE_RATE_DATA_RATEUS_FLAG_ADSL2_MP_LP0_MAKECMV;
  3469. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3470. #ifdef AMAZON_MEI_DEBUG_ON
  3471. printk("\n\nCMV fail, Group CNFG Address 24 Index 0");
  3472. #endif
  3473. Mp = 0;
  3474. }else
  3475. Mp=RxMessage[4];
  3476. LINE_RATE_DATA_RATEUS_FLAG_ADSL2_TP_LP0_MAKECMV;
  3477. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3478. #ifdef AMAZON_MEI_DEBUG_ON
  3479. printk("\n\nCMV fail, Group CNFG Address 26 Index 0");
  3480. #endif
  3481. Tp = 0;
  3482. }else
  3483. Tp=RxMessage[4];
  3484. LINE_RATE_DATA_RATEUS_FLAG_ADSL2_KP_LP0_MAKECMV;
  3485. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3486. #ifdef AMAZON_MEI_DEBUG_ON
  3487. printk("\n\nCMV fail, Group CNFG Address 28 Index 0");
  3488. #endif
  3489. Kp = 0;
  3490. }else
  3491. {
  3492. Kp=RxMessage[4]+ RxMessage[5]+1;
  3493. Bpn=RxMessage[4]+ RxMessage[5];
  3494. }
  3495. }else
  3496. {
  3497. LINE_RATE_DATA_RATEUS_FLAG_ADSL2_LP_LP1_MAKECMV;
  3498. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3499. #ifdef AMAZON_MEI_DEBUG_ON
  3500. printk("\n\nCMV fail, Group CNFG Address 25 Index 1");
  3501. #endif
  3502. Lp = 0;
  3503. }else
  3504. Lp=RxMessage[4];
  3505. LINE_RATE_DATA_RATEUS_FLAG_ADSL2_RP_LP1_MAKECMV;
  3506. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3507. #ifdef AMAZON_MEI_DEBUG_ON
  3508. printk("\n\nCMV fail, Group CNFG Address 23 Index 1");
  3509. #endif
  3510. Rp = 0;
  3511. }else
  3512. Rp=RxMessage[4];
  3513. LINE_RATE_DATA_RATEUS_FLAG_ADSL2_MP_LP1_MAKECMV;
  3514. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3515. #ifdef AMAZON_MEI_DEBUG_ON
  3516. printk("\n\nCMV fail, Group CNFG Address 24 Index 1");
  3517. #endif
  3518. Mp = 0;
  3519. }else
  3520. Mp=RxMessage[4];
  3521. LINE_RATE_DATA_RATEUS_FLAG_ADSL2_TP_LP1_MAKECMV;
  3522. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3523. #ifdef AMAZON_MEI_DEBUG_ON
  3524. printk("\n\nCMV fail, Group CNFG Address 26 Index 1");
  3525. #endif
  3526. Tp = 0;
  3527. }else
  3528. Tp=RxMessage[4];
  3529. LINE_RATE_DATA_RATEUS_FLAG_ADSL2_KP_LP1_MAKECMV;
  3530. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3531. #ifdef AMAZON_MEI_DEBUG_ON
  3532. printk("\n\nCMV fail, Group CNFG Address 28 Index 2");
  3533. #endif
  3534. Kp = 0;
  3535. }else
  3536. {
  3537. Kp=RxMessage[4]+ RxMessage[5]+1;
  3538. Bpn=RxMessage[4]+ RxMessage[5];
  3539. }
  3540. }
  3541. DataRate=((Tp*(Bpn+1)-1)*Mp*Lp*4)/(Tp*(Kp*Mp+Rp));
  3542. //DataRate_remain=((((Tp*(Bpn+1)-1)*Mp*Lp*4)%(Tp*(Kp*Mp+Rp)))*1000)/(Tp*(Kp*Mp+Rp));
  3543. //pts.adslLineRateInfo_pt->adslDataRateds = DataRate * 1000 + DataRate_remain;
  3544. pts.adslLineRateInfo_pt->adslDataRateds = DataRate;
  3545. }
  3546. }
  3547. if(IS_FLAG_SET((&(pts.adslLineRateInfo_pt->flags)), LINE_RATE_DATA_RATEUS_FLAG)){
  3548. if (adsl_mode <=8 && adsl_mode_extend==0) // adsl mode
  3549. {
  3550. if (chantype.interleave)
  3551. LINE_RATE_DATA_RATEUS_FLAG_ADSL1_LP0_MAKECMV;
  3552. else
  3553. LINE_RATE_DATA_RATEUS_FLAG_ADSL1_LP1_MAKECMV;
  3554. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3555. #ifdef AMAZON_MEI_DEBUG_ON
  3556. printk("\n\nCMV fail, Group RATE Address 0 Index 0");
  3557. #endif
  3558. pts.adslLineRateInfo_pt->adslDataRateus = 0;
  3559. }
  3560. else{
  3561. pts.adslLineRateInfo_pt->adslDataRateus = (u32)(RxMessage[4]) + (((u32)(RxMessage[5]))<<16);
  3562. }
  3563. }else // adsl 2/2+
  3564. {
  3565. unsigned long Mp,Lp,Tp,Rp,Kp,Bpn,DataRate,DataRate_remain;
  3566. Mp=Lp=Tp=Rp=Kp=Bpn=DataRate=DataRate_remain=0;
  3567. //// down stream data rate
  3568. if (chantype.interleave)
  3569. {
  3570. LINE_RATE_DATA_RATEDS_FLAG_ADSL2_LP_LP0_MAKECMV;
  3571. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3572. #ifdef AMAZON_MEI_DEBUG_ON
  3573. printk("\n\nCMV fail, Group CNFG Address 14 Index 0");
  3574. #endif
  3575. Lp = 0;
  3576. }else
  3577. Lp=RxMessage[4];
  3578. LINE_RATE_DATA_RATEDS_FLAG_ADSL2_RP_LP0_MAKECMV;
  3579. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3580. #ifdef AMAZON_MEI_DEBUG_ON
  3581. printk("\n\nCMV fail, Group CNFG Address 12 Index 0");
  3582. #endif
  3583. Rp = 0;
  3584. }else
  3585. Rp=RxMessage[4];
  3586. LINE_RATE_DATA_RATEDS_FLAG_ADSL2_MP_LP0_MAKECMV;
  3587. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3588. #ifdef AMAZON_MEI_DEBUG_ON
  3589. printk("\n\nCMV fail, Group CNFG Address 13 Index 0");
  3590. #endif
  3591. Mp = 0;
  3592. }else
  3593. Mp=RxMessage[4];
  3594. LINE_RATE_DATA_RATEDS_FLAG_ADSL2_TP_LP0_MAKECMV;
  3595. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3596. #ifdef AMAZON_MEI_DEBUG_ON
  3597. printk("\n\nCMV fail, Group CNFG Address 15 Index 0");
  3598. #endif
  3599. Tp = 0;
  3600. }else
  3601. Tp=RxMessage[4];
  3602. LINE_RATE_DATA_RATEDS_FLAG_ADSL2_KP_LP0_MAKECMV;
  3603. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3604. #ifdef AMAZON_MEI_DEBUG_ON
  3605. printk("\n\nCMV fail, Group CNFG Address 17 Index 0");
  3606. #endif
  3607. Kp = 0;
  3608. }else
  3609. {
  3610. Kp=RxMessage[4]+ RxMessage[5]+1;
  3611. Bpn=RxMessage[4]+ RxMessage[5];
  3612. }
  3613. }else
  3614. {
  3615. LINE_RATE_DATA_RATEDS_FLAG_ADSL2_LP_LP1_MAKECMV;
  3616. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3617. #ifdef AMAZON_MEI_DEBUG_ON
  3618. printk("\n\nCMV fail, Group CNFG Address 14 Index 1");
  3619. #endif
  3620. Lp = 0;
  3621. }else
  3622. Lp=RxMessage[4];
  3623. LINE_RATE_DATA_RATEDS_FLAG_ADSL2_RP_LP1_MAKECMV;
  3624. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3625. #ifdef AMAZON_MEI_DEBUG_ON
  3626. printk("\n\nCMV fail, Group CNFG Address 12 Index 1");
  3627. #endif
  3628. Rp = 0;
  3629. }else
  3630. Rp=RxMessage[4];
  3631. LINE_RATE_DATA_RATEDS_FLAG_ADSL2_MP_LP1_MAKECMV;
  3632. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3633. #ifdef AMAZON_MEI_DEBUG_ON
  3634. printk("\n\nCMV fail, Group CNFG Address 13 Index 1");
  3635. #endif
  3636. Mp = 0;
  3637. }else
  3638. Mp=RxMessage[4];
  3639. LINE_RATE_DATA_RATEDS_FLAG_ADSL2_TP_LP1_MAKECMV;
  3640. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3641. #ifdef AMAZON_MEI_DEBUG_ON
  3642. printk("\n\nCMV fail, Group CNFG Address 15 Index 1");
  3643. #endif
  3644. Tp = 0;
  3645. }else
  3646. Tp=RxMessage[4];
  3647. LINE_RATE_DATA_RATEDS_FLAG_ADSL2_KP_LP1_MAKECMV;
  3648. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3649. #ifdef AMAZON_MEI_DEBUG_ON
  3650. printk("\n\nCMV fail, Group CNFG Address 17 Index 2");
  3651. #endif
  3652. Kp = 0;
  3653. }else
  3654. {
  3655. Kp=RxMessage[4]+ RxMessage[5]+1;
  3656. Bpn=RxMessage[4]+ RxMessage[5];
  3657. }
  3658. }
  3659. DataRate=((Tp*(Bpn+1)-1)*Mp*Lp*4)/(Tp*(Kp*Mp+Rp));
  3660. //DataRate_remain=((((Tp*(Bpn+1)-1)*Mp*Lp*4)%(Tp*(Kp*Mp+Rp)))*1000)/(Tp*(Kp*Mp+Rp));
  3661. //pts.adslLineRateInfo_pt->adslDataRateus = DataRate * 1000 + DataRate_remain;
  3662. pts.adslLineRateInfo_pt->adslDataRateus = DataRate;
  3663. }
  3664. }
  3665. if(IS_FLAG_SET((&(pts.adslLineRateInfo_pt->flags)), LINE_RATE_ATTNDRDS_FLAG)){
  3666. LINE_RATE_ATTNDRDS_FLAG_MAKECMV;
  3667. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3668. #ifdef AMAZON_MEI_DEBUG_ON
  3669. printk("\n\nCMV fail, Group INFO Address 68 Index 4");
  3670. #endif
  3671. pts.adslLineRateInfo_pt->adslATTNDRds = 0;
  3672. }
  3673. else{
  3674. pts.adslLineRateInfo_pt->adslATTNDRds = (u32)(RxMessage[4]) + (((u32)(RxMessage[5]))<<16);
  3675. }
  3676. }
  3677. if(IS_FLAG_SET((&(pts.adslLineRateInfo_pt->flags)), LINE_RATE_ATTNDRUS_FLAG)){
  3678. if (adsl_mode <=8 && adsl_mode_extend==0) // adsl mode
  3679. {
  3680. LINE_RATE_ATTNDRUS_FLAG_MAKECMV;
  3681. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3682. #ifdef AMAZON_MEI_DEBUG_ON
  3683. printk("\n\nCMV fail, Group INFO Address 69 Index 4");
  3684. #endif
  3685. pts.adslLineRateInfo_pt->adslATTNDRus = 0;
  3686. }
  3687. else{
  3688. pts.adslLineRateInfo_pt->adslATTNDRus = (u32)(RxMessage[4]) + (((u32)(RxMessage[5]))<<16);
  3689. }
  3690. }else
  3691. {
  3692. hdlc_cmd[0]=0x0181;
  3693. hdlc_cmd[1]=0x24;
  3694. up(&mei_sema);
  3695. if (ifx_me_hdlc_send((unsigned char *)&hdlc_cmd[0],4)!= -EBUSY)
  3696. {
  3697. set_current_state(TASK_INTERRUPTIBLE);
  3698. schedule_timeout(1);
  3699. hdlc_rx_len=0;
  3700. hdlc_rx_len = ifx_mei_hdlc_read(&hdlc_rx_buffer,32*2);
  3701. if (hdlc_rx_len <=0)
  3702. {
  3703. meierr = -ERESTARTSYS;
  3704. goto GET_ADSL_LINE_RATE_END;
  3705. }
  3706. pts.adslLineRateInfo_pt->adslATTNDRus = (u32)le16_to_cpu(hdlc_rx_buffer[1])<<16 | (u32)le16_to_cpu(hdlc_rx_buffer[2]);
  3707. }
  3708. if(down_interruptible(&mei_sema))
  3709. {
  3710. meierr = -ERESTARTSYS;
  3711. goto GET_ADSL_LINE_RATE_END;
  3712. }
  3713. }
  3714. }
  3715. copy_to_user((char *)lon, (char *)pts.adslLineRateInfo_pt, sizeof(adslLineRateInfo));
  3716. up(&mei_sema);
  3717. GET_ADSL_LINE_RATE_END:
  3718. kfree(pts.adslLineRateInfo_pt);
  3719. break;
  3720. case GET_ADSL_LINE_INFO:
  3721. if (showtime!=1)
  3722. return -ERESTARTSYS;
  3723. if(down_interruptible(&mei_sema))
  3724. return -ERESTARTSYS;
  3725. pts.adslLineInfo_pt = (adslLineInfo *)kmalloc(sizeof(adslLineInfo), GFP_KERNEL);
  3726. copy_from_user((char *)pts.adslLineInfo_pt, (char *)lon, sizeof(adslLineInfo));
  3727. if(IS_FLAG_SET((&(pts.adslLineInfo_pt->flags)), LINE_INFO_INTLV_DEPTHDS_FLAG)){
  3728. if (chantype.interleave)
  3729. LINE_INFO_INTLV_DEPTHDS_FLAG_LP0_MAKECMV;
  3730. else
  3731. LINE_INFO_INTLV_DEPTHDS_FLAG_LP1_MAKECMV;
  3732. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3733. #ifdef AMAZON_MEI_DEBUG_ON
  3734. printk("\n\nCMV fail, Group CNFG Address 27 Index 0");
  3735. #endif
  3736. pts.adslLineInfo_pt->adslInterleaveDepthds = 0;
  3737. }
  3738. else{
  3739. pts.adslLineInfo_pt->adslInterleaveDepthds = RxMessage[4];
  3740. }
  3741. }
  3742. if(IS_FLAG_SET((&(pts.adslLineInfo_pt->flags)), LINE_INFO_INTLV_DEPTHUS_FLAG)){
  3743. if (chantype.interleave)
  3744. LINE_INFO_INTLV_DEPTHUS_FLAG_LP0_MAKECMV;
  3745. else
  3746. LINE_INFO_INTLV_DEPTHUS_FLAG_LP1_MAKECMV;
  3747. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3748. #ifdef AMAZON_MEI_DEBUG_ON
  3749. printk("\n\nCMV fail, Group CNFG Address 16 Index 0");
  3750. #endif
  3751. pts.adslLineInfo_pt->adslInterleaveDepthus = 0;
  3752. }
  3753. else{
  3754. pts.adslLineInfo_pt->adslInterleaveDepthus = RxMessage[4];
  3755. }
  3756. }
  3757. if(IS_FLAG_SET((&(pts.adslLineInfo_pt->flags)), LINE_INFO_LATNDS_FLAG)){
  3758. LINE_INFO_LATNDS_FLAG_MAKECMV;
  3759. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3760. #ifdef AMAZON_MEI_DEBUG_ON
  3761. printk("\n\nCMV fail, Group INFO Address 68 Index 1");
  3762. #endif
  3763. pts.adslLineInfo_pt->adslLATNds = 0;
  3764. }
  3765. else{
  3766. pts.adslLineInfo_pt->adslLATNds = RxMessage[4];
  3767. }
  3768. }
  3769. if(IS_FLAG_SET((&(pts.adslLineInfo_pt->flags)), LINE_INFO_LATNUS_FLAG)){
  3770. if (adsl_mode <=8 && adsl_mode_extend==0) // adsl mode
  3771. {
  3772. LINE_INFO_LATNUS_FLAG_MAKECMV;
  3773. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3774. #ifdef AMAZON_MEI_DEBUG_ON
  3775. printk("\n\nCMV fail, Group INFO Address 69 Index 1");
  3776. #endif
  3777. pts.adslLineInfo_pt->adslLATNus = 0;
  3778. }
  3779. else{
  3780. pts.adslLineInfo_pt->adslLATNus = RxMessage[4];
  3781. }
  3782. }else
  3783. {
  3784. hdlc_cmd[0]=0x0181;
  3785. hdlc_cmd[1]=0x21;
  3786. up(&mei_sema);
  3787. if (ifx_me_hdlc_send((unsigned char *)&hdlc_cmd[0],4)!= -EBUSY)
  3788. {
  3789. set_current_state(TASK_INTERRUPTIBLE);
  3790. schedule_timeout(1);
  3791. hdlc_rx_len=0;
  3792. hdlc_rx_len = ifx_mei_hdlc_read(&hdlc_rx_buffer,32*2);
  3793. if (hdlc_rx_len <=0)
  3794. {
  3795. meierr = -ERESTARTSYS;
  3796. goto GET_ADSL_LINE_INFO_END;
  3797. }
  3798. pts.adslLineInfo_pt->adslLATNus = le16_to_cpu(hdlc_rx_buffer[1]);
  3799. }
  3800. if(down_interruptible(&mei_sema))
  3801. {
  3802. meierr = -ERESTARTSYS;
  3803. goto GET_ADSL_LINE_INFO_END;
  3804. }
  3805. }
  3806. }
  3807. if(IS_FLAG_SET((&(pts.adslLineInfo_pt->flags)), LINE_INFO_SATNDS_FLAG)){
  3808. LINE_INFO_SATNDS_FLAG_MAKECMV;
  3809. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3810. #ifdef AMAZON_MEI_DEBUG_ON
  3811. printk("\n\nCMV fail, Group INFO Address 68 Index 2");
  3812. #endif
  3813. pts.adslLineInfo_pt->adslSATNds = 0;
  3814. }
  3815. else{
  3816. pts.adslLineInfo_pt->adslSATNds = RxMessage[4];
  3817. }
  3818. }
  3819. if(IS_FLAG_SET((&(pts.adslLineInfo_pt->flags)), LINE_INFO_SATNUS_FLAG)){
  3820. if (adsl_mode <=8 && adsl_mode_extend==0) // adsl mode
  3821. {
  3822. LINE_INFO_SATNUS_FLAG_MAKECMV;
  3823. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3824. #ifdef AMAZON_MEI_DEBUG_ON
  3825. printk("\n\nCMV fail, Group INFO Address 69 Index 2");
  3826. #endif
  3827. pts.adslLineInfo_pt->adslSATNus = 0;
  3828. }
  3829. else{
  3830. pts.adslLineInfo_pt->adslSATNus = RxMessage[4];
  3831. }
  3832. }else
  3833. {
  3834. hdlc_cmd[0]=0x0181;
  3835. hdlc_cmd[1]=0x22;
  3836. up(&mei_sema);
  3837. if (ifx_me_hdlc_send((unsigned char *)&hdlc_cmd[0],4)!= -EBUSY)
  3838. {
  3839. set_current_state(TASK_INTERRUPTIBLE);
  3840. schedule_timeout(1);
  3841. hdlc_rx_len=0;
  3842. hdlc_rx_len = ifx_mei_hdlc_read(&hdlc_rx_buffer,32*2);
  3843. if (hdlc_rx_len <=0)
  3844. {
  3845. meierr = -ERESTARTSYS;
  3846. goto GET_ADSL_LINE_INFO_END;
  3847. }
  3848. pts.adslLineInfo_pt->adslSATNus = le16_to_cpu(hdlc_rx_buffer[1]);
  3849. }
  3850. if(down_interruptible(&mei_sema))
  3851. {
  3852. meierr = -ERESTARTSYS;
  3853. goto GET_ADSL_LINE_INFO_END;
  3854. }
  3855. }
  3856. }
  3857. if(IS_FLAG_SET((&(pts.adslLineInfo_pt->flags)), LINE_INFO_SNRMNDS_FLAG)){
  3858. if (adsl_mode <=8 && adsl_mode_extend==0) // adsl mode
  3859. {
  3860. LINE_INFO_SNRMNDS_FLAG_ADSL1_MAKECMV;
  3861. }
  3862. else if ((adsl_mode == 0x4000) || (adsl_mode == 0x8000) || adsl_mode_extend > 0)
  3863. {
  3864. LINE_INFO_SNRMNDS_FLAG_ADSL2PLUS_MAKECMV;
  3865. }
  3866. else
  3867. {
  3868. LINE_INFO_SNRMNDS_FLAG_ADSL2_MAKECMV;
  3869. }
  3870. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3871. #ifdef AMAZON_MEI_DEBUG_ON
  3872. printk("\n\nCMV fail, Group INFO Address 68 Index 3");
  3873. #endif
  3874. pts.adslLineInfo_pt->adslSNRMds = 0;
  3875. }
  3876. else{
  3877. if (adsl_mode>8 || adsl_mode_extend>0)
  3878. {
  3879. int SNRMds,SNRMds_remain;
  3880. SNRMds=RxMessage[4];
  3881. SNRMds_remain=((SNRMds&0xff)*1000)/256;
  3882. SNRMds=(SNRMds>>8)&0xff;
  3883. if ((SNRMds_remain%100)>=50) SNRMds_remain=(SNRMds_remain/100)+1;
  3884. else SNRMds_remain=(SNRMds_remain/100);
  3885. pts.adslLineInfo_pt->adslSNRMds = SNRMds*10 + SNRMds_remain;
  3886. }else
  3887. {
  3888. pts.adslLineInfo_pt->adslSNRMds = RxMessage[4];
  3889. }
  3890. }
  3891. }
  3892. if(IS_FLAG_SET((&(pts.adslLineInfo_pt->flags)), LINE_INFO_SNRMNUS_FLAG)){
  3893. if (adsl_mode <=8 && adsl_mode_extend == 0)
  3894. {
  3895. LINE_INFO_SNRMNUS_FLAG_MAKECMV;
  3896. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3897. #ifdef AMAZON_MEI_DEBUG_ON
  3898. printk("\n\nCMV fail, Group INFO Address 69 Index 3");
  3899. #endif
  3900. pts.adslLineInfo_pt->adslSNRMus = 0;
  3901. }
  3902. else{
  3903. pts.adslLineInfo_pt->adslSNRMus = RxMessage[4];
  3904. }
  3905. }else
  3906. {
  3907. hdlc_cmd[0]=0x0181;
  3908. hdlc_cmd[1]=0x23;
  3909. up(&mei_sema);
  3910. if (ifx_me_hdlc_send((unsigned char *)&hdlc_cmd[0],4)!= -EBUSY)
  3911. {
  3912. set_current_state(TASK_INTERRUPTIBLE);
  3913. schedule_timeout(1);
  3914. hdlc_rx_len=0;
  3915. hdlc_rx_len = ifx_mei_hdlc_read(&hdlc_rx_buffer,32*2);
  3916. if (hdlc_rx_len <=0)
  3917. {
  3918. meierr = -ERESTARTSYS;
  3919. goto GET_ADSL_LINE_INFO_END;
  3920. }
  3921. pts.adslLineInfo_pt->adslSNRMus = le16_to_cpu(hdlc_rx_buffer[1]);
  3922. }
  3923. if(down_interruptible(&mei_sema))
  3924. {
  3925. meierr = -ERESTARTSYS;
  3926. goto GET_ADSL_LINE_INFO_END;
  3927. }
  3928. }
  3929. }
  3930. if(IS_FLAG_SET((&(pts.adslLineInfo_pt->flags)), LINE_INFO_ACATPDS_FLAG)){
  3931. if (adsl_mode <=8 && adsl_mode_extend == 0)
  3932. {
  3933. LINE_INFO_ACATPDS_FLAG_MAKECMV;
  3934. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3935. #ifdef AMAZON_MEI_DEBUG_ON
  3936. printk("\n\nCMV fail, Group INFO Address 68 Index 6");
  3937. #endif
  3938. pts.adslLineInfo_pt->adslACATPds = 0;
  3939. }
  3940. else{
  3941. pts.adslLineInfo_pt->adslACATPds = RxMessage[4];
  3942. }
  3943. }else
  3944. {
  3945. hdlc_cmd[0]=0x0181;
  3946. hdlc_cmd[1]=0x25;
  3947. up(&mei_sema);
  3948. if (ifx_me_hdlc_send((unsigned char *)&hdlc_cmd[0],4)!= -EBUSY)
  3949. {
  3950. set_current_state(TASK_INTERRUPTIBLE);
  3951. schedule_timeout(1);
  3952. hdlc_rx_len=0;
  3953. hdlc_rx_len = ifx_mei_hdlc_read(&hdlc_rx_buffer,32*2);
  3954. if (hdlc_rx_len <=0)
  3955. {
  3956. meierr = -ERESTARTSYS;
  3957. goto GET_ADSL_LINE_INFO_END;
  3958. }
  3959. pts.adslLineInfo_pt->adslACATPds = le16_to_cpu(hdlc_rx_buffer[1]);
  3960. }
  3961. if(down_interruptible(&mei_sema))
  3962. {
  3963. meierr = -ERESTARTSYS;
  3964. goto GET_ADSL_LINE_INFO_END;
  3965. }
  3966. }
  3967. }
  3968. if(IS_FLAG_SET((&(pts.adslLineInfo_pt->flags)), LINE_INFO_ACATPUS_FLAG)){
  3969. if (adsl_mode <=8 && adsl_mode_extend == 0)
  3970. {
  3971. LINE_INFO_ACATPUS_FLAG_MAKECMV;
  3972. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  3973. #ifdef AMAZON_MEI_DEBUG_ON
  3974. printk("\n\nCMV fail, Group INFO Address 69 Index 6");
  3975. #endif
  3976. pts.adslLineInfo_pt->adslACATPus = 0;
  3977. }
  3978. else{
  3979. pts.adslLineInfo_pt->adslACATPus = RxMessage[4];
  3980. }
  3981. }else
  3982. {
  3983. hdlc_cmd[0]=0x0181;
  3984. hdlc_cmd[1]=0x26;
  3985. up(&mei_sema);
  3986. if (ifx_me_hdlc_send((unsigned char *)&hdlc_cmd[0],4)!= -EBUSY)
  3987. {
  3988. set_current_state(TASK_INTERRUPTIBLE);
  3989. schedule_timeout(1);
  3990. hdlc_rx_len=0;
  3991. hdlc_rx_len = ifx_mei_hdlc_read(&hdlc_rx_buffer,32*2);
  3992. if (hdlc_rx_len <=0)
  3993. {
  3994. meierr = -ERESTARTSYS;
  3995. goto GET_ADSL_LINE_INFO_END;
  3996. }
  3997. pts.adslLineInfo_pt->adslACATPus = le16_to_cpu(hdlc_rx_buffer[1]);
  3998. }
  3999. if(down_interruptible(&mei_sema))
  4000. {
  4001. meierr = -ERESTARTSYS;
  4002. goto GET_ADSL_LINE_INFO_END;
  4003. }
  4004. }
  4005. }
  4006. copy_to_user((char *)lon, (char *)pts.adslLineInfo_pt, sizeof(adslLineInfo));
  4007. up(&mei_sema);
  4008. GET_ADSL_LINE_INFO_END:
  4009. kfree(pts.adslLineInfo_pt);
  4010. break;
  4011. case GET_ADSL_NEAREND_STATS:
  4012. if (showtime!=1)
  4013. return -ERESTARTSYS;
  4014. if(down_interruptible(&mei_sema))
  4015. return -ERESTARTSYS;
  4016. pts.adslNearEndPerfStats_pt = (adslNearEndPerfStats *)kmalloc(sizeof(adslNearEndPerfStats), GFP_KERNEL);
  4017. copy_from_user((char *)pts.adslNearEndPerfStats_pt, (char *)lon, sizeof(adslNearEndPerfStats));
  4018. if(IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_SUPERFRAME_FLAG)){
  4019. NEAREND_PERF_SUPERFRAME_FLAG_LSW_MAKECMV;
  4020. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4021. #ifdef AMAZON_MEI_DEBUG_ON
  4022. printk("\n\nCMV fail, Group PLAM Address 20 Index 0");
  4023. #endif
  4024. pts.adslNearEndPerfStats_pt->adslSuperFrames = 0;
  4025. }
  4026. else{
  4027. pts.adslNearEndPerfStats_pt->adslSuperFrames = (u32)(RxMessage[4]);
  4028. }
  4029. NEAREND_PERF_SUPERFRAME_FLAG_MSW_MAKECMV;
  4030. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4031. #ifdef AMAZON_MEI_DEBUG_ON
  4032. printk("\n\nCMV fail, Group PLAM Address 21 Index 0");
  4033. #endif
  4034. pts.adslNearEndPerfStats_pt->adslSuperFrames = 0;
  4035. }
  4036. else{
  4037. pts.adslNearEndPerfStats_pt->adslSuperFrames += (((u32)(RxMessage[4]))<<16);
  4038. }
  4039. }
  4040. if(IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_LOS_FLAG) ||
  4041. IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_LOF_FLAG) ||
  4042. IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_LPR_FLAG) ||
  4043. IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_NCD_FLAG) ||
  4044. IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_LCD_FLAG) ){
  4045. NEAREND_PERF_LOS_FLAG_MAKECMV;
  4046. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4047. #ifdef AMAZON_MEI_DEBUG_ON
  4048. printk("\n\nCMV fail, Group PLAM Address 0 Index 0");
  4049. #endif
  4050. RxMessage[4] = 0;
  4051. }
  4052. if(IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_LOS_FLAG)){
  4053. if( (RxMessage[4]&0x1) == 0x1)
  4054. pts.adslNearEndPerfStats_pt->adslneLOS = 1;
  4055. else
  4056. pts.adslNearEndPerfStats_pt->adslneLOS = 0;
  4057. }
  4058. if(IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_LOF_FLAG)){
  4059. if( (RxMessage[4]&0x2) == 0x2)
  4060. pts.adslNearEndPerfStats_pt->adslneLOF = 1;
  4061. else
  4062. pts.adslNearEndPerfStats_pt->adslneLOF = 0;
  4063. }
  4064. if(IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_LPR_FLAG)){
  4065. if( (RxMessage[4]&0x4) == 0x4)
  4066. pts.adslNearEndPerfStats_pt->adslneLPR = 1;
  4067. else
  4068. pts.adslNearEndPerfStats_pt->adslneLPR = 0;
  4069. }
  4070. if(IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_NCD_FLAG)){
  4071. pts.adslNearEndPerfStats_pt->adslneNCD = (RxMessage[4]>>4)&0x3;
  4072. }
  4073. if(IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_LCD_FLAG)){
  4074. pts.adslNearEndPerfStats_pt->adslneLCD = (RxMessage[4]>>6)&0x3;
  4075. }
  4076. }
  4077. if(IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_CRC_FLAG)){
  4078. if (chantype.interleave)
  4079. NEAREND_PERF_CRC_FLAG_LP0_MAKECMV;
  4080. else
  4081. NEAREND_PERF_CRC_FLAG_LP1_MAKECMV;
  4082. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4083. #ifdef AMAZON_MEI_DEBUG_ON
  4084. printk("\n\nCMV fail, Group PLAM Address 2 Index 0");
  4085. #endif
  4086. pts.adslNearEndPerfStats_pt->adslneCRC = 0;
  4087. }
  4088. else{
  4089. pts.adslNearEndPerfStats_pt->adslneCRC = (u32)(RxMessage[4]) + (((u32)(RxMessage[5]))<<16);
  4090. }
  4091. }
  4092. if(IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_RSCORR_FLAG)){
  4093. if (chantype.interleave)
  4094. NEAREND_PERF_RSCORR_FLAG_LP0_MAKECMV;
  4095. else
  4096. NEAREND_PERF_RSCORR_FLAG_LP1_MAKECMV;
  4097. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4098. #ifdef AMAZON_MEI_DEBUG_ON
  4099. printk("\n\nCMV fail, Group PLAM Address 3 Index 0");
  4100. #endif
  4101. pts.adslNearEndPerfStats_pt->adslneRSCorr = 0;
  4102. }
  4103. else{
  4104. pts.adslNearEndPerfStats_pt->adslneRSCorr = RxMessage[4];
  4105. }
  4106. }
  4107. if(IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_FECS_FLAG)){
  4108. NEAREND_PERF_FECS_FLAG_MAKECMV;
  4109. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4110. #ifdef AMAZON_MEI_DEBUG_ON
  4111. printk("\n\nCMV fail, Group PLAM Address 6 Index 0");
  4112. #endif
  4113. pts.adslNearEndPerfStats_pt->adslneFECS = 0;
  4114. }
  4115. else{
  4116. pts.adslNearEndPerfStats_pt->adslneFECS = RxMessage[4];
  4117. }
  4118. }
  4119. if(IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_ES_FLAG)){
  4120. NEAREND_PERF_ES_FLAG_MAKECMV;
  4121. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4122. #ifdef AMAZON_MEI_DEBUG_ON
  4123. printk("\n\nCMV fail, Group PLAM Address 7 Index 0");
  4124. #endif
  4125. pts.adslNearEndPerfStats_pt->adslneES = 0;
  4126. }
  4127. else{
  4128. pts.adslNearEndPerfStats_pt->adslneES = RxMessage[4];
  4129. }
  4130. }
  4131. if(IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_SES_FLAG)){
  4132. NEAREND_PERF_SES_FLAG_MAKECMV;
  4133. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4134. #ifdef AMAZON_MEI_DEBUG_ON
  4135. printk("\n\nCMV fail, Group PLAM Address 8 Index 0");
  4136. #endif
  4137. pts.adslNearEndPerfStats_pt->adslneSES = 0;
  4138. }
  4139. else{
  4140. pts.adslNearEndPerfStats_pt->adslneSES = RxMessage[4];
  4141. }
  4142. }
  4143. if(IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_LOSS_FLAG)){
  4144. NEAREND_PERF_LOSS_FLAG_MAKECMV;
  4145. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4146. #ifdef AMAZON_MEI_DEBUG_ON
  4147. printk("\n\nCMV fail, Group PLAM Address 9 Index 0");
  4148. #endif
  4149. pts.adslNearEndPerfStats_pt->adslneLOSS = 0;
  4150. }
  4151. else{
  4152. pts.adslNearEndPerfStats_pt->adslneLOSS = RxMessage[4];
  4153. }
  4154. }
  4155. if(IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_UAS_FLAG)){
  4156. NEAREND_PERF_UAS_FLAG_MAKECMV;
  4157. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4158. #ifdef AMAZON_MEI_DEBUG_ON
  4159. printk("\n\nCMV fail, Group PLAM Address 10 Index 0");
  4160. #endif
  4161. pts.adslNearEndPerfStats_pt->adslneUAS = 0;
  4162. }
  4163. else{
  4164. pts.adslNearEndPerfStats_pt->adslneUAS = RxMessage[4];
  4165. }
  4166. }
  4167. if(IS_FLAG_SET((&(pts.adslNearEndPerfStats_pt->flags)), NEAREND_PERF_HECERR_FLAG)){
  4168. if (chantype.bearchannel0)
  4169. {
  4170. NEAREND_PERF_HECERR_FLAG_BC0_MAKECMV;
  4171. }else if (chantype.bearchannel1)
  4172. {
  4173. NEAREND_PERF_HECERR_FLAG_BC1_MAKECMV;
  4174. }
  4175. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4176. #ifdef AMAZON_MEI_DEBUG_ON
  4177. printk("\n\nCMV fail, Group PLAM Address 11 Index 0");
  4178. #endif
  4179. pts.adslNearEndPerfStats_pt->adslneHECErrors = 0;
  4180. }
  4181. else{
  4182. pts.adslNearEndPerfStats_pt->adslneHECErrors = (u32)(RxMessage[4]) + (((u32)(RxMessage[5]))<<16);
  4183. }
  4184. }
  4185. copy_to_user((char *)lon, (char *)pts.adslNearEndPerfStats_pt, sizeof(adslNearEndPerfStats));
  4186. kfree(pts.adslNearEndPerfStats_pt);
  4187. up(&mei_sema);
  4188. break;
  4189. case GET_ADSL_FAREND_STATS:
  4190. if (showtime!=1)
  4191. return -ERESTARTSYS;
  4192. if (adsl_mode>8 || adsl_mode_extend > 0)
  4193. {
  4194. do_gettimeofday(&time_now);
  4195. if( FarendData_acquire_time.tv_sec==0 || time_now.tv_sec - FarendData_acquire_time.tv_sec>=1)
  4196. {
  4197. hdlc_cmd[0]=0x105;
  4198. if (ifx_me_hdlc_send((unsigned char *)&hdlc_cmd[0],2)!= -EBUSY)
  4199. {
  4200. set_current_state(TASK_INTERRUPTIBLE);
  4201. schedule_timeout(1);
  4202. hdlc_rx_len=0;
  4203. hdlc_rx_len = ifx_mei_hdlc_read(&hdlc_rx_buffer,32*2);
  4204. if (hdlc_rx_len <=0)
  4205. {
  4206. return -ERESTARTSYS;
  4207. }
  4208. FarendStatsData.adslfeRSCorr = ((u32)le16_to_cpu(hdlc_rx_buffer[1]) << 16) + (u32)le16_to_cpu(hdlc_rx_buffer[2]);
  4209. FarendStatsData.adslfeCRC = ((u32)le16_to_cpu(hdlc_rx_buffer[3]) << 16) + (u32)le16_to_cpu(hdlc_rx_buffer[4]);
  4210. FarendStatsData.adslfeFECS = ((u32)le16_to_cpu(hdlc_rx_buffer[5]) << 16) + (u32)le16_to_cpu(hdlc_rx_buffer[6]);
  4211. FarendStatsData.adslfeES = ((u32)le16_to_cpu(hdlc_rx_buffer[7]) << 16) + (u32)le16_to_cpu(hdlc_rx_buffer[8]);
  4212. FarendStatsData.adslfeSES = ((u32)le16_to_cpu(hdlc_rx_buffer[9]) << 16) + (u32)le16_to_cpu(hdlc_rx_buffer[10]);
  4213. FarendStatsData.adslfeLOSS = ((u32)le16_to_cpu(hdlc_rx_buffer[11]) << 16) + (u32)le16_to_cpu(hdlc_rx_buffer[12]);
  4214. FarendStatsData.adslfeUAS = ((u32)le16_to_cpu(hdlc_rx_buffer[13]) << 16) + (u32)le16_to_cpu(hdlc_rx_buffer[14]);
  4215. do_gettimeofday(&FarendData_acquire_time);
  4216. }
  4217. }
  4218. }
  4219. if(down_interruptible(&mei_sema))
  4220. return -ERESTARTSYS;
  4221. pts.adslFarEndPerfStats_pt = (adslFarEndPerfStats *)kmalloc(sizeof(adslFarEndPerfStats), GFP_KERNEL);
  4222. copy_from_user((char *)pts.adslFarEndPerfStats_pt, (char *)lon, sizeof(adslFarEndPerfStats));
  4223. if(IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_LOS_FLAG) ||
  4224. IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_LOF_FLAG) ||
  4225. IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_LPR_FLAG) ||
  4226. IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_NCD_FLAG) ||
  4227. IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_LCD_FLAG) ){
  4228. FAREND_PERF_LOS_FLAG_MAKECMV;
  4229. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4230. #ifdef AMAZON_MEI_DEBUG_ON
  4231. printk("\n\nCMV fail, Group PLAM Address 1 Index 0");
  4232. #endif
  4233. RxMessage[4] = 0;
  4234. }
  4235. if(IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_LOS_FLAG)){
  4236. if((RxMessage[4]&0x1) == 0x1)
  4237. pts.adslFarEndPerfStats_pt->adslfeLOS = 1;
  4238. else
  4239. pts.adslFarEndPerfStats_pt->adslfeLOS = 0;
  4240. }
  4241. if(IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_LOF_FLAG)){
  4242. if((RxMessage[4]&0x2) == 0x2)
  4243. pts.adslFarEndPerfStats_pt->adslfeLOF = 1;
  4244. else
  4245. pts.adslFarEndPerfStats_pt->adslfeLOF = 0;
  4246. }
  4247. if(IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_LPR_FLAG)){
  4248. if((RxMessage[4]&0x4) == 0x4)
  4249. pts.adslFarEndPerfStats_pt->adslfeLPR = 1;
  4250. else
  4251. pts.adslFarEndPerfStats_pt->adslfeLPR = 0;
  4252. }
  4253. if(IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_NCD_FLAG)){
  4254. pts.adslFarEndPerfStats_pt->adslfeNCD = (RxMessage[4]>>4)&0x3;
  4255. }
  4256. if(IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_LCD_FLAG)){
  4257. pts.adslFarEndPerfStats_pt->adslfeLCD = (RxMessage[4]>>6)&0x3;
  4258. }
  4259. }
  4260. if(IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_CRC_FLAG)){
  4261. if (adsl_mode<=8 && adsl_mode_extend == 0)
  4262. {
  4263. if (chantype.interleave)
  4264. {
  4265. FAREND_PERF_CRC_FLAG_LP0_MAKECMV;
  4266. }
  4267. else
  4268. {
  4269. FAREND_PERF_CRC_FLAG_LP1_MAKECMV;
  4270. }
  4271. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4272. #ifdef AMAZON_MEI_DEBUG_ON
  4273. printk("\n\nCMV fail, Group PLAM Address 24 Index 0");
  4274. #endif
  4275. pts.adslFarEndPerfStats_pt->adslfeCRC = 0;
  4276. }
  4277. else{
  4278. pts.adslFarEndPerfStats_pt->adslfeCRC = RxMessage[4];
  4279. }
  4280. }else
  4281. {
  4282. pts.adslFarEndPerfStats_pt->adslfeCRC = FarendStatsData.adslfeCRC;
  4283. }
  4284. }
  4285. if(IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_RSCORR_FLAG)){
  4286. if (adsl_mode<=8 && adsl_mode_extend == 0)
  4287. {
  4288. if (chantype.interleave)
  4289. FAREND_PERF_RSCORR_FLAG_LP0_MAKECMV;
  4290. else
  4291. FAREND_PERF_RSCORR_FLAG_LP1_MAKECMV;
  4292. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4293. #ifdef AMAZON_MEI_DEBUG_ON
  4294. printk("\n\nCMV fail, Group PLAM Address 28 Index 0");
  4295. #endif
  4296. pts.adslFarEndPerfStats_pt->adslfeRSCorr = 0;
  4297. }
  4298. else{
  4299. pts.adslFarEndPerfStats_pt->adslfeRSCorr = RxMessage[4];
  4300. }
  4301. }
  4302. else
  4303. {
  4304. pts.adslFarEndPerfStats_pt->adslfeRSCorr = FarendStatsData.adslfeRSCorr;
  4305. }
  4306. }
  4307. if(IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_FECS_FLAG)){
  4308. if (adsl_mode<=8 && adsl_mode_extend == 0)
  4309. {
  4310. FAREND_PERF_FECS_FLAG_MAKECMV;
  4311. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4312. #ifdef AMAZON_MEI_DEBUG_ON
  4313. printk("\n\nCMV fail, Group PLAM Address 32 Index 0");
  4314. #endif
  4315. pts.adslFarEndPerfStats_pt->adslfeFECS = 0;
  4316. }
  4317. else{
  4318. pts.adslFarEndPerfStats_pt->adslfeFECS = RxMessage[4];
  4319. }
  4320. }else {
  4321. pts.adslFarEndPerfStats_pt->adslfeFECS = FarendStatsData.adslfeFECS;
  4322. }
  4323. }
  4324. if(IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_ES_FLAG)){
  4325. if (adsl_mode<=8 && adsl_mode_extend == 0)
  4326. {
  4327. FAREND_PERF_ES_FLAG_MAKECMV;
  4328. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4329. #ifdef AMAZON_MEI_DEBUG_ON
  4330. printk("\n\nCMV fail, Group PLAM Address 33 Index 0");
  4331. #endif
  4332. pts.adslFarEndPerfStats_pt->adslfeES = 0;
  4333. }
  4334. else{
  4335. pts.adslFarEndPerfStats_pt->adslfeES = RxMessage[4];
  4336. }
  4337. }else
  4338. {
  4339. pts.adslFarEndPerfStats_pt->adslfeES = FarendStatsData.adslfeES;
  4340. }
  4341. }
  4342. if(IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_SES_FLAG)){
  4343. if (adsl_mode<=8 && adsl_mode_extend == 0)
  4344. {
  4345. FAREND_PERF_SES_FLAG_MAKECMV;
  4346. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4347. #ifdef AMAZON_MEI_DEBUG_ON
  4348. printk("\n\nCMV fail, Group PLAM Address 34 Index 0");
  4349. #endif
  4350. pts.adslFarEndPerfStats_pt->adslfeSES = 0;
  4351. }
  4352. else{
  4353. pts.adslFarEndPerfStats_pt->adslfeSES = RxMessage[4];
  4354. }
  4355. }else
  4356. {
  4357. pts.adslFarEndPerfStats_pt->adslfeSES = FarendStatsData.adslfeSES;
  4358. }
  4359. }
  4360. if(IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_LOSS_FLAG)){
  4361. if (adsl_mode<=8 && adsl_mode_extend == 0)
  4362. {
  4363. FAREND_PERF_LOSS_FLAG_MAKECMV;
  4364. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4365. #ifdef AMAZON_MEI_DEBUG_ON
  4366. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  4367. #endif
  4368. pts.adslFarEndPerfStats_pt->adslfeLOSS = 0;
  4369. }
  4370. else{
  4371. pts.adslFarEndPerfStats_pt->adslfeLOSS = RxMessage[4];
  4372. }
  4373. }else
  4374. {
  4375. pts.adslFarEndPerfStats_pt->adslfeLOSS = FarendStatsData.adslfeLOSS;
  4376. }
  4377. }
  4378. if(IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_UAS_FLAG)){
  4379. if (adsl_mode<=8 && adsl_mode_extend == 0)
  4380. {
  4381. FAREND_PERF_UAS_FLAG_MAKECMV;
  4382. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4383. #ifdef AMAZON_MEI_DEBUG_ON
  4384. printk("\n\nCMV fail, Group PLAM Address 36 Index 0");
  4385. #endif
  4386. pts.adslFarEndPerfStats_pt->adslfeUAS = 0;
  4387. }
  4388. else{
  4389. pts.adslFarEndPerfStats_pt->adslfeUAS = RxMessage[4];
  4390. }
  4391. }else
  4392. {
  4393. pts.adslFarEndPerfStats_pt->adslfeUAS = FarendStatsData.adslfeUAS;
  4394. }
  4395. }
  4396. if(IS_FLAG_SET((&(pts.adslFarEndPerfStats_pt->flags)), FAREND_PERF_HECERR_FLAG)){
  4397. if (chantype.bearchannel0)
  4398. {
  4399. FAREND_PERF_HECERR_FLAG_BC0_MAKECMV;
  4400. }else if (chantype.bearchannel1)
  4401. {
  4402. FAREND_PERF_HECERR_FLAG_BC1_MAKECMV;
  4403. }
  4404. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4405. #ifdef AMAZON_MEI_DEBUG_ON
  4406. printk("\n\nCMV fail, Group PLAM Address 37 Index 0");
  4407. #endif
  4408. pts.adslFarEndPerfStats_pt->adslfeHECErrors = 0;
  4409. }
  4410. else{
  4411. pts.adslFarEndPerfStats_pt->adslfeHECErrors = (u32)(RxMessage[4]) + (((u32)(RxMessage[5]))<<16);
  4412. }
  4413. }
  4414. copy_to_user((char *)lon, (char *)pts.adslFarEndPerfStats_pt, sizeof(adslFarEndPerfStats));
  4415. kfree(pts.adslFarEndPerfStats_pt);
  4416. up(&mei_sema);
  4417. break;
  4418. // 603221:tc.chen end
  4419. case GET_ADSL_LOOP_DIAGNOSTICS_MODE:
  4420. //lon = loop_diagnostics_mode;
  4421. copy_to_user((char *)lon, (char *)&loop_diagnostics_mode, sizeof(int));
  4422. break;
  4423. //>> SHC
  4424. case IS_ADSL_LOOP_DIAGNOSTICS_MODE_COMPLETE:
  4425. copy_to_user((char *)lon, (char *)&loop_diagnostics_completed, sizeof(int));
  4426. break;
  4427. //<< end SHC
  4428. case LOOP_DIAGNOSTIC_MODE_COMPLETE:
  4429. loop_diagnostics_completed = 1;
  4430. // read adsl mode
  4431. makeCMV(H2D_CMV_READ, STAT, 1, 0, 1, data);
  4432. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4433. #ifdef AMAZON_MEI_DEBUG_ON
  4434. printk("\n\nCMV fail, Group STAT Address 1 Index 0");
  4435. #endif
  4436. }
  4437. adsl_mode = RxMessage[4];
  4438. makeCMV(H2D_CMV_READ, STAT, 17, 0, 1, data);
  4439. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4440. #ifdef AMAZON_MEI_DEBUG_ON
  4441. printk("\n\nCMV fail, Group STAT Address 1 Index 0");
  4442. #endif
  4443. }
  4444. adsl_mode_extend = RxMessage[4];
  4445. wake_up_interruptible(&wait_queue_loop_diagnostic);
  4446. break;
  4447. case SET_ADSL_LOOP_DIAGNOSTICS_MODE:
  4448. if (lon != loop_diagnostics_mode)
  4449. {
  4450. loop_diagnostics_completed = 0;
  4451. loop_diagnostics_mode = lon;
  4452. mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_REBOOT, NULL);
  4453. }
  4454. break;
  4455. case GET_ADSL_ATUR_SUBCARRIER_STATS:
  4456. if (loop_diagnostics_completed == 0)
  4457. {
  4458. interruptible_sleep_on_timeout(&wait_queue_loop_diagnostic,300*HZ);
  4459. if (loop_diagnostics_completed==0)
  4460. {
  4461. return -ERESTARTSYS;
  4462. }
  4463. }
  4464. if(down_interruptible(&mei_sema))
  4465. return -ERESTARTSYS;
  4466. pts.adslATURSubcarrierInfo_pt = (adslATURSubcarrierInfo *)kmalloc(sizeof(adslATURSubcarrierInfo), GFP_KERNEL);
  4467. copy_from_user((char *)pts.adslATURSubcarrierInfo_pt, (char *)lon, sizeof(adslATURSubcarrierInfo));
  4468. if(IS_FLAG_SET((&(pts.adslATURSubcarrierInfo_pt->flags)), FAREND_HLINSC)){
  4469. FAREND_HLINSC_MAKECMV(H2D_CMV_READ);
  4470. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4471. #ifdef AMAZON_MEI_DEBUG_ON
  4472. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  4473. #endif
  4474. pts.adslATURSubcarrierInfo_pt->HLINSCds = 0;
  4475. }
  4476. else{
  4477. pts.adslATURSubcarrierInfo_pt->HLINSCds = RxMessage[4];
  4478. }
  4479. }
  4480. if(IS_FLAG_SET((&(pts.adslATURSubcarrierInfo_pt->flags)), FAREND_HLINPS)){
  4481. int index=0,size=12;
  4482. //printk("FAREND_HLINPS\n");
  4483. for (index=0;index<1024;index+=size)
  4484. {
  4485. if (index+size>=1024)
  4486. size = 1024-index;
  4487. FAREND_HLINPS_MAKECMV(H2D_CMV_READ,index,size);
  4488. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4489. #ifdef AMAZON_MEI_DEBUG_ON
  4490. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  4491. #endif
  4492. }
  4493. else{
  4494. memcpy(&pts.adslATURSubcarrierInfo_pt->HLINpsds[index],&RxMessage[4],size*2);
  4495. #if 0
  4496. int msg_idx;
  4497. for(msg_idx=0;msg_idx<size;msg_idx++)
  4498. printk("index:%d ,cmv_result: %04X\n",index+msg_idx,RxMessage[4+msg_idx]);
  4499. #endif
  4500. }
  4501. }
  4502. }
  4503. if(IS_FLAG_SET((&(pts.adslATURSubcarrierInfo_pt->flags)), FAREND_HLOGMT)){
  4504. FAREND_HLOGMT_MAKECMV(H2D_CMV_READ);
  4505. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4506. #ifdef AMAZON_MEI_DEBUG_ON
  4507. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  4508. #endif
  4509. pts.adslATURSubcarrierInfo_pt->HLOGMTds = 0;
  4510. }
  4511. else{
  4512. pts.adslATURSubcarrierInfo_pt->HLOGMTds = RxMessage[4];
  4513. }
  4514. }
  4515. /////////////////////////////////////////////////////////////////////////
  4516. if(IS_FLAG_SET((&(pts.adslATURSubcarrierInfo_pt->flags)), FAREND_HLOGPS)){
  4517. //printk("FAREND_HLOGPS\n");
  4518. int index=0,size=12;
  4519. for (index=0;index<256;index+=size)
  4520. {
  4521. if (index+size>=256)
  4522. size = 256-index;
  4523. FAREND_HLOGPS_MAKECMV(H2D_CMV_READ,index,size);
  4524. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4525. #ifdef AMAZON_MEI_DEBUG_ON
  4526. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  4527. #endif
  4528. }
  4529. else{
  4530. if (adsl_mode < 0x4000 && adsl_mode_extend==0)//adsl2 mode
  4531. {
  4532. memcpy(&pts.adslATURSubcarrierInfo_pt->HLOGpsds[index],&RxMessage[4],size*2);
  4533. }else
  4534. {
  4535. int msg_idx=0;
  4536. for (msg_idx=0;msg_idx<size;msg_idx++)
  4537. {
  4538. pts.adslATURSubcarrierInfo_pt->HLOGpsds[(index+msg_idx)*2+1] = RxMessage[4+msg_idx];
  4539. //printk("index:%d ,cmv_result: %04X\n",index+msg_idx,RxMessage[4+msg_idx]);
  4540. }
  4541. }
  4542. }
  4543. }
  4544. if (adsl_mode >= 0x4000 || adsl_mode_extend >0)//adsl2+ mode
  4545. {
  4546. pts.adslATURSubcarrierInfo_pt->HLOGpsds[0] = pts.adslATURSubcarrierInfo_pt->HLOGpsds[1];
  4547. for (index=1;index<256;index++)
  4548. {
  4549. pts.adslATURSubcarrierInfo_pt->HLOGpsds[index*2] = (pts.adslATURSubcarrierInfo_pt->HLOGpsds[(index)*2-1] + pts.adslATURSubcarrierInfo_pt->HLOGpsds[(index)*2+1] +1) >>1;
  4550. }
  4551. }
  4552. }
  4553. if(IS_FLAG_SET((&(pts.adslATURSubcarrierInfo_pt->flags)), FAREND_QLNMT)){
  4554. FAREND_QLNMT_MAKECMV(H2D_CMV_READ);
  4555. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4556. #ifdef AMAZON_MEI_DEBUG_ON
  4557. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  4558. #endif
  4559. pts.adslATURSubcarrierInfo_pt->QLNMTds = 0;
  4560. }
  4561. else{
  4562. pts.adslATURSubcarrierInfo_pt->QLNMTds = RxMessage[4];
  4563. }
  4564. }
  4565. /////////////////////////////////////////////////////////////////////////
  4566. if(IS_FLAG_SET((&(pts.adslATURSubcarrierInfo_pt->flags)), FAREND_QLNPS)){
  4567. int index=0,size=12;
  4568. //printk("FAREND_QLNPS\n");
  4569. for (index=0;index<128;index+=size)
  4570. {
  4571. if (index+size>=128)
  4572. size = 128-index;
  4573. FAREND_QLNPS_MAKECMV(H2D_CMV_READ,index,size);
  4574. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4575. #ifdef AMAZON_MEI_DEBUG_ON
  4576. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  4577. #endif
  4578. }
  4579. else{
  4580. int msg_idx=0;
  4581. for (msg_idx=0;msg_idx<size;msg_idx++)
  4582. {
  4583. //memcpy(&pts.adslATURSubcarrierInfo_pt->QLNpsds[index],&RxMessage[4],size*2);
  4584. if (adsl_mode < 0x4000 && adsl_mode_extend==0)//adsl2 mode
  4585. {
  4586. pts.adslATURSubcarrierInfo_pt->QLNpsds[(index+msg_idx)*2] = (u16)(RxMessage[4+msg_idx]&0xFF);
  4587. pts.adslATURSubcarrierInfo_pt->QLNpsds[(index+msg_idx)*2+1] = (u16)((RxMessage[4+msg_idx]>>8)&0xFF);
  4588. }else
  4589. {
  4590. pts.adslATURSubcarrierInfo_pt->QLNpsds[(index+msg_idx)*4+1] = (u16)(RxMessage[4+msg_idx]&0xFF);
  4591. pts.adslATURSubcarrierInfo_pt->QLNpsds[(index+msg_idx)*4+3] = (u16)((RxMessage[4+msg_idx]>>8)&0xFF);
  4592. //printk("index:%d ,cmv_result: %04X\n",index+msg_idx,RxMessage[4+msg_idx]);
  4593. }
  4594. }
  4595. }
  4596. }
  4597. if (adsl_mode >= 0x4000 || adsl_mode_extend >0)//adsl2+ mode
  4598. {
  4599. pts.adslATURSubcarrierInfo_pt->QLNpsds[0] = pts.adslATURSubcarrierInfo_pt->QLNpsds[1];
  4600. for (index=1;index<256;index++)
  4601. {
  4602. pts.adslATURSubcarrierInfo_pt->QLNpsds[index*2] = (pts.adslATURSubcarrierInfo_pt->QLNpsds[(index)*2-1] + pts.adslATURSubcarrierInfo_pt->QLNpsds[(index)*2+1]) >>1;
  4603. }
  4604. }
  4605. }
  4606. if(IS_FLAG_SET((&(pts.adslATURSubcarrierInfo_pt->flags)), FAREND_SNRMT)){
  4607. FAREND_SNRMT_MAKECMV(H2D_CMV_READ);
  4608. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4609. #ifdef AMAZON_MEI_DEBUG_ON
  4610. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  4611. #endif
  4612. pts.adslATURSubcarrierInfo_pt->SNRMTds = 0;
  4613. }
  4614. else{
  4615. pts.adslATURSubcarrierInfo_pt->SNRMTds = RxMessage[4];
  4616. }
  4617. }
  4618. if(IS_FLAG_SET((&(pts.adslATURSubcarrierInfo_pt->flags)), FAREND_SNRPS)){
  4619. int index=0,size=12;
  4620. //printk("FAREND_SNRPS\n");
  4621. for (index=0;index<512;index+=size)
  4622. {
  4623. if (index+size>=512)
  4624. size = 512-index;
  4625. FAREND_SNRPS_MAKECMV(H2D_CMV_READ,index,size);
  4626. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4627. #ifdef AMAZON_MEI_DEBUG_ON
  4628. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  4629. #endif
  4630. }
  4631. else{
  4632. //memcpy(&pts.adslATURSubcarrierInfo_pt->SNRpsds[index],&RxMessage[4],size*2);
  4633. int msg_idx=0;
  4634. for (msg_idx=0;msg_idx<size;msg_idx++)
  4635. {
  4636. pts.adslATURSubcarrierInfo_pt->SNRpsds[index+msg_idx] = (u16)(RxMessage[4+msg_idx]&0xFF);
  4637. //printk("index:%d ,cmv_result: %04X\n",index+msg_idx,RxMessage[4+msg_idx]);
  4638. }
  4639. }
  4640. }
  4641. }
  4642. if(IS_FLAG_SET((&(pts.adslATURSubcarrierInfo_pt->flags)), FAREND_BITPS)){
  4643. int index=0,size=12;
  4644. //printk("FAREND_BITPS\n");
  4645. for (index=0;index<256;index+=size)
  4646. {
  4647. if (index+size>=256)
  4648. size = 256-index;
  4649. FAREND_BITPS_MAKECMV(H2D_CMV_READ,index,size);
  4650. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4651. #ifdef AMAZON_MEI_DEBUG_ON
  4652. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  4653. #endif
  4654. }
  4655. else{
  4656. int msg_idx=0;
  4657. for (msg_idx=0;msg_idx<size;msg_idx++)
  4658. {
  4659. pts.adslATURSubcarrierInfo_pt->BITpsds[(index+msg_idx)*2] = (u16)(RxMessage[4+msg_idx]&0xFF);
  4660. pts.adslATURSubcarrierInfo_pt->BITpsds[(index+msg_idx)*2+1] = (u16)((RxMessage[4+msg_idx]>>8)&0xFF);
  4661. //printk("index:%d ,cmv_result: %04X, %d\n",index+msg_idx,RxMessage[4+msg_idx],RxMessage[4+msg_idx]);
  4662. }
  4663. }
  4664. }
  4665. }
  4666. if(IS_FLAG_SET((&(pts.adslATURSubcarrierInfo_pt->flags)), FAREND_GAINPS)){
  4667. int index=0,size=12;
  4668. //printk("FAREND_GAINPS\n");
  4669. for (index=0;index<512;index+=size)
  4670. {
  4671. FAREND_GAINPS_MAKECMV(H2D_CMV_READ,index,size);
  4672. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4673. #ifdef AMAZON_MEI_DEBUG_ON
  4674. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  4675. #endif
  4676. }
  4677. else{
  4678. /*
  4679. int msg_idx=0;
  4680. for (msg_idx=0;msg_idx<size;msg_idx++)
  4681. {
  4682. pts.adslATURSubcarrierInfo_pt->GAINpsds[(index+msg_idx)*2] = RxMessage[4+msg_idx]&0xFF;
  4683. pts.adslATURSubcarrierInfo_pt->GAINpsds[(index+msg_idx)*2+1] = (RxMessage[4+msg_idx]>>8)&0xFF;
  4684. }
  4685. */
  4686. memcpy(&pts.adslATURSubcarrierInfo_pt->GAINpsds[index],&RxMessage[4],size*2);
  4687. #if 0
  4688. int msg_idx=0;
  4689. for (msg_idx=0;msg_idx<size;msg_idx++)
  4690. {
  4691. printk("index:%d ,cmv_result: %04X\n",index+msg_idx,RxMessage[4+msg_idx]);
  4692. }
  4693. #endif
  4694. }
  4695. }
  4696. }
  4697. copy_to_user((char *)lon, (char *)pts.adslATURSubcarrierInfo_pt, sizeof(adslATURSubcarrierInfo));
  4698. kfree(pts.adslATURSubcarrierInfo_pt);
  4699. up(&mei_sema);
  4700. break;
  4701. case GET_ADSL_ATUC_SUBCARRIER_STATS:
  4702. if (loop_diagnostics_completed == 0)
  4703. {
  4704. interruptible_sleep_on_timeout(&wait_queue_loop_diagnostic,300*HZ);
  4705. if (loop_diagnostics_completed==0)
  4706. {
  4707. return -ERESTARTSYS;
  4708. }
  4709. }
  4710. if(down_interruptible(&mei_sema))
  4711. return -ERESTARTSYS;
  4712. pts.adslATUCSubcarrierInfo_pt = (adslATUCSubcarrierInfo *)kmalloc(sizeof(adslATUCSubcarrierInfo), GFP_KERNEL);
  4713. copy_from_user((char *)pts.adslATUCSubcarrierInfo_pt, (char *)lon, sizeof(adslATUCSubcarrierInfo));
  4714. if(IS_FLAG_SET((&(pts.adslATUCSubcarrierInfo_pt->flags)), NEAREND_HLINSC)){
  4715. NEAREND_HLINSC_MAKECMV(H2D_CMV_READ);
  4716. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4717. #ifdef AMAZON_MEI_DEBUG_ON
  4718. printk("\n\nCMV fail, Group INFO Address 71 Index 2");
  4719. #endif
  4720. pts.adslATUCSubcarrierInfo_pt->HLINSCus = 0;
  4721. }
  4722. else{
  4723. pts.adslATUCSubcarrierInfo_pt->HLINSCus = RxMessage[4];
  4724. }
  4725. }
  4726. if(IS_FLAG_SET((&(pts.adslATUCSubcarrierInfo_pt->flags)), NEAREND_HLINPS)){
  4727. int index=0,size=12;
  4728. //printk("NEAREND_HLINPS\n");
  4729. for (index=0;index<128;index+=size)
  4730. {
  4731. if (index+size>=128)
  4732. size = 128-index;
  4733. NEAREND_HLINPS_MAKECMV(H2D_CMV_READ,index,size);
  4734. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4735. #ifdef AMAZON_MEI_DEBUG_ON
  4736. printk("\n\nCMV fail, Group INFO Address 73 Index 0");
  4737. #endif
  4738. }
  4739. else{
  4740. memcpy(&pts.adslATUCSubcarrierInfo_pt->HLINpsus[index],&RxMessage[4],size*2);
  4741. #if 0
  4742. int msg_idx;
  4743. for (msg_idx=0;msg_idx<size;msg_idx++)
  4744. {
  4745. printk("index:%d ,cmv_result: %04X\n",index+msg_idx,RxMessage[4+msg_idx]);
  4746. }
  4747. #endif
  4748. }
  4749. }
  4750. }
  4751. if(IS_FLAG_SET((&(pts.adslATUCSubcarrierInfo_pt->flags)), NEAREND_HLOGMT)){
  4752. NEAREND_HLOGMT_MAKECMV(H2D_CMV_READ);
  4753. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4754. #ifdef AMAZON_MEI_DEBUG_ON
  4755. printk("\n\nCMV fail, Group INFO Address 80 Index 0");
  4756. #endif
  4757. pts.adslATUCSubcarrierInfo_pt->HLOGMTus = 0;
  4758. }
  4759. else{
  4760. pts.adslATUCSubcarrierInfo_pt->HLOGMTus = RxMessage[4];
  4761. }
  4762. }
  4763. /////////////////////////////////////////////////////////////////////////
  4764. if(IS_FLAG_SET((&(pts.adslATUCSubcarrierInfo_pt->flags)), NEAREND_HLOGPS)){
  4765. int index=0,size=12;
  4766. //printk("NEAREND_HLOGPS\n");
  4767. for (index=0;index<64;index+=size)
  4768. {
  4769. if (index+size>=64)
  4770. size = 64-index;
  4771. NEAREND_HLOGPS_MAKECMV(H2D_CMV_READ,index,size);
  4772. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4773. #ifdef AMAZON_MEI_DEBUG_ON
  4774. printk("\n\nCMV fail, Group INFO Address 75 Index 0");
  4775. #endif
  4776. }
  4777. else{
  4778. #if 0
  4779. if (adsl_mode <0x4000)//adsl /adsl2 mode
  4780. {
  4781. #endif
  4782. memcpy(&pts.adslATUCSubcarrierInfo_pt->HLOGpsus[index],&RxMessage[4],size*2);
  4783. #if 0
  4784. }else
  4785. {
  4786. int msg_idx=0;
  4787. for (msg_idx=0;msg_idx<size;msg_idx++)
  4788. {
  4789. //pts.adslATUCSubcarrierInfo_pt->HLOGpsus[(index+msg_idx)*2+1] = RxMessage[4+msg_idx];
  4790. pts.adslATUCSubcarrierInfo_pt->HLOGpsus[(index+msg_idx)] = RxMessage[4+msg_idx];
  4791. }
  4792. }
  4793. #endif
  4794. }
  4795. }
  4796. #if 0
  4797. if (adsl_mode >= 0x4000)//adsl2 mode
  4798. {
  4799. pts.adslATUCSubcarrierInfo_pt->HLOGpsus[0] = pts.adslATUCSubcarrierInfo_pt->HLOGpsus[1];
  4800. for (index=1;index<64;index++)
  4801. {
  4802. pts.adslATUCSubcarrierInfo_pt->HLOGpsus[index*2] = (pts.adslATUCSubcarrierInfo_pt->HLOGpsus[(index)*2-1] + pts.adslATUCSubcarrierInfo_pt->HLOGpsus[(index)*2+1]) >>1;
  4803. }
  4804. }
  4805. #endif
  4806. }
  4807. if(IS_FLAG_SET((&(pts.adslATUCSubcarrierInfo_pt->flags)), NEAREND_QLNMT)){
  4808. NEAREND_QLNMT_MAKECMV(H2D_CMV_READ);
  4809. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4810. #ifdef AMAZON_MEI_DEBUG_ON
  4811. printk("\n\nCMV fail, Group INFO Address 80 Index 1");
  4812. #endif
  4813. pts.adslATUCSubcarrierInfo_pt->QLNMTus = 0;
  4814. }
  4815. else{
  4816. pts.adslATUCSubcarrierInfo_pt->QLNMTus = RxMessage[4];
  4817. }
  4818. }
  4819. /////////////////////////////////////////////////////////////////////////
  4820. if(IS_FLAG_SET((&(pts.adslATUCSubcarrierInfo_pt->flags)), NEAREND_QLNPS)){
  4821. int index=0,size=12;
  4822. //printk("NEAREND_QLNPS\n");
  4823. for (index=0;index<32;index+=size)
  4824. {
  4825. if (index+size>=32)
  4826. size = 32-index;
  4827. NEAREND_QLNPS_MAKECMV(H2D_CMV_READ,index,size);
  4828. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4829. #ifdef AMAZON_MEI_DEBUG_ON
  4830. printk("\n\nCMV fail, Group INFO Address 77 Index 0");
  4831. #endif
  4832. }
  4833. else{
  4834. int msg_idx=0;
  4835. for (msg_idx=0;msg_idx<size;msg_idx++)
  4836. {
  4837. #if 0
  4838. //memcpy(&pts.adslATUCSubcarrierInfo_pt->QLNpsds[index],&RxMessage[4],size*2);
  4839. if (adsl_mode == 0x200 || adsl_mode == 0x800 || adsl_mode ==0x2000 || adsl_mode ==0x4000 || (adsl_mode == 0 && (adsl_mode_extend == 0x4 || adsl_mode_extend == 0x2))//ADSL 2 Annex B(0x200)/J(0x800)/M(0x2000) //ADSL 2+ B,J,M
  4840. if (adsl_mode < 0x4000 && adsl_mode_extend==0)//adsl2 mode
  4841. {
  4842. pts.adslATUCSubcarrierInfo_pt->QLNpsus[(index+msg_idx)*4+1] = (u16)(RxMessage[4+msg_idx]&0xFF);
  4843. pts.adslATUCSubcarrierInfo_pt->QLNpsus[(index+msg_idx)*4+3] = (u16)((RxMessage[4+msg_idx]>>8)&0xFF);
  4844. }else
  4845. #endif
  4846. {
  4847. pts.adslATUCSubcarrierInfo_pt->QLNpsus[(index+msg_idx)*2] = (u16)(RxMessage[4+msg_idx]&0xFF);
  4848. pts.adslATUCSubcarrierInfo_pt->QLNpsus[(index+msg_idx)*2+1] = (u16)((RxMessage[4+msg_idx]>>8)&0xFF);
  4849. //printk("index:%d ,cmv_result: %04X\n",index+msg_idx,RxMessage[4+msg_idx]);
  4850. }
  4851. }
  4852. }
  4853. }
  4854. #if 0
  4855. //if (adsl_mode <0x4000)//Annex I/J/L/M
  4856. if (adsl_mode == 0x200 || adsl_mode == 0x800 || adsl_mode ==0x2000 || adsl_mode ==0x4000 || (adsl_mode == 0 && (adsl_mode_extend == 0x4 || adsl_mode_extend == 0x2))//ADSL 2 Annex B(0x200)/J(0x800)/M(0x2000) //ADSL 2+ B,J,M
  4857. {
  4858. pts.adslATUCSubcarrierInfo_pt->QLNpsus[0] = pts.adslATUCSubcarrierInfo_pt->QLNpsus[1];
  4859. for (index=1;index<64;index++)
  4860. {
  4861. pts.adslATUCSubcarrierInfo_pt->QLNpsus[index*2] = (pts.adslATUCSubcarrierInfo_pt->QLNpsus[(index)*2-1] + pts.adslATUCSubcarrierInfo_pt->QLNpsus[(index)*2+1]) >>1;
  4862. }
  4863. }
  4864. #endif
  4865. }
  4866. if(IS_FLAG_SET((&(pts.adslATUCSubcarrierInfo_pt->flags)), NEAREND_SNRMT)){
  4867. NEAREND_SNRMT_MAKECMV(H2D_CMV_READ);
  4868. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4869. #ifdef AMAZON_MEI_DEBUG_ON
  4870. printk("\n\nCMV fail, Group INFO Address 80 Index 2");
  4871. #endif
  4872. pts.adslATUCSubcarrierInfo_pt->SNRMTus = 0;
  4873. }
  4874. else{
  4875. pts.adslATUCSubcarrierInfo_pt->SNRMTus = RxMessage[4];
  4876. }
  4877. }
  4878. if(IS_FLAG_SET((&(pts.adslATUCSubcarrierInfo_pt->flags)), NEAREND_SNRPS)){
  4879. int index=0,size=12;
  4880. //printk("NEAREND_SNRPS\n");
  4881. for (index=0;index<64;index+=size)
  4882. {
  4883. if (index+size>=64)
  4884. size = 64-index;
  4885. NEAREND_SNRPS_MAKECMV(H2D_CMV_READ,index,size);
  4886. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4887. #ifdef AMAZON_MEI_DEBUG_ON
  4888. printk("\n\nCMV fail, Group INFO Address 78 Index 0");
  4889. #endif
  4890. }
  4891. else{
  4892. //memcpy(&pts.adslATUCSubcarrierInfo_pt->SNRpsus[index],&RxMessage[4],size*2);
  4893. int msg_idx=0;
  4894. for (msg_idx=0;msg_idx<size;msg_idx++)
  4895. {
  4896. pts.adslATUCSubcarrierInfo_pt->SNRpsus[index+msg_idx] = (u16)(RxMessage[4+msg_idx]&0xFF);
  4897. //printk("index:%d ,cmv_result: %04X\n",index+msg_idx,RxMessage[4+msg_idx]);
  4898. }
  4899. }
  4900. }
  4901. }
  4902. if(IS_FLAG_SET((&(pts.adslATUCSubcarrierInfo_pt->flags)), NEAREND_BITPS)){
  4903. int index=0,size=12;
  4904. //printk("NEAREND_BITPS\n");
  4905. for (index=0;index<32;index+=size)
  4906. {
  4907. if (index+size>=32)
  4908. size = 32-index;
  4909. NEAREND_BITPS_MAKECMV(H2D_CMV_READ,index,size);
  4910. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4911. #ifdef AMAZON_MEI_DEBUG_ON
  4912. printk("\n\nCMV fail, Group INFO Address 22 Index 0");
  4913. #endif
  4914. }
  4915. else{
  4916. int msg_idx=0;
  4917. for (msg_idx=0;msg_idx<size;msg_idx++)
  4918. {
  4919. pts.adslATUCSubcarrierInfo_pt->BITpsus[(index+msg_idx)*2] = (u16)(RxMessage[4+msg_idx]&0xFF);
  4920. pts.adslATUCSubcarrierInfo_pt->BITpsus[(index+msg_idx)*2+1] = (u16)((RxMessage[4+msg_idx]>>8)&0xFF);
  4921. //printk("index:%d ,cmv_result: %04X\n",index+msg_idx,RxMessage[4+msg_idx]);
  4922. }
  4923. }
  4924. }
  4925. }
  4926. if(IS_FLAG_SET((&(pts.adslATUCSubcarrierInfo_pt->flags)), NEAREND_GAINPS)){
  4927. int index=0,size=12;
  4928. //printk("NEAREND_GAINPS\n");
  4929. for (index=0;index<64;index+=size)
  4930. {
  4931. if (index+size>=64)
  4932. size = 64-index;
  4933. NEAREND_GAINPS_MAKECMV(H2D_CMV_READ,index,size);
  4934. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4935. #ifdef AMAZON_MEI_DEBUG_ON
  4936. printk("\n\nCMV fail, Group INFO Address 24 Index 0");
  4937. #endif
  4938. }
  4939. else{
  4940. /*
  4941. int msg_idx=0;
  4942. for (msg_idx=0;msg_idx<size;msg_idx++)
  4943. {
  4944. pts.adslATUCSubcarrierInfo_pt->GAINpsds[(index+msg_idx)*2] = RxMessage[4+msg_idx]&0xFF;
  4945. pts.adslATUCSubcarrierInfo_pt->GAINpsds[(index+msg_idx)*2+1] = (RxMessage[4+msg_idx]>>8)&0xFF;
  4946. }
  4947. */
  4948. memcpy(&pts.adslATUCSubcarrierInfo_pt->GAINpsus[index],&RxMessage[4],size*2);
  4949. #if 0
  4950. int msg_idx;
  4951. for (msg_idx=0;msg_idx<size;msg_idx++)
  4952. {
  4953. printk("index:%d ,cmv_result: %04X\n",index+msg_idx,RxMessage[4+msg_idx]);
  4954. }
  4955. #endif
  4956. }
  4957. }
  4958. }
  4959. copy_to_user((char *)lon, (char *)pts.adslATUCSubcarrierInfo_pt, sizeof(adslATUCSubcarrierInfo));
  4960. kfree(pts.adslATUCSubcarrierInfo_pt);
  4961. up(&mei_sema);
  4962. break;
  4963. case GET_ADSL_LINE_INIT_STATS:
  4964. copy_to_user((char *)lon, (char *)&AdslInitStatsData, sizeof(AdslInitStatsData));
  4965. break;
  4966. case GET_ADSL_POWER_SPECTRAL_DENSITY:
  4967. if(down_interruptible(&mei_sema))
  4968. return -ERESTARTSYS;
  4969. i=0;
  4970. pts.adslPowerSpectralDensity_pt = (adslPowerSpectralDensity *)kmalloc(sizeof(adslPowerSpectralDensity), GFP_KERNEL);
  4971. memset((char *)pts.adslPowerSpectralDensity_pt, 0, sizeof(adslPowerSpectralDensity));
  4972. //US
  4973. NOMPSD_US_MAKECMV;
  4974. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4975. #ifdef AMAZON_MEI_DEBUG_ON
  4976. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  4977. #endif
  4978. i=-1;
  4979. }
  4980. else{
  4981. j=RxMessage[4];
  4982. }
  4983. PCB_US_MAKECMV;
  4984. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4985. #ifdef AMAZON_MEI_DEBUG_ON
  4986. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  4987. #endif
  4988. i=-1;
  4989. }
  4990. else{
  4991. temp=RxMessage[4];
  4992. }
  4993. RMSGI_US_MAKECMV;
  4994. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  4995. #ifdef AMAZON_MEI_DEBUG_ON
  4996. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  4997. #endif
  4998. i=-1;
  4999. }
  5000. else{
  5001. k=(int16_t)RxMessage[4];
  5002. }
  5003. if (i==0)
  5004. {
  5005. pts.adslPowerSpectralDensity_pt->ACTPSDus = ((int )(j*256 - temp*10*256 + k*10)) /256;
  5006. }
  5007. // DS
  5008. i=0;
  5009. j=temp=temp2=0;
  5010. NOMPSD_DS_MAKECMV;
  5011. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5012. #ifdef AMAZON_MEI_DEBUG_ON
  5013. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  5014. #endif
  5015. i=-1;
  5016. }
  5017. else{
  5018. j=RxMessage[4];
  5019. }
  5020. PCB_DS_MAKECMV;
  5021. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5022. #ifdef AMAZON_MEI_DEBUG_ON
  5023. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  5024. #endif
  5025. i=-1;
  5026. }
  5027. else{
  5028. temp=RxMessage[4];
  5029. }
  5030. RMSGI_DS_MAKECMV;
  5031. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5032. #ifdef AMAZON_MEI_DEBUG_ON
  5033. printk("\n\nCMV fail, Group PLAM Address 35 Index 0");
  5034. #endif
  5035. i=-1;
  5036. }
  5037. else{
  5038. //temp2=RxMessage[4];
  5039. k=(int16_t)RxMessage[4];
  5040. }
  5041. if (i==0)
  5042. {
  5043. pts.adslPowerSpectralDensity_pt->ACTPSDds = ((int )(j*256 - temp*10*256 + k*10)) /256;
  5044. }
  5045. copy_to_user((char *)lon, (char *)pts.adslPowerSpectralDensity_pt, sizeof(adslPowerSpectralDensity));
  5046. kfree(pts.adslPowerSpectralDensity_pt);
  5047. up(&mei_sema);
  5048. break;
  5049. case AMAZON_MEI_START:
  5050. showtime=0;
  5051. loop_diagnostics_completed = 0;
  5052. #ifdef ARC_READY_ACK
  5053. #ifdef LOCK_RETRY
  5054. i=0;
  5055. lock_retry:
  5056. if(down_trylock(&mei_sema)!=0)
  5057. {
  5058. reboot_lock = 1;
  5059. printk("lock fail\n");
  5060. i++;
  5061. if (i <=5)
  5062. {
  5063. set_current_state(TASK_INTERRUPTIBLE);
  5064. schedule_timeout(10);
  5065. goto lock_retry;
  5066. }else
  5067. {
  5068. printk("Force to Reboot ADSL!\n");
  5069. up(&mei_sema);
  5070. set_current_state(TASK_INTERRUPTIBLE);
  5071. schedule_timeout(1000);
  5072. sema_init(&mei_sema, 1); // semaphore initialization, mutex
  5073. }
  5074. }else
  5075. {
  5076. reboot_lock = 1;
  5077. }
  5078. #else
  5079. if(down_interruptible(&mei_sema)) //disable CMV access until ARC ready
  5080. {
  5081. return -ERESTARTSYS;
  5082. }
  5083. #endif
  5084. #endif
  5085. //CLEAR_BIT((*((volatile u32 *)0xB0100B40)), 0x40); //Warning LED GPIO ON
  5086. if(chantype.interleave==1){
  5087. kfree(interleave_mei_net.priv);
  5088. unregister_netdev(&interleave_mei_net);
  5089. }
  5090. else if(chantype.fast==1){
  5091. kfree(fast_mei_net.priv);
  5092. unregister_netdev(&fast_mei_net);
  5093. }
  5094. chantype.interleave=0;
  5095. chantype.fast=0;
  5096. meiMailboxInterruptsDisable(); //disable all MEI interrupts
  5097. if(mei_arc_swap_buff == NULL){
  5098. mei_arc_swap_buff = (u32 *)kmalloc(MAXSWAPSIZE*4, GFP_KERNEL);
  5099. if(mei_arc_swap_buff==NULL){
  5100. #ifdef AMAZON_MEI_DEBUG_ON
  5101. printk("\n\n malloc fail for codeswap buff");
  5102. #endif
  5103. meierr=MEI_FAILURE;
  5104. }
  5105. }
  5106. if(meiForceRebootAdslModem() != MEI_SUCCESS){
  5107. #ifdef AMAZON_MEI_DEBUG_ON
  5108. printk("\n\n meiForceRebootAdslModem() error...");
  5109. #endif
  5110. meierr=MEI_FAILURE;
  5111. }
  5112. interruptible_sleep_on(&wait_queue_codeswap);
  5113. // reset is called
  5114. break;
  5115. case AMAZON_MEI_MIB_DAEMON:
  5116. #ifdef IFX_SMALL_FOOTPRINT /* [ */
  5117. return -1;
  5118. #else /* ][ !IFX_SMALL_FOOTPRINT */
  5119. i=0;
  5120. while(1){
  5121. if(i<MIB_INTERVAL)
  5122. interruptible_sleep_on_timeout(&wait_queue_mibdaemon, ((MIB_INTERVAL-i)/(1000/HZ)));
  5123. i=0;
  5124. if(showtime==1){
  5125. // printk("\n\n update mib");
  5126. do_gettimeofday(&time_now);
  5127. if(time_now.tv_sec - current_intvl->start_time.tv_sec>=900){
  5128. if(current_intvl->list.next!=&interval_list){
  5129. current_intvl = list_entry(current_intvl->list.next, amazon_mei_mib, list);
  5130. do_gettimeofday(&(current_intvl->start_time));
  5131. }
  5132. else{
  5133. mib_ptr = list_entry(interval_list.next, amazon_mei_mib, list);
  5134. list_del(interval_list.next);
  5135. memset(mib_ptr, 0, sizeof(amazon_mei_mib));
  5136. list_add_tail(&(mib_ptr->list), &interval_list);
  5137. if(current_intvl->list.next==&interval_list)
  5138. #ifdef AMAZON_MEI_DEBUG_ON
  5139. printk("\n\nlink list error");
  5140. #endif
  5141. current_intvl = list_entry(current_intvl->list.next, amazon_mei_mib, list);
  5142. do_gettimeofday(&(current_intvl->start_time));
  5143. }
  5144. }
  5145. if(down_interruptible(&mei_sema))
  5146. return -ERESTARTSYS;
  5147. /*
  5148. ATUC_PERF_LO_FLAG_MAKECMV;
  5149. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5150. #ifdef AMAZON_MEI_DEBUG_ON
  5151. printk("\n\nCMV fail, Group 7 Address 0 Index 0");
  5152. #endif
  5153. }
  5154. else{
  5155. if(RxMessage[4]&PLAM_LOS_FailureBit){
  5156. current_intvl->AtucPerfLos++;
  5157. ATUC_PERF_LOSS++;
  5158. CurrStatus.adslAtucCurrStatus = 2;
  5159. }
  5160. if(RxMessage[4]&PLAM_LOF_FailureBit){
  5161. current_intvl->AtucPerfLof++;
  5162. ATUC_PERF_LOFS++;
  5163. CurrStatus.adslAtucCurrStatus = 1;
  5164. }
  5165. if(!(RxMessage[4]&(PLAM_LOS_FailureBit|PLAM_LOF_FailureBit)))
  5166. CurrStatus.adslAtucCurrStatus = 0;
  5167. }
  5168. */
  5169. ATUC_PERF_ESS_FLAG_MAKECMV;
  5170. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5171. #ifdef AMAZON_MEI_DEBUG_ON
  5172. printk("\n\nCMV fail, Group 7 Address 7 Index 0");
  5173. #endif
  5174. }
  5175. else{
  5176. temp = RxMessage[4]-mib_pread.ATUC_PERF_ESS;
  5177. if(temp>=0){
  5178. current_intvl->AtucPerfEs+=temp;
  5179. ATUC_PERF_ESS+=temp;
  5180. mib_pread.ATUC_PERF_ESS = RxMessage[4];
  5181. }
  5182. else{
  5183. current_intvl->AtucPerfEs+=0xffff-mib_pread.ATUC_PERF_ESS+RxMessage[4];
  5184. ATUC_PERF_ESS+=0xffff-mib_pread.ATUC_PERF_ESS+RxMessage[4];
  5185. mib_pread.ATUC_PERF_ESS = RxMessage[4];
  5186. }
  5187. }
  5188. /*
  5189. ATUR_PERF_LO_FLAG_MAKECMV;
  5190. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5191. #ifdef AMAZON_MEI_DEBUG_ON
  5192. printk("\n\nCMV fail, Group 7 Address 1 Index 0");
  5193. #endif
  5194. }
  5195. else{
  5196. if(RxMessage[4]&PLAM_LOS_FailureBit){
  5197. current_intvl->AturPerfLos++;
  5198. ATUR_PERF_LOSS++;
  5199. CurrStatus.adslAturCurrStatus = 2;
  5200. }
  5201. if(RxMessage[4]&PLAM_LOF_FailureBit){
  5202. current_intvl->AturPerfLof++;
  5203. ATUR_PERF_LOFS++;
  5204. CurrStatus.adslAturCurrStatus = 1;
  5205. }
  5206. if(RxMessage[4]&PLAM_LPR_FailureBit){
  5207. current_intvl->AturPerfLpr++;
  5208. ATUR_PERF_LPR++;
  5209. CurrStatus.adslAturCurrStatus = 3;
  5210. }
  5211. if(!(RxMessage[4]&(PLAM_LOS_FailureBit|PLAM_LOF_FailureBit|PLAM_LPR_FailureBit)))
  5212. CurrStatus.adslAturCurrStatus = 0;
  5213. }
  5214. */
  5215. ATUR_PERF_ESS_FLAG_MAKECMV;
  5216. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5217. #ifdef AMAZON_MEI_DEBUG_ON
  5218. printk("\n\nCMV fail, Group 7 Address 33 Index 0");
  5219. #endif
  5220. }
  5221. else{
  5222. temp = RxMessage[4]-mib_pread.ATUR_PERF_ESS;
  5223. if(temp>=0){
  5224. current_intvl->AturPerfEs+=temp;
  5225. ATUR_PERF_ESS+=temp;
  5226. mib_pread.ATUR_PERF_ESS = RxMessage[4];
  5227. }
  5228. else{
  5229. current_intvl->AturPerfEs+=0xffff-mib_pread.ATUR_PERF_ESS+RxMessage[4];
  5230. ATUR_PERF_ESS+= 0xffff-mib_pread.ATUR_PERF_ESS+RxMessage[4];
  5231. mib_pread.ATUR_PERF_ESS=RxMessage[4];
  5232. }
  5233. }
  5234. // to update rx/tx blocks
  5235. ATUR_CHAN_RECV_BLK_FLAG_MAKECMV_LSW;
  5236. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5237. #ifdef AMAZON_MEI_DEBUG_ON
  5238. printk("\n\nCMV fail, Group 7 Address 20 Index 0");
  5239. #endif
  5240. }
  5241. else{
  5242. temp = RxMessage[4];
  5243. }
  5244. ATUR_CHAN_RECV_BLK_FLAG_MAKECMV_MSW;
  5245. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5246. #ifdef AMAZON_MEI_DEBUG_ON
  5247. printk("\n\nCMV fail, Group 7 Address 21 Index 0");
  5248. #endif
  5249. }
  5250. else{
  5251. temp2 = RxMessage[4];
  5252. }
  5253. if((temp + (temp2<<16) - mib_pread.ATUR_CHAN_RECV_BLK)>=0){
  5254. current_intvl->AturChanPerfRxBlk+=temp + (temp2<<16) - mib_pread.ATUR_CHAN_RECV_BLK;
  5255. ATUR_CHAN_RECV_BLK+=temp + (temp2<<16) - mib_pread.ATUR_CHAN_RECV_BLK;
  5256. mib_pread.ATUR_CHAN_RECV_BLK = temp + (temp2<<16);
  5257. }
  5258. else{
  5259. current_intvl->AturChanPerfRxBlk+=0xffffffff - mib_pread.ATUR_CHAN_RECV_BLK +(temp + (temp2<<16));
  5260. ATUR_CHAN_RECV_BLK+=0xffffffff - mib_pread.ATUR_CHAN_RECV_BLK +(temp + (temp2<<16));
  5261. mib_pread.ATUR_CHAN_RECV_BLK = temp + (temp2<<16);
  5262. }
  5263. current_intvl->AturChanPerfTxBlk = current_intvl->AturChanPerfRxBlk;
  5264. ATUR_CHAN_TX_BLK = ATUR_CHAN_RECV_BLK;
  5265. /*
  5266. ATUR_CHAN_TX_BLK_FLAG_MAKECMV_LSW;
  5267. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS)
  5268. printk("\n\nCMV fail, Group 7 Address 20 Index 0");
  5269. else{
  5270. if(RxMessage[4]){
  5271. current_intvl->AturChanPerfTxBlk+=RxMessage[4];
  5272. ATUR_CHAN_TX_BLK+=RxMessage[4];
  5273. }
  5274. }
  5275. ATUR_CHAN_TX_BLK_FLAG_MAKECMV_MSW;
  5276. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS)
  5277. printk("\n\nCMV fail, Group 7 Address 21 Index 0");
  5278. else{
  5279. if(RxMessage[4]){
  5280. current_intvl->AturChanPerfTxBlk+=(int)((RxMessage[4])<<16);
  5281. ATUR_CHAN_TX_BLK+=(int)((RxMessage[4])<<16);
  5282. }
  5283. }
  5284. */
  5285. if(chantype.interleave == 1){
  5286. ATUR_CHAN_CORR_BLK_FLAG_MAKECMV_INTL;
  5287. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5288. #ifdef AMAZON_MEI_DEBUG_ON
  5289. printk("\n\nCMV fail, Group 7 Address 3 Index 0");
  5290. #endif
  5291. }
  5292. else{
  5293. temp = RxMessage[4] - mib_pread.ATUR_CHAN_CORR_BLK_INTL;
  5294. if(temp>=0){
  5295. current_intvl->AturChanPerfCorrBlk+=temp;
  5296. ATUR_CHAN_CORR_BLK+=temp;
  5297. mib_pread.ATUR_CHAN_CORR_BLK_INTL = RxMessage[4];
  5298. }
  5299. else{
  5300. current_intvl->AturChanPerfCorrBlk+=0xffff - mib_pread.ATUR_CHAN_CORR_BLK_INTL +RxMessage[4];
  5301. ATUR_CHAN_CORR_BLK+=0xffff - mib_pread.ATUR_CHAN_CORR_BLK_INTL +RxMessage[4];
  5302. mib_pread.ATUR_CHAN_CORR_BLK_INTL = RxMessage[4];
  5303. }
  5304. }
  5305. }
  5306. else if(chantype.fast == 1){
  5307. ATUR_CHAN_CORR_BLK_FLAG_MAKECMV_FAST;
  5308. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5309. #ifdef AMAZON_MEI_DEBUG_ON
  5310. printk("\n\nCMV fail, Group 7 Address 3 Index 1");
  5311. #endif
  5312. }
  5313. else{
  5314. temp = RxMessage[4] - mib_pread.ATUR_CHAN_CORR_BLK_FAST;
  5315. if(temp>=0){
  5316. current_intvl->AturChanPerfCorrBlk+=temp;
  5317. ATUR_CHAN_CORR_BLK+=temp;
  5318. mib_pread.ATUR_CHAN_CORR_BLK_FAST = RxMessage[4];
  5319. }
  5320. else{
  5321. current_intvl->AturChanPerfCorrBlk+=0xffff - mib_pread.ATUR_CHAN_CORR_BLK_FAST + RxMessage[4];
  5322. ATUR_CHAN_CORR_BLK+=0xffff - mib_pread.ATUR_CHAN_CORR_BLK_FAST + RxMessage[4];
  5323. mib_pread.ATUR_CHAN_CORR_BLK_FAST = RxMessage[4];
  5324. }
  5325. }
  5326. }
  5327. if(chantype.interleave == 1){
  5328. ATUR_CHAN_UNCORR_BLK_FLAG_MAKECMV_INTL;
  5329. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5330. #ifdef AMAZON_MEI_DEBUG_ON
  5331. printk("\n\nCMV fail, Group 7 Address 2 Index 0");
  5332. #endif
  5333. }
  5334. else{
  5335. temp = RxMessage[4] - mib_pread.ATUR_CHAN_UNCORR_BLK_INTL;
  5336. if(temp>=0){
  5337. current_intvl->AturChanPerfUncorrBlk+=temp;
  5338. ATUR_CHAN_UNCORR_BLK+=temp;
  5339. mib_pread.ATUR_CHAN_UNCORR_BLK_INTL = RxMessage[4];
  5340. }
  5341. else{
  5342. current_intvl->AturChanPerfUncorrBlk+=0xffff - mib_pread.ATUR_CHAN_UNCORR_BLK_INTL + RxMessage[4];
  5343. ATUR_CHAN_UNCORR_BLK+=0xffff - mib_pread.ATUR_CHAN_UNCORR_BLK_INTL + RxMessage[4];
  5344. mib_pread.ATUR_CHAN_UNCORR_BLK_INTL = RxMessage[4];
  5345. }
  5346. }
  5347. }
  5348. else if(chantype.fast == 1){
  5349. ATUR_CHAN_UNCORR_BLK_FLAG_MAKECMV_FAST;
  5350. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5351. #ifdef AMAZON_MEI_DEBUG_ON
  5352. printk("\n\nCMV fail, Group 7 Address 2 Index 1");
  5353. #endif
  5354. }
  5355. else{
  5356. temp = RxMessage[4] - mib_pread.ATUR_CHAN_UNCORR_BLK_FAST;
  5357. if(temp>=0){
  5358. current_intvl->AturChanPerfUncorrBlk+=temp;
  5359. ATUR_CHAN_UNCORR_BLK+=temp;
  5360. mib_pread.ATUR_CHAN_UNCORR_BLK_FAST = RxMessage[4];
  5361. }
  5362. else{
  5363. current_intvl->AturChanPerfUncorrBlk+=0xffff - mib_pread.ATUR_CHAN_UNCORR_BLK_FAST + RxMessage[4];
  5364. ATUR_CHAN_UNCORR_BLK+=0xffff - mib_pread.ATUR_CHAN_UNCORR_BLK_FAST + RxMessage[4];
  5365. mib_pread.ATUR_CHAN_UNCORR_BLK_FAST = RxMessage[4];
  5366. }
  5367. }
  5368. }
  5369. //RFC-3440
  5370. #ifdef AMAZON_MEI_MIB_RFC3440
  5371. ATUC_PERF_STAT_FASTR_FLAG_MAKECMV; //???
  5372. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5373. #ifdef AMAZON_MEI_DEBUG_ON
  5374. printk("\n\nCMV fail, Group 0 Address 0 Index 0");
  5375. #endif
  5376. }
  5377. else{
  5378. temp = RxMessage[4] - mib_pread.ATUC_PERF_STAT_FASTR;
  5379. if(temp>=0){
  5380. current_intvl->AtucPerfStatFastR+=temp;
  5381. ATUC_PERF_STAT_FASTR+=temp;
  5382. mib_pread.ATUC_PERF_STAT_FASTR = RxMessage[4];
  5383. }
  5384. else{
  5385. current_intvl->AtucPerfStatFastR+=0xffff - mib_pread.ATUC_PERF_STAT_FASTR + RxMessage[4];
  5386. ATUC_PERF_STAT_FASTR+=0xffff - mib_pread.ATUC_PERF_STAT_FASTR + RxMessage[4];
  5387. mib_pread.ATUC_PERF_STAT_FASTR = RxMessage[4];
  5388. }
  5389. }
  5390. ATUC_PERF_STAT_FAILED_FASTR_FLAG_MAKECMV; //???
  5391. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5392. #ifdef AMAZON_MEI_DEBUG_ON
  5393. printk("\n\nCMV fail, Group 0 Address 0 Index 0");
  5394. #endif
  5395. }
  5396. else{
  5397. temp = RxMessage[4] - mib_pread.ATUC_PERF_STAT_FAILED_FASTR;
  5398. if(temp>=0){
  5399. current_intvl->AtucPerfStatFailedFastR+=temp;
  5400. ATUC_PERF_STAT_FAILED_FASTR+=temp;
  5401. mib_pread.ATUC_PERF_STAT_FAILED_FASTR = RxMessage[4];
  5402. }
  5403. else{
  5404. current_intvl->AtucPerfStatFailedFastR+=0xffff - mib_pread.ATUC_PERF_STAT_FAILED_FASTR + RxMessage[4];
  5405. ATUC_PERF_STAT_FAILED_FASTR+=0xffff - mib_pread.ATUC_PERF_STAT_FAILED_FASTR + RxMessage[4];
  5406. mib_pread.ATUC_PERF_STAT_FAILED_FASTR = RxMessage[4];
  5407. }
  5408. }
  5409. ATUC_PERF_STAT_SESL_FLAG_MAKECMV;
  5410. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5411. #ifdef AMAZON_MEI_DEBUG_ON
  5412. printk("\n\nCMV fail, Group 7 Address 8 Index 0");
  5413. #endif
  5414. }
  5415. else{
  5416. temp = RxMessage[4] - mib_pread.ATUC_PERF_STAT_SESL;
  5417. if(temp>=0){
  5418. current_intvl->AtucPerfStatSesL+=temp;
  5419. ATUC_PERF_STAT_SESL+=temp;
  5420. mib_pread.ATUC_PERF_STAT_SESL = RxMessage[4];
  5421. }
  5422. else{
  5423. current_intvl->AtucPerfStatSesL+=0xffff - mib_pread.ATUC_PERF_STAT_SESL + RxMessage[4];
  5424. ATUC_PERF_STAT_SESL+=0xffff - mib_pread.ATUC_PERF_STAT_SESL + RxMessage[4];
  5425. mib_pread.ATUC_PERF_STAT_SESL = RxMessage[4];
  5426. }
  5427. }
  5428. ATUC_PERF_STAT_UASL_FLAG_MAKECMV;
  5429. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5430. #ifdef AMAZON_MEI_DEBUG_ON
  5431. printk("\n\nCMV fail, Group 7 Address 10 Index 0");
  5432. #endif
  5433. }
  5434. else{
  5435. temp = RxMessage[4] - mib_pread.ATUC_PERF_STAT_UASL;
  5436. if(temp>=0){
  5437. current_intvl->AtucPerfStatUasL+=temp;
  5438. ATUC_PERF_STAT_UASL+=temp;
  5439. mib_pread.ATUC_PERF_STAT_UASL = RxMessage[4];
  5440. }
  5441. else{
  5442. current_intvl->AtucPerfStatUasL+=0xffff - mib_pread.ATUC_PERF_STAT_UASL + RxMessage[4];
  5443. ATUC_PERF_STAT_UASL+=0xffff - mib_pread.ATUC_PERF_STAT_UASL + RxMessage[4];
  5444. mib_pread.ATUC_PERF_STAT_UASL = RxMessage[4];
  5445. }
  5446. }
  5447. ATUR_PERF_STAT_SESL_FLAG_MAKECMV;
  5448. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5449. #ifdef AMAZON_MEI_DEBUG_ON
  5450. printk("\n\nCMV fail, Group 7 Address 34 Index 0");
  5451. #endif
  5452. }
  5453. else{
  5454. temp = RxMessage[4] - mib_pread.ATUR_PERF_STAT_SESL;
  5455. if(temp>=0){
  5456. current_intvl->AtucPerfStatUasL+=temp;
  5457. ATUC_PERF_STAT_UASL+=temp;
  5458. mib_pread.ATUR_PERF_STAT_SESL = RxMessage[4];
  5459. }
  5460. else{
  5461. current_intvl->AtucPerfStatUasL+=0xffff - mib_pread.ATUR_PERF_STAT_SESL + RxMessage[4];
  5462. ATUC_PERF_STAT_UASL+=0xffff - mib_pread.ATUR_PERF_STAT_SESL + RxMessage[4];
  5463. mib_pread.ATUR_PERF_STAT_SESL = RxMessage[4];
  5464. }
  5465. }
  5466. #endif
  5467. up(&mei_sema);
  5468. do_gettimeofday(&time_fini);
  5469. i = ((int)((time_fini.tv_sec-time_now.tv_sec)*1000)) + ((int)((time_fini.tv_usec-time_now.tv_usec)/1000)) ; //msec
  5470. }//showtime==1
  5471. }
  5472. break;
  5473. #endif /* ] !IFX_SMALL_FOOTPRINT */
  5474. case AMAZON_MEI_RESET:
  5475. case AMAZON_MEI_REBOOT:
  5476. case AMAZON_MEI_SHOWTIME:
  5477. /* if(mei_arc_swap_buff !=NULL){
  5478. kfree(mei_arc_swap_buff);
  5479. mei_arc_swap_buff=NULL;
  5480. }
  5481. if(image_buffer !=NULL){
  5482. // kfree(image_buffer);
  5483. vfree(image_buffer);
  5484. image_buffer =NULL;
  5485. }
  5486. */
  5487. if(clreoc_command_pkt !=NULL){
  5488. kfree(clreoc_command_pkt);
  5489. clreoc_command_pkt =NULL;
  5490. }
  5491. for(i=0;i<CLREOC_BUFF_SIZE;i++)
  5492. clreoc_pkt[i].len=0; //flush all remaining clreoc commands in buffer
  5493. /*
  5494. memset(mei_mib, 0, (sizeof(amazon_mei_mib)*INTERVAL_NUM));
  5495. INIT_LIST_HEAD(&interval_list);
  5496. for(i=0;i<INTERVAL_NUM;i++)
  5497. list_add_tail(&(mei_mib[i].list), &interval_list);
  5498. current_intvl = list_entry(interval_list.next, amazon_mei_mib, list);
  5499. do_gettimeofday(&(current_intvl->start_time));
  5500. ATUC_PERF_LOFS=0;
  5501. ATUC_PERF_LOSS=0;
  5502. ATUC_PERF_ESS=0;
  5503. ATUC_PERF_INITS=0;
  5504. ATUR_PERF_LOFS=0;
  5505. ATUR_PERF_LOSS=0;
  5506. ATUR_PERF_LPR=0;
  5507. ATUR_PERF_ESS=0;
  5508. ATUR_CHAN_RECV_BLK=0;
  5509. ATUR_CHAN_TX_BLK=0;
  5510. ATUR_CHAN_CORR_BLK=0;
  5511. ATUR_CHAN_UNCORR_BLK=0;
  5512. memset((((u8 *)&AlarmConfProfile)+32), 0, 16*4);
  5513. AlarmConfProfile.adslLineAlarmConfProfileRowStatus=1;
  5514. */
  5515. PrevTxRate.adslAtucChanPrevTxRate=0;
  5516. PrevTxRate.adslAturChanPrevTxRate=0;
  5517. CurrStatus.adslAtucCurrStatus=0;
  5518. CurrStatus.adslAturCurrStatus=0;
  5519. if((command==AMAZON_MEI_RESET) || (command==AMAZON_MEI_REBOOT)){
  5520. #ifdef AMAZON_CHECK_LINK
  5521. if (adsl_link_notify){
  5522. (*adsl_link_notify)(0);
  5523. }
  5524. #endif
  5525. showtime=0;
  5526. //CLEAR_BIT((*((volatile u32 *)0xB0100B40)), 0x40); //Warning LED GPIO ON
  5527. // disconnect net_dev
  5528. if(chantype.interleave==1){
  5529. kfree(interleave_mei_net.priv);
  5530. unregister_netdev(&interleave_mei_net);
  5531. // if(unregister_netdev(&interleave_mei_net)!=0)
  5532. // printk("\n unregister interleave fail");
  5533. }
  5534. else if(chantype.fast==1){
  5535. kfree(fast_mei_net.priv);
  5536. unregister_netdev(&fast_mei_net);
  5537. // if(unregister_netdev(&fast_mei_net)!=0)
  5538. // printk("\n unregister fast fail");
  5539. }
  5540. chantype.interleave=0;
  5541. chantype.fast=0;
  5542. // 603221:tc.chen start
  5543. chantype.bearchannel0 = 0;
  5544. chantype.bearchannel1 = 0;
  5545. adsl_mode = 0;
  5546. // 603221:tc.chen end
  5547. while(1){
  5548. makeCMV(H2D_CMV_READ, STAT, 0, 0, 1, NULL); //maximum allowed tx message length, in bytes
  5549. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5550. //printk("AdslInitStatsData.FullInitializationCount++\n");
  5551. AdslInitStatsData.FullInitializationCount++;
  5552. //printk("AdslInitStatsData.FailedFullInitializationCount++\n");
  5553. AdslInitStatsData.FailedFullInitializationCount++;
  5554. //printk("AdslInitStatsData.LINIT_Errors++\n");
  5555. AdslInitStatsData.LINIT_Errors++;
  5556. }else
  5557. {
  5558. //printk("RxMessage=%X\n",RxMessage[4]);
  5559. if ( RxMessage[4]!=0x1)
  5560. {
  5561. //printk("AdslInitStatsData.FullInitializationCount++\n");
  5562. AdslInitStatsData.FullInitializationCount++;
  5563. if ( RxMessage[4] != 0x7)
  5564. {
  5565. //printk("AdslInitStatsData.LINIT_Errors++\n");
  5566. AdslInitStatsData.LINIT_Errors++;
  5567. //printk("AdslInitStatsData.FailedFullInitializationCount++\n");
  5568. AdslInitStatsData.FailedFullInitializationCount++;
  5569. }
  5570. }
  5571. }
  5572. reboot_flag=0;
  5573. wake_up_interruptible(&wait_queue_codeswap); //wake up codeswap daemon
  5574. interruptible_sleep_on_timeout(&wait_queue_reboot, 1*HZ); // sleep until arc ready
  5575. #ifdef ARC_READY_ACK
  5576. if(reboot_flag!=0)
  5577. break;
  5578. else
  5579. {
  5580. up(&mei_sema);
  5581. printk("\n reboot retry");
  5582. }
  5583. #else
  5584. break;
  5585. #endif
  5586. }
  5587. }
  5588. else{ //AMAZON_MEI_SHOWTIME
  5589. if(down_interruptible(&mei_sema))
  5590. return -ERESTARTSYS;
  5591. // clreoc stuff
  5592. makeCMV(H2D_CMV_READ, INFO, 83, 0, 1, data); //maximum allowed tx message length, in bytes
  5593. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5594. #ifdef AMAZON_MEI_DEBUG_ON
  5595. printk("\n\nCMV fail, Group 3 Address 83 Index 0");
  5596. #endif
  5597. }
  5598. else{
  5599. clreoc_max_tx_len = (int)RxMessage[4];
  5600. clreoc_command_pkt = kmalloc((clreoc_max_tx_len*CLREOC_BUFF_SIZE), GFP_KERNEL);
  5601. if(clreoc_command_pkt == NULL){
  5602. #ifdef AMAZON_MEI_DEBUG_ON
  5603. printk("kmalloc error for clreoc_command_pkt\n\n");
  5604. #endif
  5605. up(&mei_sema);
  5606. return -1;
  5607. }
  5608. for(i=0;i<CLREOC_BUFF_SIZE;i++){
  5609. clreoc_pkt[i].command = (u8 *)(((u8 *)clreoc_command_pkt) + (clreoc_max_tx_len*i));
  5610. clreoc_pkt[i].len=0;
  5611. }
  5612. }
  5613. // decide what channel, then register
  5614. makeCMV(H2D_CMV_READ, STAT, 12, 0, 1, data);
  5615. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5616. #ifdef AMAZON_MEI_DEBUG_ON
  5617. printk("\n\nCMV fail, Group 2 Address 12 Index 0");
  5618. #endif
  5619. }
  5620. else{
  5621. if((RxMessage[4]&0x1)==1){
  5622. if(register_netdev(&interleave_mei_net)!=0){
  5623. #ifdef AMAZON_MEI_DEBUG_ON
  5624. printk("\n\n Register interleave Device Failed.");
  5625. #endif
  5626. }
  5627. else{
  5628. chantype.interleave = 1;
  5629. chantype.fast= 0;
  5630. #ifdef AMAZON_MEI_DEBUG_ON
  5631. printk("\n channel is interleave");
  5632. #endif
  5633. }
  5634. }
  5635. else if((RxMessage[4]&0x2)==2){
  5636. if(register_netdev(&fast_mei_net)!=0){
  5637. #ifdef AMAZON_MEI_DEBUG_ON
  5638. printk("\n\n Register fast Device Failed.");
  5639. #endif
  5640. }
  5641. else{
  5642. chantype.fast = 1;
  5643. chantype.interleave = 0;
  5644. #ifdef AMAZON_MEI_DEBUG_ON
  5645. printk("\n channel is fast");
  5646. #endif
  5647. }
  5648. }
  5649. else{
  5650. #ifdef AMAZON_MEI_DEBUG_ON
  5651. printk("\nunknown channel type, 0x%8x", RxMessage[4]);
  5652. #endif
  5653. }
  5654. // 603221:tc.chen start
  5655. if ( (RxMessage[4]&0x100) == 0x100)
  5656. {
  5657. chantype.bearchannel0 = 1;
  5658. }else if ( (RxMessage[4]&0x100) == 0x200)
  5659. {
  5660. chantype.bearchannel1 = 1;
  5661. }
  5662. // 603221:tc.chen end
  5663. }
  5664. // 603221:tc.chen start
  5665. // read adsl mode
  5666. makeCMV(H2D_CMV_READ, STAT, 1, 0, 1, data);
  5667. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5668. #ifdef AMAZON_MEI_DEBUG_ON
  5669. printk("\n\nCMV fail, Group STAT Address 1 Index 0");
  5670. #endif
  5671. }
  5672. adsl_mode = RxMessage[4];
  5673. // 603221:tc.chen end
  5674. makeCMV(H2D_CMV_READ, STAT, 17, 0, 1, data);
  5675. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5676. #ifdef AMAZON_MEI_DEBUG_ON
  5677. printk("\n\nCMV fail, Group STAT Address 1 Index 0");
  5678. #endif
  5679. }
  5680. adsl_mode_extend = RxMessage[4];
  5681. // update previous channel tx rate
  5682. ATUC_CHAN_CURR_TX_RATE_FLAG_MAKECMV;
  5683. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5684. #ifdef AMAZON_MEI_DEBUG_ON
  5685. printk("\n\nCMV fail, Group 6 Address 1 Index 0");
  5686. #endif
  5687. PrevTxRate.adslAtucChanPrevTxRate = 0;
  5688. }
  5689. else{
  5690. PrevTxRate.adslAtucChanPrevTxRate = (u32)(RxMessage[4]) + (((u32)(RxMessage[5]))<<16);
  5691. }
  5692. ATUR_CHAN_CURR_TX_RATE_FLAG_MAKECMV;
  5693. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5694. #ifdef AMAZON_MEI_DEBUG_ON
  5695. printk("\n\nCMV fail, Group 6 Address 0 Index 0");
  5696. #endif
  5697. PrevTxRate.adslAturChanPrevTxRate = 0;
  5698. }
  5699. else{
  5700. PrevTxRate.adslAturChanPrevTxRate = (u32)(RxMessage[4]) + (((u32)(RxMessage[5]))<<16);
  5701. }
  5702. // up(&mei_sema);
  5703. // showtime=1;
  5704. //SET_BIT((*((volatile u32 *)0xB0100B40)), 0x40); //Warning LED GPIO OFF
  5705. //dying gasp -start
  5706. #ifdef IFX_DYING_GASP
  5707. lop_debugwr.buffer[0]=0xffffffff; //dying gasp
  5708. lop_debugwr.iCount=1; //dying gasp
  5709. makeCMV(H2D_CMV_READ, INFO, 66, 4, 1, NULL);
  5710. //mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, &RxMessage);
  5711. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5712. #ifdef AMAZON_MEI_DEBUG_ON
  5713. printk("\n\nCMV fail, Group 3 Address 66 Index 4");
  5714. }
  5715. #endif
  5716. lop_debugwr.iAddress=(u32)RxMessage[4];
  5717. makeCMV(H2D_CMV_READ, INFO, 66, 5, 1, NULL);
  5718. //mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, &RxMessage);
  5719. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5720. #ifdef AMAZON_MEI_DEBUG_ON
  5721. printk("\n\nCMV fail, Group 3 Address 66 Index 5");
  5722. }
  5723. #endif
  5724. lop_debugwr.iAddress+=((u32)RxMessage[4])<<16;
  5725. //dying gasp -end
  5726. #endif // IFX_DYING_GASP
  5727. //joelin 04/16/2005-start
  5728. makeCMV(H2D_CMV_WRITE, PLAM, 10, 0, 1, &unavailable_seconds);
  5729. //mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, &RxMessage);
  5730. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5731. #ifdef AMAZON_MEI_DEBUG_ON
  5732. printk("\n\nCMV fail, Group 7 Address 10 Index 0");
  5733. #endif
  5734. }
  5735. //joelin 04/16/2005-end
  5736. showtime=1;
  5737. up(&mei_sema);
  5738. #ifdef AMAZON_CHECK_LINK
  5739. if (adsl_link_notify){
  5740. (*adsl_link_notify)(1);
  5741. }
  5742. #endif
  5743. }
  5744. break;
  5745. /*
  5746. case AMAZON_MEI_REPLY:
  5747. copy_from_user((char *)buff, (char *)lon, MSG_LENGTH * 2);
  5748. if(meiCMV(buff, YES_REPLY) != MEI_SUCCESS){
  5749. printk("\n\n meiCMV no reply back");
  5750. meierr=MEI_FAILURE;
  5751. }
  5752. else
  5753. copy_to_user((char *)lon, (char *)RxMessage, MSG_LENGTH * 2);
  5754. break;
  5755. case AMAZON_MEI_NOREPLY:
  5756. copy_from_user((char *)buff, (char *)lon, MSG_LENGTH * 2);
  5757. if(meiCMV(buff, NO_REPLY) != MEI_SUCCESS){
  5758. printk("\n\n meiCMV Host to DSP failed");
  5759. meierr=MEI_FAILURE;
  5760. }
  5761. break;
  5762. */
  5763. case AMAZON_MEI_HALT:
  5764. meiHaltArc();
  5765. break;
  5766. case AMAZON_MEI_CMV_WINHOST:
  5767. if(down_interruptible(&mei_sema))
  5768. return -ERESTARTSYS;
  5769. if (!from_kernel )
  5770. copy_from_user((char *)TxMessage, (char *)lon, MSG_LENGTH*2);//joelin
  5771. else
  5772. memcpy(TxMessage,(char *)lon,MSG_LENGTH*2);
  5773. #if 0
  5774. // if((TxMessage[0]&0xff0)==0x0a0){
  5775. for(i=0;i<16;i++){
  5776. printk("\nTxMessage[%i]=%8x", i, TxMessage[i]);
  5777. }
  5778. // }
  5779. #endif
  5780. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  5781. #ifdef AMAZON_MEI_DEBUG_ON
  5782. // printk("\n\n WINHOST CMV fail ");
  5783. printk("\n\nWINHOST CMV fail :TxMessage:%X %X %X %X, RxMessage:%X %X %X %X %X\n",TxMessage[0],TxMessage[1],TxMessage[2],TxMessage[3],RxMessage[0],RxMessage[1],RxMessage[2],RxMessage[3],RxMessage[4]);
  5784. #endif
  5785. meierr = MEI_FAILURE;
  5786. }
  5787. else
  5788. {
  5789. if (!from_kernel ) //joelin
  5790. copy_to_user((char *)lon, (char *)RxMessage, MSG_LENGTH*2);
  5791. else
  5792. memcpy((char *)lon,(char *)RxMessage,MSG_LENGTH*2);
  5793. }
  5794. up(&mei_sema);
  5795. break;
  5796. #ifdef AMAZON_MEI_CMV_EXTRA
  5797. case AMAZON_MEI_CMV_READ:
  5798. copy_from_user((char *)(&regrdwr), (char *)lon, sizeof(meireg));
  5799. meiLongwordRead(regrdwr.iAddress, &(regrdwr.iData));
  5800. {
  5801. // printk("\n\n iAddress = %8x",regrdwr.iAddress);
  5802. }
  5803. copy_to_user((char *)lon, (char *)(&regrdwr), sizeof(meireg));
  5804. {
  5805. // printk("\n\n iData readback = %8x", regrdwr.iData);
  5806. }
  5807. break;
  5808. #endif
  5809. #ifdef AMAZON_MEI_CMV_EXTRA
  5810. case AMAZON_MEI_CMV_WRITE:
  5811. copy_from_user((char *)(&regrdwr), (char *)lon, sizeof(meireg));
  5812. {
  5813. // printk("\n\n iAddress = %8x",regrdwr.iAddress);
  5814. // printk("\n\n iData = %8x",regrdwr.iData);
  5815. }
  5816. meiLongwordWrite(regrdwr.iAddress, regrdwr.iData);
  5817. break;
  5818. #endif
  5819. #ifdef AMAZON_MEI_CMV_EXTRA
  5820. case AMAZON_MEI_REMOTE:
  5821. copy_from_user((char *)(&i), (char *)lon, sizeof(int));
  5822. if(i==0){
  5823. meiMailboxInterruptsEnable();
  5824. up(&mei_sema);
  5825. }
  5826. else if(i==1){
  5827. meiMailboxInterruptsDisable();
  5828. if(down_interruptible(&mei_sema))
  5829. return -ERESTARTSYS;
  5830. }
  5831. else{
  5832. #ifdef AMAZON_MEI_DEBUG_ON
  5833. printk("\n\n AMAZON_MEI_REMOTE argument error");
  5834. #endif
  5835. meierr=MEI_FAILURE;
  5836. }
  5837. break;
  5838. #endif
  5839. #ifdef AMAZON_MEI_CMV_EXTRA
  5840. case AMAZON_MEI_READDEBUG:
  5841. case AMAZON_MEI_WRITEDEBUG:
  5842. if(down_interruptible(&mei_sema))
  5843. return -ERESTARTSYS;
  5844. #ifdef IFX_DYING_GASP
  5845. if (!from_kernel) copy_from_user((char *)(&debugrdwr), (char *)lon, sizeof(debugrdwr));//dying gasp
  5846. else memcpy((char *)(&debugrdwr), (char *)lon, sizeof(debugrdwr));
  5847. #else //IFX_DYING_GASP
  5848. copy_from_user((char *)(&debugrdwr), (char *)lon, sizeof(debugrdwr));
  5849. #endif //IFX_DYING_GASP
  5850. #if 0
  5851. printk("\nIN iAddress: %8x, iCount:%8x\n", debugrdwr.iAddress, debugrdwr.iCount);
  5852. #endif
  5853. if(command==AMAZON_MEI_READDEBUG)
  5854. meiDebugRead(debugrdwr.iAddress, debugrdwr.buffer, debugrdwr.iCount);
  5855. else
  5856. meiDebugWrite(debugrdwr.iAddress, debugrdwr.buffer, debugrdwr.iCount);
  5857. #ifdef IFX_DYING_GASP
  5858. if (!from_kernel) copy_to_user((char *)lon, (char*)(&debugrdwr), sizeof(debugrdwr));//dying gasp
  5859. #else //IFX_DYING_GASP
  5860. copy_to_user((char *)lon, (char*)(&debugrdwr), sizeof(debugrdwr));
  5861. #endif //IFX_DYING_GASP
  5862. up(&mei_sema);
  5863. #if 0
  5864. printk("\nOUT iAddress: %8x, iCount:%8x\n", debugrdwr.iAddress, debugrdwr.iCount);
  5865. for(i=0;i<debugrdwr.iCount;i++)
  5866. printk("\n %8x",debugrdwr.buffer[i]);
  5867. #endif
  5868. break;
  5869. #endif
  5870. case AMAZON_MEI_LOP:
  5871. //GPIO31 :dying gasp event indication
  5872. // (1) logic high: dying gasp event is false (default)
  5873. // (2) logic low: dying gasp event is true
  5874. #ifdef IFX_DYING_GASP
  5875. break;
  5876. #else
  5877. CLEAR_BIT((*((volatile u32 *)0xB0100B48)), 0x8000);
  5878. CLEAR_BIT((*((volatile u32 *)0xB0100B4C)), 0x8000);
  5879. CLEAR_BIT((*((volatile u32 *)0xB0100B50)), 0x8000);
  5880. SET_BIT((*((volatile u32 *)0xB0100B54)), 0x8000);
  5881. asm("SYNC");
  5882. if(((*((volatile u32 *)0xB0100B44))&0x8000)==0x0)
  5883. meierr=MEI_FAILURE; //return - to indicate loss of power
  5884. break;
  5885. #endif //#ifdef IFX_DYING_GASP
  5886. //for PCM
  5887. case AMAZON_MEI_PCM_SETUP:
  5888. //gpio
  5889. *AMAZON_GPIO_P0_DIR |=1<<15;
  5890. *AMAZON_GPIO_P0_ALTSEL0 |=1<<15;
  5891. *AMAZON_GPIO_P0_ALTSEL1 &=~(1<<15);
  5892. *AMAZON_GPIO_P0_OD |=1<<15;
  5893. /*GPIO 16 TDM_DI*/
  5894. *AMAZON_GPIO_P1_DIR &=~1;
  5895. *AMAZON_GPIO_P1_ALTSEL0 |=1;
  5896. *AMAZON_GPIO_P1_ALTSEL1 &=~1;
  5897. /*GPIO 17 TDM_DCL */
  5898. *AMAZON_GPIO_P1_DIR|=0x02;
  5899. *AMAZON_GPIO_P1_ALTSEL0|=0x02;
  5900. *AMAZON_GPIO_P1_ALTSEL1 &=(u32)~0x02;
  5901. *AMAZON_GPIO_P1_OD|=0x02;
  5902. /*GPIO 18 TDM FSC*/
  5903. *AMAZON_GPIO_P1_DIR|=0x04;
  5904. *AMAZON_GPIO_P1_ALTSEL0|=0x04;
  5905. *AMAZON_GPIO_P1_ALTSEL1 &=(u32)~0x04;
  5906. *AMAZON_GPIO_P1_OD|=0x04;
  5907. for(i=0;i<2;i++){
  5908. for(j=0;j<256;j++)
  5909. sampledata[i*256+j]=j;
  5910. }
  5911. pcm_start_addr = lon;
  5912. printk("\n\n pcm_start_addr is %8x", lon);
  5913. for(i=0;i<PCM_CHANNEL_NUM;i++){
  5914. #ifdef PCM_ACCESS_DEBUG
  5915. meiDebugRead_16((pcm_start_addr+i*16), (u32*)(pcm_data+i), 4);
  5916. #else
  5917. meiDMARead_16((pcm_start_addr+i*16), (u32*)(pcm_data+i), 4);
  5918. #endif
  5919. if((pcm_data[i].S!=8)||(pcm_data[i].len<1)||(pcm_data[i].rdindex!=0)||(pcm_data[i].wrindex!=0)||(pcm_data[i].flow!=0))
  5920. printk("\n\n pcm_data fill in wrongly\n\n");
  5921. printk("\npcm_data %d",i);
  5922. printk("\n S = %d", pcm_data[i].S);
  5923. printk("\n LSW = %4x", pcm_data[i].LSW);
  5924. printk("\n MSW = %4x", pcm_data[i].MSW);
  5925. printk("\n len = %d", pcm_data[i].len);
  5926. printk("\n rdindex = %d", pcm_data[i].rdindex);
  5927. printk("\n wrindex = %d", pcm_data[i].wrindex);
  5928. printk("\n flow = %d", pcm_data[i].flow);
  5929. pcm_data[i].finish=0;
  5930. if(i%2==0){//tx channel
  5931. for(j=0;j<PCM_BUFF_SIZE/256;j++){
  5932. for(k=0;k<256;k++){
  5933. pcm_data[i].buff[j*256+k]=k;
  5934. /* if(k%2==0)
  5935. pcm_data[i].buff[j*256+k]=0xaa;
  5936. else
  5937. pcm_data[i].buff[j*256+k]=0x55;*/
  5938. }
  5939. }
  5940. #ifdef PCM_ACCESS_DEBUG
  5941. meiDebugWrite_8((((u32)(pcm_data[i].LSW))+(((u32)(pcm_data[i].MSW))<<16)), (u32*)(pcm_data[i].buff),((pcm_data[i].len/4)/2));//fill half first
  5942. // meiDebugWrite_8((((u32)(pcm_data[i].LSW))+(((u32)(pcm_data[i].MSW))<<16)), (u32*)(pcm_data[i].buff),2);//fill half first
  5943. #else
  5944. meiDMAWrite_8((((u32)(pcm_data[i].LSW))+(((u32)(pcm_data[i].MSW))<<16)), (u32*)(pcm_data[i].buff),((pcm_data[i].len/4)/2));//fill half first
  5945. // meiDMAWrite_8((((u32)(pcm_data[i].LSW))+(((u32)(pcm_data[i].MSW))<<16)), (u32*)(pcm_data[i].buff),2);//fill half first
  5946. #endif
  5947. pcm_data[i].point=(pcm_data[i].len)/2;
  5948. // pcm_data[i].point=8;
  5949. #ifdef PCM_ACCESS_DEBUG
  5950. meiDebugRead_16(pcm_start_addr+i*16+12, &temp, 1);
  5951. #else
  5952. meiDMARead_16(pcm_start_addr+i*16+12, &temp, 1);
  5953. #endif
  5954. temp = (temp &0xffff) + (((u32)(pcm_data[i].point))<<16);
  5955. #ifdef PCM_ACCESS_DEBUG
  5956. meiDebugWrite_16(pcm_start_addr+i*16+12,&temp, 1);//update wrindex
  5957. #else
  5958. meiDMAWrite_16(pcm_start_addr+i*16+12,&temp, 1);//update wrindex
  5959. #endif
  5960. }
  5961. else{// rx channel
  5962. pcm_data[i].point=0;
  5963. }
  5964. }
  5965. break;
  5966. case AMAZON_MEI_PCM_START_TIMER:
  5967. /* GPTU timer 6 */
  5968. /* enable the timer in the PMU */
  5969. *(AMAZON_PMU_PWDCR) = (*(AMAZON_PMU_PWDCR))| AMAZON_PMU_PWDCR_GPT|AMAZON_PMU_PWDCR_FPI;
  5970. /* setup the GPTU for timer tick f_fpi == f_gptu*/
  5971. *(AMAZON_GPTU_CLC) = 0x100;
  5972. //reload value = fpi/(HZ * P), timer mode, Prescaler = 4 ( T6I = 000, T6BPS2 = 0)
  5973. *(AMAZON_GPTU_CAPREL) = (int)(117500000/(lon*4));
  5974. *(AMAZON_GPTU_T6CON) = 0x80C0;
  5975. if (request_irq(AMAZON_TIMER6_INT, amazon_timer6_interrupt_MEI,0, "hrt", NULL)!=0){
  5976. #ifdef AMAZON_MEI_DEBUG_ON
  5977. printk("\n\n unable to register irq for hrt!!!");
  5978. #endif
  5979. return -1;
  5980. }
  5981. enable_irq(AMAZON_TIMER6_INT);
  5982. break;
  5983. case AMAZON_MEI_PCM_STOP_TIMER:
  5984. disable_irq(AMAZON_TIMER6_INT);
  5985. free_irq(AMAZON_TIMER6_INT, NULL);
  5986. break;
  5987. case AMAZON_MEI_PCM_CHECK:
  5988. for(i=0;i<PCM_CHANNEL_NUM;i++){
  5989. if(pcm_data[i].finish!=1)
  5990. return 0;
  5991. }
  5992. for(i=0;i<PCM_CHANNEL_NUM/2;i++){
  5993. j=0;
  5994. while(1){
  5995. if((pcm_data[i*2+1].buff[j]==0x0) && (pcm_data[i*2+1].buff[j+1]==0x1)&& (pcm_data[i*2+1].buff[j+2]==0x2))
  5996. break;
  5997. else
  5998. j++;
  5999. }
  6000. printk("\n j=%d", j);
  6001. temp=0;
  6002. for(k=0;k<((PCM_BUFF_SIZE-j)/4);k++){
  6003. if(memcmp(pcm_data[i*2].buff+k*4, pcm_data[i*2+1].buff+j+k*4, 4)!=0){
  6004. temp++;
  6005. printk("\n\n%2x %2x %2x %2x %2x %2x %2x %2x\n\n", *((u8*)(pcm_data[i*2].buff+k*4)), *((u8*)(pcm_data[i*2].buff+k*4+1)),*((u8*)(pcm_data[i*2].buff+k*4+2)),*((u8*)(pcm_data[i*2].buff+k*4+3)),*((u8*)(pcm_data[i*2+1].buff+j+k*4)),*((u8*)(pcm_data[i*2+1].buff+j+k*4+1)),*((u8*)(pcm_data[i*2+1].buff+j+k*4+2)),*((u8*)(pcm_data[i*2+1].buff+j+k*4+3)));
  6006. break;
  6007. }
  6008. }
  6009. if(temp!=0)
  6010. printk("\n\n Channel pair %d not match: err32 %d\n\n", i, temp);
  6011. else
  6012. printk("\n\n Channel pair %d match\n\n", i);
  6013. }
  6014. for(i=0;i<PCM_CHANNEL_NUM;i++){
  6015. if(i%2==1){//rx channel
  6016. #ifdef PCM_ACCESS_DEBUG
  6017. meiDebugRead_16(pcm_start_addr+i*16+12, &temp, 1);
  6018. #else
  6019. meiDMARead_16(pcm_start_addr+i*16+12, &temp, 1);
  6020. #endif
  6021. printk("\n\nRx channel %d: Overflow Bytes %d", i, (temp&0xffff));
  6022. }
  6023. else{//tx channel
  6024. #ifdef PCM_ACCESS_DEBUG
  6025. meiDebugRead_16(pcm_start_addr+i*16, &temp, 1);
  6026. #else
  6027. meiDMARead_16(pcm_start_addr+i*16, &temp, 1);
  6028. #endif
  6029. printk("\n\nElectra Err: %d",(temp&0xffff));
  6030. }
  6031. }
  6032. //check electra overflow
  6033. meierr=1;
  6034. break;
  6035. case AMAZON_MEI_PCM_GETDATA:
  6036. copy_to_user(lon, pcm_data[1].buff, PCM_BUFF_SIZE);
  6037. break;
  6038. case AMAZON_MEI_PCM_GPIO:
  6039. //gpio
  6040. *AMAZON_GPIO_P0_DIR |=1<<15;
  6041. *AMAZON_GPIO_P0_ALTSEL0 |=1<<15;
  6042. *AMAZON_GPIO_P0_ALTSEL1 &=~(1<<15);
  6043. *AMAZON_GPIO_P0_OD |=1<<15;
  6044. /*GPIO 16 TDM_DI*/
  6045. *AMAZON_GPIO_P1_DIR &=~1;
  6046. *AMAZON_GPIO_P1_ALTSEL0 |=1;
  6047. *AMAZON_GPIO_P1_ALTSEL1 &=~1;
  6048. /*GPIO 17 TDM_DCL */
  6049. *AMAZON_GPIO_P1_DIR|=0x02;
  6050. *AMAZON_GPIO_P1_ALTSEL0|=0x02;
  6051. *AMAZON_GPIO_P1_ALTSEL1 &=(u32)~0x02;
  6052. *AMAZON_GPIO_P1_OD|=0x02;
  6053. /*GPIO 18 TDM FSC*/
  6054. *AMAZON_GPIO_P1_DIR|=0x04;
  6055. *AMAZON_GPIO_P1_ALTSEL0|=0x04;
  6056. *AMAZON_GPIO_P1_ALTSEL1 &=(u32)~0x04;
  6057. *AMAZON_GPIO_P1_OD|=0x04;
  6058. break;
  6059. //for clearEoC
  6060. #ifdef AMAZON_CLEAR_EOC
  6061. case AMAZON_MEI_GET_EOC_LEN:
  6062. while(1){
  6063. current_clreoc = list_entry(clreoc_list.next, amazon_clreoc_pkt, list);
  6064. if((current_clreoc->len)>0){
  6065. copy_to_user((char *)lon, (char*)(&(current_clreoc->len)), 4);
  6066. break;
  6067. }
  6068. else//wait for eoc data from higher layer
  6069. interruptible_sleep_on(&wait_queue_clreoc);
  6070. }
  6071. break;
  6072. case AMAZON_MEI_GET_EOC_DATA:
  6073. current_clreoc = list_entry(clreoc_list.next, amazon_clreoc_pkt, list);
  6074. if((current_clreoc->len)>0){
  6075. copy_to_user((char*)lon, (char*)(current_clreoc->command), current_clreoc->len);
  6076. meierr=1;
  6077. list_del(clreoc_list.next); //remove and add to end of list
  6078. current_clreoc->len = 0;
  6079. list_add_tail(&(current_clreoc->list), &clreoc_list);
  6080. }
  6081. else
  6082. meierr=-1;
  6083. break;
  6084. case AMAZON_MEI_EOC_SEND:
  6085. copy_from_user((char *)(&debugrdwr), (char *)lon, sizeof(debugrdwr));
  6086. eoc_skb = dev_alloc_skb(debugrdwr.iCount*4);
  6087. if(eoc_skb==NULL){
  6088. printk("\n\nskb alloc fail");
  6089. break;
  6090. }
  6091. eoc_skb->len=debugrdwr.iCount*4;
  6092. memcpy(skb_put(eoc_skb, debugrdwr.iCount*4), (char *)debugrdwr.buffer, debugrdwr.iCount*4);
  6093. ifx_push_eoc(eoc_skb); //pass data to higher layer
  6094. break;
  6095. #endif //#ifdef AMAZON_CLEAR_EOC
  6096. case AMAZON_MIB_LO_ATUC:
  6097. do_gettimeofday(&time_now);
  6098. if(lon&0x1){
  6099. if((time_now.tv_sec-(mib_pflagtime.ATUC_PERF_LOSS_PTIME).tv_sec)>2){
  6100. current_intvl->AtucPerfLos++;
  6101. ATUC_PERF_LOSS++;
  6102. CurrStatus.adslAtucCurrStatus = 2;
  6103. }
  6104. (mib_pflagtime.ATUC_PERF_LOSS_PTIME).tv_sec = time_now.tv_sec;
  6105. }
  6106. if(lon&0x2){
  6107. if((time_now.tv_sec-(mib_pflagtime.ATUC_PERF_LOFS_PTIME).tv_sec)>2){
  6108. current_intvl->AtucPerfLof++;
  6109. ATUC_PERF_LOFS++;
  6110. CurrStatus.adslAtucCurrStatus = 1;
  6111. }
  6112. (mib_pflagtime.ATUC_PERF_LOFS_PTIME).tv_sec = time_now.tv_sec;
  6113. }
  6114. if(!(lon&0x3))
  6115. CurrStatus.adslAtucCurrStatus = 0;
  6116. break;
  6117. case AMAZON_MIB_LO_ATUR:
  6118. do_gettimeofday(&time_now);
  6119. if(lon&0x1){
  6120. if((time_now.tv_sec-(mib_pflagtime.ATUR_PERF_LOSS_PTIME).tv_sec)>2){
  6121. current_intvl->AturPerfLos++;
  6122. ATUR_PERF_LOSS++;
  6123. CurrStatus.adslAturCurrStatus = 2;
  6124. }
  6125. (mib_pflagtime.ATUR_PERF_LOSS_PTIME).tv_sec = time_now.tv_sec;
  6126. }
  6127. if(lon&0x2){
  6128. if((time_now.tv_sec-(mib_pflagtime.ATUR_PERF_LOFS_PTIME).tv_sec)>2){
  6129. current_intvl->AturPerfLof++;
  6130. ATUR_PERF_LOFS++;
  6131. CurrStatus.adslAturCurrStatus = 1;
  6132. }
  6133. (mib_pflagtime.ATUR_PERF_LOFS_PTIME).tv_sec = time_now.tv_sec;
  6134. }
  6135. if(lon&0x4){
  6136. if((time_now.tv_sec-(mib_pflagtime.ATUR_PERF_LPR_PTIME).tv_sec)>2){
  6137. current_intvl->AturPerfLpr++;
  6138. ATUR_PERF_LPR++;
  6139. CurrStatus.adslAturCurrStatus = 3;
  6140. }
  6141. (mib_pflagtime.ATUR_PERF_LPR_PTIME).tv_sec = time_now.tv_sec;
  6142. }
  6143. if(!(lon&0x7))
  6144. CurrStatus.adslAturCurrStatus = 0;
  6145. break;
  6146. case AMAZON_MEI_DOWNLOAD:
  6147. // DMA the boot code page(s)
  6148. #ifdef AMAZON_MEI_DEBUG_ON
  6149. printk("\n\n start download pages");
  6150. #endif
  6151. for( boot_loop = 0; boot_loop < img_hdr->count; boot_loop++){
  6152. if( img_hdr->page[boot_loop].p_size & BOOT_FLAG){
  6153. page_size = meiGetPage( boot_loop, GET_PROG, MAXSWAPSIZE, mei_arc_swap_buff, &dest_addr);
  6154. if( page_size > 0){
  6155. meiDMAWrite(dest_addr, mei_arc_swap_buff, page_size);
  6156. }
  6157. }
  6158. if( img_hdr->page[boot_loop].d_size & BOOT_FLAG){
  6159. page_size = meiGetPage( boot_loop, GET_DATA, MAXSWAPSIZE, mei_arc_swap_buff, &dest_addr);
  6160. if( page_size > 0){
  6161. meiDMAWrite( dest_addr, mei_arc_swap_buff, page_size);
  6162. }
  6163. }
  6164. }
  6165. #ifdef AMAZON_MEI_DEBUG_ON
  6166. printk("\n\n pages downloaded");
  6167. #endif
  6168. break;
  6169. //509221:tc.chen start
  6170. case AMAZON_MEI_DEBUG_MODE:
  6171. mei_debug_mode = lon;
  6172. break;
  6173. //509221:tc.chen end
  6174. }
  6175. return meierr;
  6176. }
  6177. ////////////////////// Interrupt handler /////////////////////////////////////////////////////
  6178. static void mei_interrupt_arcmsgav(int,void *,struct pt_regs *);
  6179. static void mei_interrupt_arcmsgav(int int1, void * void0, struct pt_regs * regs)
  6180. {
  6181. u32 scratch;
  6182. u32 fetchpage;
  6183. u32 size;
  6184. u32 dest_addr;
  6185. u32 temp;
  6186. int i;
  6187. meiDebugRead(ARC_MEI_MAILBOXR, &scratch, 1);
  6188. if(scratch & OMB_CODESWAP_MESSAGE_MSG_TYPE_MASK)
  6189. {
  6190. if(showtime==1){
  6191. #ifdef AMAZON_MEI_DEBUG_ON
  6192. printk("\n\n Code Swap Request After ShowTime !!!");
  6193. #endif
  6194. }
  6195. else{
  6196. #ifdef AMAZON_MEI_DEBUG_ON
  6197. // printk("\n\n Code Swap Request");
  6198. #endif
  6199. fetchpage = scratch & ~OMB_CODESWAP_MESSAGE_MSG_TYPE_MASK;
  6200. size = meiGetPage( fetchpage, GET_PROG, MAXSWAPSIZE, mei_arc_swap_buff, &dest_addr);
  6201. if( size > 0)
  6202. {
  6203. #ifdef AMAZON_MEI_DEBUG_ON
  6204. // printk(" : prom page num %d",fetchpage);
  6205. #endif
  6206. meiDMAWrite( dest_addr, mei_arc_swap_buff, size);
  6207. }
  6208. size = meiGetPage( fetchpage, GET_DATA, MAXSWAPSIZE, mei_arc_swap_buff, &dest_addr);
  6209. if( size > 0)
  6210. {
  6211. #ifdef AMAZON_MEI_DEBUG_ON
  6212. // printk(" : data page num %d",fetchpage);
  6213. #endif
  6214. meiDMAWrite( dest_addr, mei_arc_swap_buff, size);
  6215. }
  6216. }
  6217. // Notify arc that mailbox read complete
  6218. meiLongwordWrite(ARC_TO_MEI_INT, ARC_TO_MEI_MSGAV);
  6219. // Tell ARC Codeswap is done
  6220. meiLongwordWrite(MEI_TO_ARC_INT, MEI_TO_ARC_CS_DONE);
  6221. asm("SYNC");
  6222. i=0;
  6223. while(i<WHILE_DELAY){
  6224. meiLongwordRead(MEI_TO_ARC_INT, &temp);
  6225. if((temp & MEI_TO_ARC_CS_DONE) ==0){
  6226. #ifdef AMAZON_MEI_DEBUG_ON
  6227. // printk("\n\n Code Swap Done");
  6228. #endif
  6229. break;
  6230. }
  6231. i++;
  6232. if(i==WHILE_DELAY){
  6233. #ifdef AMAZON_MEI_DEBUG_ON
  6234. printk("\n\n MEI_TO_ARC_CS_DONE not cleared by ARC");
  6235. //509221:tc.chen start
  6236. if (!mei_debug_mode)
  6237. {
  6238. //printk("Reset Arc!\n");
  6239. //printk("AdslInitStatsData.FullInitializationCount++\n");
  6240. AdslInitStatsData.FullInitializationCount++;
  6241. if (!showtime)
  6242. {
  6243. //printk("AdslInitStatsData.FailedFullInitializationCount++\n");
  6244. AdslInitStatsData.FailedFullInitializationCount++;
  6245. //printk("AdslInitStatsData.LINIT_Errors++\n");
  6246. AdslInitStatsData.LINIT_Errors++;
  6247. }
  6248. wake_up_interruptible(&wait_queue_codeswap); // wait up ioctl reboot
  6249. }
  6250. //509221:tc.chen end
  6251. #endif
  6252. }
  6253. }
  6254. }
  6255. else{ // normal message
  6256. // printk("\n\n interrupt");
  6257. meiMailboxRead(RxMessage, MSG_LENGTH);
  6258. if(cmv_waiting==1){
  6259. arcmsgav=1;
  6260. cmv_waiting=0;
  6261. wake_up_interruptible(&wait_queue_arcmsgav);
  6262. }
  6263. else{
  6264. indicator_count++;
  6265. memcpy((char *)Recent_indicator, (char *)RxMessage, MSG_LENGTH *2);
  6266. #ifdef ARC_READY_ACK
  6267. if(((RxMessage[0]&0xff0)>>4)==D2H_AUTONOMOUS_MODEM_READY_MSG){ //check ARC ready message
  6268. #ifdef LOCK_RETRY
  6269. if (reboot_lock)
  6270. {
  6271. reboot_lock = 0;
  6272. up(&mei_sema); // allow cmv access
  6273. }
  6274. #else
  6275. up(&mei_sema); // allow cmv access
  6276. #endif
  6277. reboot_flag=1;
  6278. //#ifdef ADSL_LED_SUPPORT
  6279. #if 0
  6280. led_support_check=1;//adsl led for 1.1.2.7.1.1
  6281. adsl_led_flash();//adsl led for 1.1.2.7.1.1
  6282. #endif
  6283. wake_up_interruptible(&wait_queue_reboot); // wait up ioctl reboot
  6284. }
  6285. #endif
  6286. }
  6287. }
  6288. // meiLongwordWrite(ARC_TO_MEI_INT, ARC_TO_MEI_MSGAV);
  6289. mask_and_ack_amazon_irq(AMAZON_MEI_INT);
  6290. return;
  6291. }
  6292. // 603221:tc.chen start
  6293. ////////////////////////hdlc ////////////////
  6294. // get hdlc status
  6295. static unsigned int ifx_me_hdlc_status(void)
  6296. {
  6297. u16 CMVMSG[MSG_LENGTH];
  6298. int ret;
  6299. if (showtime!=1)
  6300. return -ENETRESET;
  6301. makeCMV_local(H2D_CMV_READ, STAT, 14, 0, 1, NULL,CMVMSG); //Get HDLC status
  6302. ret = mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, CMVMSG);
  6303. if (ret != 0)
  6304. {
  6305. return -EIO;
  6306. }
  6307. return CMVMSG[4]&0x0F;
  6308. }
  6309. int ifx_me_is_resloved(int status)
  6310. {
  6311. u16 CMVMSG[MSG_LENGTH];
  6312. int ret;
  6313. if (status == ME_HDLC_MSG_QUEUED || status == ME_HDLC_MSG_SENT)
  6314. return ME_HDLC_UNRESOLVED;
  6315. if (status == ME_HDLC_IDLE)
  6316. {
  6317. makeCMV_local(H2D_CMV_READ, CNTL, 2, 0, 1, NULL,CMVMSG); //Get ME-HDLC Control
  6318. ret = mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, CMVMSG);
  6319. if (ret != 0)
  6320. {
  6321. return IFX_POP_EOC_FAIL;
  6322. }
  6323. if (CMVMSG[4]&(1<<0))
  6324. {
  6325. return ME_HDLC_UNRESOLVED;
  6326. }
  6327. }
  6328. return ME_HDLC_RESOLVED;
  6329. }
  6330. int _ifx_me_hdlc_send(unsigned char *hdlc_pkt,int len,int max_length)
  6331. {
  6332. int ret;
  6333. u16 CMVMSG[MSG_LENGTH];
  6334. u16 data=0;
  6335. u16 pkt_len=len;
  6336. if (pkt_len > max_length)
  6337. {
  6338. printk("Exceed maximum eoc message length\n");
  6339. return -ENOBUFS;
  6340. }
  6341. //while(pkt_len > 0)
  6342. {
  6343. makeCMV_local(H2D_CMV_WRITE, INFO, 81, 0, (pkt_len+1)/2,(u16 *)hdlc_pkt,CMVMSG); //Write clear eoc message to ARC
  6344. ret = mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, CMVMSG);
  6345. if (ret != 0)
  6346. {
  6347. return -EIO;
  6348. }
  6349. makeCMV_local(H2D_CMV_WRITE, INFO, 83, 2, 1,&pkt_len,CMVMSG); //Update tx message length
  6350. ret = mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, CMVMSG);
  6351. if (ret != 0)
  6352. {
  6353. return -EIO;
  6354. }
  6355. data = (1<<0);
  6356. makeCMV_local(H2D_CMV_WRITE, CNTL, 2, 0, 1,&data,CMVMSG); //Start to send
  6357. ret = mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, CMVMSG);
  6358. if (ret != 0)
  6359. {
  6360. return -EIO;
  6361. }
  6362. return 0;
  6363. }
  6364. }
  6365. static int ifx_me_hdlc_send(unsigned char *hdlc_pkt,int hdlc_pkt_len)
  6366. {
  6367. int hdlc_status=0;
  6368. u16 CMVMSG[MSG_LENGTH];
  6369. int max_hdlc_tx_length=0,ret=0,retry=0;
  6370. while(retry<10)
  6371. {
  6372. hdlc_status = ifx_me_hdlc_status();
  6373. if (ifx_me_is_resloved(hdlc_status)==ME_HDLC_RESOLVED) // arc ready to send HDLC message
  6374. {
  6375. makeCMV_local(H2D_CMV_READ, INFO, 83, 0, 1, NULL,CMVMSG); //Get Maximum Allowed HDLC Tx Message Length
  6376. ret = mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, CMVMSG);
  6377. if (ret != 0)
  6378. {
  6379. return -EIO;
  6380. }
  6381. max_hdlc_tx_length = CMVMSG[4];
  6382. ret = _ifx_me_hdlc_send(hdlc_pkt,hdlc_pkt_len,max_hdlc_tx_length);
  6383. return ret;
  6384. }
  6385. set_current_state(TASK_INTERRUPTIBLE);
  6386. schedule_timeout(10);
  6387. }
  6388. return -EBUSY;
  6389. }
  6390. int ifx_mei_hdlc_read(char *hdlc_pkt,int max_hdlc_pkt_len)
  6391. {
  6392. u16 CMVMSG[MSG_LENGTH];
  6393. int msg_read_len,ret=0,pkt_len=0,retry = 0;
  6394. while(retry<10)
  6395. {
  6396. ret = ifx_me_hdlc_status();
  6397. if (ret == ME_HDLC_RESP_RCVD)
  6398. {
  6399. int current_size=0;
  6400. makeCMV_local(H2D_CMV_READ, INFO, 83, 3, 1, NULL,CMVMSG); //Get EoC packet length
  6401. ret = mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, CMVMSG);
  6402. if (ret != 0)
  6403. {
  6404. return -EIO;
  6405. }
  6406. pkt_len = CMVMSG[4];
  6407. if (pkt_len > max_hdlc_pkt_len)
  6408. {
  6409. ret = -ENOMEM;
  6410. goto error;
  6411. }
  6412. while( current_size < pkt_len)
  6413. {
  6414. if (pkt_len - current_size >(MSG_LENGTH*2-8))
  6415. msg_read_len = (MSG_LENGTH*2-8);
  6416. else
  6417. msg_read_len = pkt_len - (current_size);
  6418. makeCMV_local(H2D_CMV_READ, INFO, 82, 0 + (current_size/2), (msg_read_len+1)/2, NULL,CMVMSG); //Get hdlc packet
  6419. ret = mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, CMVMSG);
  6420. if (ret != 0)
  6421. {
  6422. goto error;
  6423. }
  6424. memcpy(hdlc_pkt+current_size,&CMVMSG[4],msg_read_len);
  6425. current_size +=msg_read_len;
  6426. }
  6427. ret = current_size;
  6428. break;
  6429. }else
  6430. {
  6431. ret = -ENODATA;
  6432. }
  6433. retry++;
  6434. set_current_state(TASK_INTERRUPTIBLE);
  6435. schedule_timeout(10);
  6436. }
  6437. return ret;
  6438. error:
  6439. return ret;
  6440. }
  6441. ////////////////////////hdlc ////////////////
  6442. // 603221:tc.chen end
  6443. /////////////////////// clearEoC, int ifx_pop_eoc(sk_buff * pkt) //////////
  6444. int ifx_pop_eoc(struct sk_buff * pkt);
  6445. int ifx_pop_eoc(struct sk_buff * pkt)
  6446. {
  6447. amazon_clreoc_pkt * current;
  6448. if(showtime!=1){
  6449. dev_kfree_skb(pkt);
  6450. return IFX_POP_EOC_FAIL;
  6451. }
  6452. if((pkt->len)>clreoc_max_tx_len){
  6453. dev_kfree_skb(pkt);
  6454. return IFX_POP_EOC_FAIL;
  6455. }
  6456. current = list_entry(clreoc_list.next, amazon_clreoc_pkt, list);
  6457. while(1){
  6458. if(current->len==0){
  6459. memcpy(current->command, pkt->data, pkt->len);
  6460. current->len=pkt->len;
  6461. break;
  6462. }
  6463. else{
  6464. if((current->list).next==&clreoc_list){
  6465. dev_kfree_skb(pkt);
  6466. return IFX_POP_EOC_FAIL; //buffer full
  6467. }
  6468. current = list_entry((current->list).next,amazon_clreoc_pkt, list);
  6469. }
  6470. }
  6471. wake_up_interruptible(&wait_queue_clreoc);
  6472. dev_kfree_skb(pkt);
  6473. return IFX_POP_EOC_DONE;
  6474. }
  6475. /* this is used in circular fifo mode */
  6476. /*
  6477. int ifx_pop_eoc(sk_buff * pkt);
  6478. int ifx_pop_eoc(sk_buff * pkt)
  6479. {
  6480. int buff_space,i;
  6481. if(showtime!=1)
  6482. return IFX_POP_EOC_FAIL;
  6483. if(clreoc_wr>=clreoc_rd)
  6484. buff_space = (MEI_CLREOC_BUFF_SIZE-1)-(clreoc_wr - clreoc_rd);
  6485. else
  6486. buff_space = clreoc_rd - clreoc_wr - 1;
  6487. if((pkt->len)>buff_space)
  6488. return IFX_POP_EOC_FAIL;
  6489. if((clreoc_wr+pkt->len)>MEI_CLREOC_BUFF_SIZE){
  6490. memcpy((clreoc+clreoc_wr), pkt->data, ((clreoc_wr+pkt->len)-MEI_CLREOC_BUFF_SIZE+1));
  6491. memcpy(clreoc, (pkt->data)+((clreoc_wr+pkt->len)-MEI_CLREOC_BUFF_SIZE+1), (pkt->len)-((clreoc_wr+pkt->len)-MEI_CLREOC_BUFF_SIZE+1));
  6492. clreoc_wr=(clreoc_wr+pkt->len)-MEI_CLREOC_BUFF_SIZE;
  6493. }
  6494. else{
  6495. memcpy((clreoc+clreoc_wr), pkt->data, pkt->len);
  6496. if((clreoc_wr+pkt->len)=MEI_CLREOC_BUFF_SIZE)
  6497. clreoc_wr=0;
  6498. else
  6499. clreoc_wr+=pkt->len;
  6500. }
  6501. wake_up_interruptible(&wait_queue_clreoc);
  6502. return IFX_POP_EOC_DONE;
  6503. }
  6504. */
  6505. ////////////////////////////////////////////////////////////////////////////
  6506. //int amazon_mei_init_module (void);
  6507. //void amazon_mei_cleanup_module (void);
  6508. //int __init init_module (void);
  6509. //void __exit cleanup_module (void);
  6510. int __init amazon_mei_init_module(void)
  6511. //int __init init_module(void)
  6512. {
  6513. struct proc_dir_entry *entry;
  6514. int i;
  6515. //dying gasp-start
  6516. #ifdef IFX_DYING_GASP
  6517. //000003:fchang Start
  6518. #ifdef CONFIG_CPU_AMAZON_E
  6519. //GPIO31 :dying gasp event indication
  6520. // (1) logic high: dying gasp event is false (default)
  6521. // (2) logic low: dying gasp event is true
  6522. CLEAR_BIT((*((volatile u32 *)0xB0100B18)), 0x4);
  6523. CLEAR_BIT((*((volatile u32 *)0xB0100B1c)), 0x4);
  6524. CLEAR_BIT((*((volatile u32 *)0xB0100B20)), 0x4);
  6525. SET_BIT((*((volatile u32 *)0xB0100B24)), 0x4);
  6526. asm("SYNC");
  6527. #else //000003:fchang End
  6528. //GPIO31 :dying gasp event indication
  6529. // (1) logic high: dying gasp event is false (default)
  6530. // (2) logic low: dying gasp event is true
  6531. CLEAR_BIT((*((volatile u32 *)0xB0100B48)), 0x8000);
  6532. CLEAR_BIT((*((volatile u32 *)0xB0100B4C)), 0x8000);
  6533. CLEAR_BIT((*((volatile u32 *)0xB0100B50)), 0x8000);
  6534. SET_BIT((*((volatile u32 *)0xB0100B54)), 0x8000);
  6535. #if 0
  6536. //warning-led-start
  6537. //GPIO 22
  6538. SET_BIT ((*((volatile u32 *)0xB0100B48)), 0x40);
  6539. CLEAR_BIT((*((volatile u32 *)0xB0100B4C)), 0x40);
  6540. CLEAR_BIT((*((volatile u32 *)0xB0100B50)), 0x40);
  6541. SET_BIT((*((volatile u32 *)0xB0100B54)), 0x40);
  6542. CLEAR_BIT((*((volatile u32 *)0xB0100B40)), 0x40); //GPIO ON
  6543. printk("LED ON ON ON ON ON ON.....");
  6544. //warning-led-end
  6545. #endif
  6546. asm("SYNC");
  6547. #endif //000003:fchang
  6548. #endif //IFX_DYING_GASP
  6549. //dying gasp -end
  6550. reg_entry_t regs_temp[PROC_ITEMS] = // Items being debugged
  6551. {
  6552. /* { flag, name, description } */
  6553. { &arcmsgav, "arcmsgav", "arc to mei message ", 0 },
  6554. { &cmv_reply, "cmv_reply", "cmv needs reply", 0},
  6555. { &cmv_waiting, "cmv_waiting", "waiting for cmv reply from arc", 0},
  6556. { &indicator_count, "indicator_count", "ARC to MEI indicator count", 0},
  6557. { &cmv_count, "cmv_count", "MEI to ARC CMVs", 0},
  6558. { &reply_count, "reply_count", "ARC to MEI Reply", 0},
  6559. { (int *)Recent_indicator, "Recent_indicator", "most recent indicator", 0},
  6560. { (int *)8, "version", "version of firmware", 0},
  6561. };
  6562. memcpy((char *)regs, (char *)regs_temp, sizeof(regs_temp));
  6563. //sema_init(&mei_sema, 0); // semaphore initialization, mutex
  6564. sema_init(&mei_sema, 1); // semaphore initialization, mutex
  6565. init_waitqueue_head(&wait_queue_arcmsgav); // for ARCMSGAV
  6566. init_waitqueue_head(&wait_queue_codeswap); // for codeswap daemon
  6567. init_waitqueue_head(&wait_queue_mibdaemon); // for mib daemon
  6568. init_waitqueue_head(&wait_queue_reboot); // for ioctl reboot
  6569. init_waitqueue_head(&wait_queue_clreoc); // for clreoc_wr function
  6570. init_waitqueue_head(&wait_queue_loop_diagnostic); // for loop diagnostic function
  6571. #ifdef ADSL_LED_SUPPORT
  6572. init_waitqueue_head(&wait_queue_led); // adsl led for led function
  6573. init_waitqueue_head(&wait_queue_led_polling); // adsl led for led function
  6574. led_task.routine = adsl_led_flash_task; // adsl led for led function
  6575. led_poll_init(); // adsl led for led function
  6576. #endif //ADSL_LED_SUPPORT
  6577. #ifdef IFX_DYING_GASP
  6578. init_waitqueue_head(&wait_queue_dying_gasp); // IFX_DYING_GASP
  6579. lop_poll_init(); // IFX_DYING_GASP
  6580. #endif //IFX_DYING_GASP
  6581. init_waitqueue_head(&wait_queue_uas_poll);//joelin 04/16/2005
  6582. unavailable_seconds_poll_init();//joelin 04/16/2005
  6583. memset(&mib_pflagtime, 0, (sizeof(mib_flags_pretime)));
  6584. // initialize link list for intervals
  6585. mei_mib = (amazon_mei_mib *)kmalloc((sizeof(amazon_mei_mib)*INTERVAL_NUM), GFP_KERNEL);
  6586. if(mei_mib == NULL){
  6587. #ifdef AMAZON_MEI_DEBUG_ON
  6588. printk("kmalloc error for amazon_mei_mib\n\n");
  6589. #endif
  6590. return -1;
  6591. }
  6592. memset(mei_mib, 0, (sizeof(amazon_mei_mib)*INTERVAL_NUM));
  6593. INIT_LIST_HEAD(&interval_list);
  6594. for(i=0;i<INTERVAL_NUM;i++)
  6595. list_add_tail(&(mei_mib[i].list), &interval_list);
  6596. current_intvl = list_entry(interval_list.next, amazon_mei_mib, list);
  6597. do_gettimeofday(&(current_intvl->start_time));
  6598. // initialize clreoc list
  6599. clreoc_pkt = (amazon_clreoc_pkt *)kmalloc((sizeof(amazon_clreoc_pkt)*CLREOC_BUFF_SIZE), GFP_KERNEL);
  6600. if(clreoc_pkt == NULL){
  6601. #ifdef AMAZON_MEI_DEBUG_ON
  6602. printk("kmalloc error for clreoc_pkt\n\n");
  6603. #endif
  6604. return -1;
  6605. }
  6606. memset(clreoc_pkt, 0, (sizeof(amazon_clreoc_pkt)*CLREOC_BUFF_SIZE));
  6607. INIT_LIST_HEAD(&clreoc_list);
  6608. for(i=0;i<CLREOC_BUFF_SIZE;i++)
  6609. list_add_tail(&(clreoc_pkt[i].list), &clreoc_list);
  6610. memset(&AdslInitStatsData, 0, sizeof(AdslInitStatsData));
  6611. if (register_chrdev(major, "amazon_mei", &mei_operations)!=0) {
  6612. #ifdef AMAZON_MEI_DEBUG_ON
  6613. printk("\n\n unable to register major for amazon_mei!!!");
  6614. #endif
  6615. return -1;
  6616. }
  6617. if (request_irq(AMAZON_MEI_INT, mei_interrupt_arcmsgav,0, "amazon_mei_arcmsgav", NULL)!=0){
  6618. #ifdef AMAZON_MEI_DEBUG_ON
  6619. printk("\n\n unable to register irq for amazon_mei!!!");
  6620. #endif
  6621. return -1;
  6622. }
  6623. // disable_irq(AMAZON_MEI_INT);
  6624. enable_irq(AMAZON_MEI_INT);
  6625. // procfs
  6626. meidir=proc_mkdir(MEI_DIRNAME, &proc_root);
  6627. if ( meidir == NULL) {
  6628. #ifdef AMAZON_MEI_DEBUG_ON
  6629. printk(KERN_ERR ": can't create /proc/" MEI_DIRNAME "\n\n");
  6630. #endif
  6631. return(-ENOMEM);
  6632. }
  6633. for(i=0;i<NUM_OF_REG_ENTRY;i++) {
  6634. entry = create_proc_entry(regs[i].name,
  6635. S_IWUSR |S_IRUSR | S_IRGRP | S_IROTH,
  6636. meidir);
  6637. if(entry) {
  6638. regs[i].low_ino = entry->low_ino;
  6639. entry->proc_fops = &proc_operations;
  6640. } else {
  6641. #ifdef AMAZON_MEI_DEBUG_ON
  6642. printk( KERN_ERR
  6643. ": can't create /proc/" MEI_DIRNAME
  6644. "/%s\n\n", regs[i].name);
  6645. #endif
  6646. return(-ENOMEM);
  6647. }
  6648. }
  6649. ///////////////////////////////// register net device ////////////////////////////
  6650. if(register_netdev(&phy_mei_net)!=0){
  6651. #ifdef AMAZON_MEI_DEBUG_ON
  6652. printk("\n\n Register phy Device Failed.");
  6653. #endif
  6654. return -1;
  6655. }
  6656. /*
  6657. if(register_netdev(&interleave_mei_net)!=0){
  6658. printk("\n\n Register interleave Device Failed.");
  6659. return -1;
  6660. }
  6661. if(register_netdev(&fast_mei_net)!=0){
  6662. printk("\n\n Register fast Device Failed.");
  6663. return -1;
  6664. }
  6665. */
  6666. #ifdef DFE_LOOPBACK
  6667. mei_arc_swap_buff = (u32 *)kmalloc(MAXSWAPSIZE*4, GFP_KERNEL);
  6668. if (mei_arc_swap_buff){
  6669. #ifdef ARC_READY_ACK
  6670. if(down_interruptible(&mei_sema)) //disable CMV access until ARC ready
  6671. {
  6672. return -ERESTARTSYS;
  6673. }
  6674. #ifdef LOCK_RETRY
  6675. reboot_lock = 1;
  6676. #endif
  6677. #endif
  6678. meiForceRebootAdslModem();
  6679. kfree(mei_arc_swap_buff);
  6680. }else{
  6681. #ifdef AMAZON_MEI_DEBUG_ON
  6682. printk("cannot load image: no memory\n\n");
  6683. #endif
  6684. }
  6685. #endif
  6686. #ifdef IFX_SMALL_FOOTPRINT
  6687. mib_poll_init();
  6688. #endif
  6689. return 0;
  6690. }
  6691. void __exit amazon_mei_cleanup_module(void)
  6692. //void __exit cleanup_module(void)
  6693. {
  6694. int i;
  6695. #ifdef ADSL_LED_SUPPORT
  6696. stop_led_module=1; //wake up and clean led module
  6697. led_support_check=0;//joelin , clear task
  6698. showtime=0;//joelin,clear task
  6699. //CLEAR_BIT((*((volatile u32 *)0xB0100B40)), 0x40); //Warning LED GPIO ON
  6700. firmware_support_led=0;//joelin ,clear task
  6701. wake_up_interruptible(&wait_queue_led); //wake up and clean led module
  6702. wake_up_interruptible(&wait_queue_led_polling); //wake up and clean led module
  6703. #endif
  6704. for(i=0;i<NUM_OF_REG_ENTRY;i++)
  6705. remove_proc_entry(regs[i].name, meidir);
  6706. remove_proc_entry(MEI_DIRNAME, &proc_root);
  6707. disable_irq(AMAZON_MEI_INT);
  6708. free_irq(AMAZON_MEI_INT, NULL);
  6709. unregister_chrdev(major, "amazon_mei");
  6710. kfree(mei_mib);
  6711. kfree(clreoc_pkt);
  6712. kfree(phy_mei_net.priv);
  6713. unregister_netdev(&phy_mei_net);
  6714. return;
  6715. }
  6716. #ifdef IFX_SMALL_FOOTPRINT
  6717. int adsl_mib_poll(void *unused)
  6718. {
  6719. struct task_struct *tsk = current;
  6720. int i=0;
  6721. struct timeval time_now;
  6722. struct timeval time_fini;
  6723. u32 temp,temp2;
  6724. amazon_mei_mib * mib_ptr;
  6725. // u16 buff[MSG_LENGTH]__attribute__ ((aligned(4)));
  6726. u16 * data=NULL; //used in makeCMV, to pass in payload when CMV set, ignored when CMV read.
  6727. daemonize();
  6728. strcpy(tsk->comm, "kmibpoll");
  6729. sigfillset(&tsk->blocked);
  6730. printk("Inside mib poll loop ...\n");
  6731. i=0;
  6732. while(1){
  6733. if(i<MIB_INTERVAL)
  6734. interruptible_sleep_on_timeout(&wait_queue_mibdaemon, ((MIB_INTERVAL-i)/(1000/HZ)));
  6735. i=0;
  6736. if(showtime==1){
  6737. // printk("\n\n update mib");
  6738. do_gettimeofday(&time_now);
  6739. if(time_now.tv_sec - current_intvl->start_time.tv_sec>=900){
  6740. if(current_intvl->list.next!=&interval_list){
  6741. current_intvl = list_entry(current_intvl->list.next, amazon_mei_mib, list);
  6742. do_gettimeofday(&(current_intvl->start_time));
  6743. }
  6744. else{
  6745. mib_ptr = list_entry(interval_list.next, amazon_mei_mib, list);
  6746. list_del(interval_list.next);
  6747. memset(mib_ptr, 0, sizeof(amazon_mei_mib));
  6748. list_add_tail(&(mib_ptr->list), &interval_list);
  6749. if(current_intvl->list.next==&interval_list)
  6750. #ifdef AMAZON_MEI_DEBUG_ON
  6751. printk("\n\nlink list error");
  6752. #endif
  6753. current_intvl = list_entry(current_intvl->list.next, amazon_mei_mib, list);
  6754. do_gettimeofday(&(current_intvl->start_time));
  6755. }
  6756. }
  6757. if(down_interruptible(&mei_sema))
  6758. return -ERESTARTSYS;
  6759. /*
  6760. ATUC_PERF_LO_FLAG_MAKECMV;
  6761. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  6762. #ifdef AMAZON_MEI_DEBUG_ON
  6763. printk("\n\nCMV fail, Group 7 Address 0 Index 0");
  6764. #endif
  6765. }
  6766. else{
  6767. if(RxMessage[4]&PLAM_LOS_FailureBit){
  6768. current_intvl->AtucPerfLos++;
  6769. ATUC_PERF_LOSS++;
  6770. CurrStatus.adslAtucCurrStatus = 2;
  6771. }
  6772. if(RxMessage[4]&PLAM_LOF_FailureBit){
  6773. current_intvl->AtucPerfLof++;
  6774. ATUC_PERF_LOFS++;
  6775. CurrStatus.adslAtucCurrStatus = 1;
  6776. }
  6777. if(!(RxMessage[4]&(PLAM_LOS_FailureBit|PLAM_LOF_FailureBit)))
  6778. CurrStatus.adslAtucCurrStatus = 0;
  6779. }
  6780. */
  6781. if(showtime!=1)
  6782. goto mib_poll_end;
  6783. ATUC_PERF_ESS_FLAG_MAKECMV;
  6784. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  6785. #ifdef AMAZON_MEI_DEBUG_ON
  6786. printk("\n\nCMV fail, Group 7 Address 7 Index 0");
  6787. #endif
  6788. }
  6789. else{
  6790. temp = RxMessage[4]-mib_pread.ATUC_PERF_ESS;
  6791. if(temp>=0){
  6792. current_intvl->AtucPerfEs+=temp;
  6793. ATUC_PERF_ESS+=temp;
  6794. mib_pread.ATUC_PERF_ESS = RxMessage[4];
  6795. }
  6796. else{
  6797. current_intvl->AtucPerfEs+=0xffff-mib_pread.ATUC_PERF_ESS+RxMessage[4];
  6798. ATUC_PERF_ESS+=0xffff-mib_pread.ATUC_PERF_ESS+RxMessage[4];
  6799. mib_pread.ATUC_PERF_ESS = RxMessage[4];
  6800. }
  6801. }
  6802. /*
  6803. ATUR_PERF_LO_FLAG_MAKECMV;
  6804. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  6805. #ifdef AMAZON_MEI_DEBUG_ON
  6806. printk("\n\nCMV fail, Group 7 Address 1 Index 0");
  6807. #endif
  6808. }
  6809. else{
  6810. if(RxMessage[4]&PLAM_LOS_FailureBit){
  6811. current_intvl->AturPerfLos++;
  6812. ATUR_PERF_LOSS++;
  6813. CurrStatus.adslAturCurrStatus = 2;
  6814. }
  6815. if(RxMessage[4]&PLAM_LOF_FailureBit){
  6816. current_intvl->AturPerfLof++;
  6817. ATUR_PERF_LOFS++;
  6818. CurrStatus.adslAturCurrStatus = 1;
  6819. }
  6820. if(RxMessage[4]&PLAM_LPR_FailureBit){
  6821. current_intvl->AturPerfLpr++;
  6822. ATUR_PERF_LPR++;
  6823. CurrStatus.adslAturCurrStatus = 3;
  6824. }
  6825. if(!(RxMessage[4]&(PLAM_LOS_FailureBit|PLAM_LOF_FailureBit|PLAM_LPR_FailureBit)))
  6826. CurrStatus.adslAturCurrStatus = 0;
  6827. }
  6828. */
  6829. if(showtime!=1)
  6830. goto mib_poll_end;
  6831. ATUR_PERF_ESS_FLAG_MAKECMV;
  6832. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  6833. #ifdef AMAZON_MEI_DEBUG_ON
  6834. printk("\n\nCMV fail, Group 7 Address 33 Index 0");
  6835. #endif
  6836. }
  6837. else{
  6838. temp = RxMessage[4]-mib_pread.ATUR_PERF_ESS;
  6839. if(temp>=0){
  6840. current_intvl->AturPerfEs+=temp;
  6841. ATUR_PERF_ESS+=temp;
  6842. mib_pread.ATUR_PERF_ESS = RxMessage[4];
  6843. }
  6844. else{
  6845. current_intvl->AturPerfEs+=0xffff-mib_pread.ATUR_PERF_ESS+RxMessage[4];
  6846. ATUR_PERF_ESS+= 0xffff-mib_pread.ATUR_PERF_ESS+RxMessage[4];
  6847. mib_pread.ATUR_PERF_ESS=RxMessage[4];
  6848. }
  6849. }
  6850. if(showtime!=1)
  6851. goto mib_poll_end;
  6852. // to update rx/tx blocks
  6853. ATUR_CHAN_RECV_BLK_FLAG_MAKECMV_LSW;
  6854. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  6855. #ifdef AMAZON_MEI_DEBUG_ON
  6856. printk("\n\nCMV fail, Group 7 Address 20 Index 0");
  6857. #endif
  6858. }
  6859. else{
  6860. temp = RxMessage[4];
  6861. }
  6862. if(showtime!=1)
  6863. goto mib_poll_end;
  6864. ATUR_CHAN_RECV_BLK_FLAG_MAKECMV_MSW;
  6865. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  6866. #ifdef AMAZON_MEI_DEBUG_ON
  6867. printk("\n\nCMV fail, Group 7 Address 21 Index 0");
  6868. #endif
  6869. }
  6870. else{
  6871. temp2 = RxMessage[4];
  6872. }
  6873. if((temp + (temp2<<16) - mib_pread.ATUR_CHAN_RECV_BLK)>=0){
  6874. current_intvl->AturChanPerfRxBlk+=temp + (temp2<<16) - mib_pread.ATUR_CHAN_RECV_BLK;
  6875. ATUR_CHAN_RECV_BLK+=temp + (temp2<<16) - mib_pread.ATUR_CHAN_RECV_BLK;
  6876. mib_pread.ATUR_CHAN_RECV_BLK = temp + (temp2<<16);
  6877. }
  6878. else{
  6879. current_intvl->AturChanPerfRxBlk+=0xffffffff - mib_pread.ATUR_CHAN_RECV_BLK +(temp + (temp2<<16));
  6880. ATUR_CHAN_RECV_BLK+=0xffffffff - mib_pread.ATUR_CHAN_RECV_BLK +(temp + (temp2<<16));
  6881. mib_pread.ATUR_CHAN_RECV_BLK = temp + (temp2<<16);
  6882. }
  6883. current_intvl->AturChanPerfTxBlk = current_intvl->AturChanPerfRxBlk;
  6884. ATUR_CHAN_TX_BLK = ATUR_CHAN_RECV_BLK;
  6885. /*
  6886. ATUR_CHAN_TX_BLK_FLAG_MAKECMV_LSW;
  6887. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS)
  6888. printk("\n\nCMV fail, Group 7 Address 20 Index 0");
  6889. else{
  6890. if(RxMessage[4]){
  6891. current_intvl->AturChanPerfTxBlk+=RxMessage[4];
  6892. ATUR_CHAN_TX_BLK+=RxMessage[4];
  6893. }
  6894. }
  6895. ATUR_CHAN_TX_BLK_FLAG_MAKECMV_MSW;
  6896. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS)
  6897. printk("\n\nCMV fail, Group 7 Address 21 Index 0");
  6898. else{
  6899. if(RxMessage[4]){
  6900. current_intvl->AturChanPerfTxBlk+=(int)((RxMessage[4])<<16);
  6901. ATUR_CHAN_TX_BLK+=(int)((RxMessage[4])<<16);
  6902. }
  6903. }
  6904. */
  6905. if(chantype.interleave == 1){
  6906. if(showtime!=1)
  6907. goto mib_poll_end;
  6908. ATUR_CHAN_CORR_BLK_FLAG_MAKECMV_INTL;
  6909. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  6910. #ifdef AMAZON_MEI_DEBUG_ON
  6911. printk("\n\nCMV fail, Group 7 Address 3 Index 0");
  6912. #endif
  6913. }
  6914. else{
  6915. temp = RxMessage[4] - mib_pread.ATUR_CHAN_CORR_BLK_INTL;
  6916. if(temp>=0){
  6917. current_intvl->AturChanPerfCorrBlk+=temp;
  6918. ATUR_CHAN_CORR_BLK+=temp;
  6919. mib_pread.ATUR_CHAN_CORR_BLK_INTL = RxMessage[4];
  6920. }
  6921. else{
  6922. current_intvl->AturChanPerfCorrBlk+=0xffff - mib_pread.ATUR_CHAN_CORR_BLK_INTL +RxMessage[4];
  6923. ATUR_CHAN_CORR_BLK+=0xffff - mib_pread.ATUR_CHAN_CORR_BLK_INTL +RxMessage[4];
  6924. mib_pread.ATUR_CHAN_CORR_BLK_INTL = RxMessage[4];
  6925. }
  6926. }
  6927. }
  6928. else if(chantype.fast == 1){
  6929. if(showtime!=1)
  6930. goto mib_poll_end;
  6931. ATUR_CHAN_CORR_BLK_FLAG_MAKECMV_FAST;
  6932. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  6933. #ifdef AMAZON_MEI_DEBUG_ON
  6934. printk("\n\nCMV fail, Group 7 Address 3 Index 1");
  6935. #endif
  6936. }
  6937. else{
  6938. temp = RxMessage[4] - mib_pread.ATUR_CHAN_CORR_BLK_FAST;
  6939. if(temp>=0){
  6940. current_intvl->AturChanPerfCorrBlk+=temp;
  6941. ATUR_CHAN_CORR_BLK+=temp;
  6942. mib_pread.ATUR_CHAN_CORR_BLK_FAST = RxMessage[4];
  6943. }
  6944. else{
  6945. current_intvl->AturChanPerfCorrBlk+=0xffff - mib_pread.ATUR_CHAN_CORR_BLK_FAST + RxMessage[4];
  6946. ATUR_CHAN_CORR_BLK+=0xffff - mib_pread.ATUR_CHAN_CORR_BLK_FAST + RxMessage[4];
  6947. mib_pread.ATUR_CHAN_CORR_BLK_FAST = RxMessage[4];
  6948. }
  6949. }
  6950. }
  6951. if(chantype.interleave == 1){
  6952. if(showtime!=1)
  6953. goto mib_poll_end;
  6954. ATUR_CHAN_UNCORR_BLK_FLAG_MAKECMV_INTL;
  6955. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  6956. #ifdef AMAZON_MEI_DEBUG_ON
  6957. printk("\n\nCMV fail, Group 7 Address 2 Index 0");
  6958. #endif
  6959. }
  6960. else{
  6961. temp = RxMessage[4] - mib_pread.ATUR_CHAN_UNCORR_BLK_INTL;
  6962. if(temp>=0){
  6963. current_intvl->AturChanPerfUncorrBlk+=temp;
  6964. ATUR_CHAN_UNCORR_BLK+=temp;
  6965. mib_pread.ATUR_CHAN_UNCORR_BLK_INTL = RxMessage[4];
  6966. }
  6967. else{
  6968. current_intvl->AturChanPerfUncorrBlk+=0xffff - mib_pread.ATUR_CHAN_UNCORR_BLK_INTL + RxMessage[4];
  6969. ATUR_CHAN_UNCORR_BLK+=0xffff - mib_pread.ATUR_CHAN_UNCORR_BLK_INTL + RxMessage[4];
  6970. mib_pread.ATUR_CHAN_UNCORR_BLK_INTL = RxMessage[4];
  6971. }
  6972. }
  6973. }
  6974. else if(chantype.fast == 1){
  6975. if(showtime!=1)
  6976. goto mib_poll_end;
  6977. ATUR_CHAN_UNCORR_BLK_FLAG_MAKECMV_FAST;
  6978. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  6979. #ifdef AMAZON_MEI_DEBUG_ON
  6980. printk("\n\nCMV fail, Group 7 Address 2 Index 1");
  6981. #endif
  6982. }
  6983. else{
  6984. temp = RxMessage[4] - mib_pread.ATUR_CHAN_UNCORR_BLK_FAST;
  6985. if(temp>=0){
  6986. current_intvl->AturChanPerfUncorrBlk+=temp;
  6987. ATUR_CHAN_UNCORR_BLK+=temp;
  6988. mib_pread.ATUR_CHAN_UNCORR_BLK_FAST = RxMessage[4];
  6989. }
  6990. else{
  6991. current_intvl->AturChanPerfUncorrBlk+=0xffff - mib_pread.ATUR_CHAN_UNCORR_BLK_FAST + RxMessage[4];
  6992. ATUR_CHAN_UNCORR_BLK+=0xffff - mib_pread.ATUR_CHAN_UNCORR_BLK_FAST + RxMessage[4];
  6993. mib_pread.ATUR_CHAN_UNCORR_BLK_FAST = RxMessage[4];
  6994. }
  6995. }
  6996. }
  6997. //RFC-3440
  6998. #ifdef AMAZON_MEI_MIB_RFC3440
  6999. if(showtime!=1)
  7000. goto mib_poll_end;
  7001. ATUC_PERF_STAT_FASTR_FLAG_MAKECMV; //???
  7002. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  7003. #ifdef AMAZON_MEI_DEBUG_ON
  7004. printk("\n\nCMV fail, Group 0 Address 0 Index 0");
  7005. #endif
  7006. }
  7007. else{
  7008. temp = RxMessage[4] - mib_pread.ATUC_PERF_STAT_FASTR;
  7009. if(temp>=0){
  7010. current_intvl->AtucPerfStatFastR+=temp;
  7011. ATUC_PERF_STAT_FASTR+=temp;
  7012. mib_pread.ATUC_PERF_STAT_FASTR = RxMessage[4];
  7013. }
  7014. else{
  7015. current_intvl->AtucPerfStatFastR+=0xffff - mib_pread.ATUC_PERF_STAT_FASTR + RxMessage[4];
  7016. ATUC_PERF_STAT_FASTR+=0xffff - mib_pread.ATUC_PERF_STAT_FASTR + RxMessage[4];
  7017. mib_pread.ATUC_PERF_STAT_FASTR = RxMessage[4];
  7018. }
  7019. }
  7020. if(showtime!=1)
  7021. goto mib_poll_end;
  7022. ATUC_PERF_STAT_FAILED_FASTR_FLAG_MAKECMV; //???
  7023. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  7024. #ifdef AMAZON_MEI_DEBUG_ON
  7025. printk("\n\nCMV fail, Group 0 Address 0 Index 0");
  7026. #endif
  7027. }
  7028. else{
  7029. temp = RxMessage[4] - mib_pread.ATUC_PERF_STAT_FAILED_FASTR;
  7030. if(temp>=0){
  7031. current_intvl->AtucPerfStatFailedFastR+=temp;
  7032. ATUC_PERF_STAT_FAILED_FASTR+=temp;
  7033. mib_pread.ATUC_PERF_STAT_FAILED_FASTR = RxMessage[4];
  7034. }
  7035. else{
  7036. current_intvl->AtucPerfStatFailedFastR+=0xffff - mib_pread.ATUC_PERF_STAT_FAILED_FASTR + RxMessage[4];
  7037. ATUC_PERF_STAT_FAILED_FASTR+=0xffff - mib_pread.ATUC_PERF_STAT_FAILED_FASTR + RxMessage[4];
  7038. mib_pread.ATUC_PERF_STAT_FAILED_FASTR = RxMessage[4];
  7039. }
  7040. }
  7041. if(showtime!=1)
  7042. goto mib_poll_end;
  7043. ATUC_PERF_STAT_SESL_FLAG_MAKECMV;
  7044. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  7045. #ifdef AMAZON_MEI_DEBUG_ON
  7046. printk("\n\nCMV fail, Group 7 Address 8 Index 0");
  7047. #endif
  7048. }
  7049. else{
  7050. temp = RxMessage[4] - mib_pread.ATUC_PERF_STAT_SESL;
  7051. if(temp>=0){
  7052. current_intvl->AtucPerfStatSesL+=temp;
  7053. ATUC_PERF_STAT_SESL+=temp;
  7054. mib_pread.ATUC_PERF_STAT_SESL = RxMessage[4];
  7055. }
  7056. else{
  7057. current_intvl->AtucPerfStatSesL+=0xffff - mib_pread.ATUC_PERF_STAT_SESL + RxMessage[4];
  7058. ATUC_PERF_STAT_SESL+=0xffff - mib_pread.ATUC_PERF_STAT_SESL + RxMessage[4];
  7059. mib_pread.ATUC_PERF_STAT_SESL = RxMessage[4];
  7060. }
  7061. }
  7062. if(showtime!=1)
  7063. goto mib_poll_end;
  7064. ATUC_PERF_STAT_UASL_FLAG_MAKECMV;
  7065. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  7066. #ifdef AMAZON_MEI_DEBUG_ON
  7067. printk("\n\nCMV fail, Group 7 Address 10 Index 0");
  7068. #endif
  7069. }
  7070. else{
  7071. temp = RxMessage[4] - mib_pread.ATUC_PERF_STAT_UASL;
  7072. if(temp>=0){
  7073. current_intvl->AtucPerfStatUasL+=temp;
  7074. ATUC_PERF_STAT_UASL+=temp;
  7075. mib_pread.ATUC_PERF_STAT_UASL = RxMessage[4];
  7076. }
  7077. else{
  7078. current_intvl->AtucPerfStatUasL+=0xffff - mib_pread.ATUC_PERF_STAT_UASL + RxMessage[4];
  7079. ATUC_PERF_STAT_UASL+=0xffff - mib_pread.ATUC_PERF_STAT_UASL + RxMessage[4];
  7080. mib_pread.ATUC_PERF_STAT_UASL = RxMessage[4];
  7081. }
  7082. }
  7083. if(showtime!=1)
  7084. goto mib_poll_end;
  7085. ATUR_PERF_STAT_SESL_FLAG_MAKECMV;
  7086. if(meiCMV(TxMessage, YES_REPLY)!=MEI_SUCCESS){
  7087. #ifdef AMAZON_MEI_DEBUG_ON
  7088. printk("\n\nCMV fail, Group 7 Address 34 Index 0");
  7089. #endif
  7090. }
  7091. else{
  7092. temp = RxMessage[4] - mib_pread.ATUR_PERF_STAT_SESL;
  7093. if(temp>=0){
  7094. current_intvl->AtucPerfStatUasL+=temp;
  7095. ATUC_PERF_STAT_UASL+=temp;
  7096. mib_pread.ATUR_PERF_STAT_SESL = RxMessage[4];
  7097. }
  7098. else{
  7099. current_intvl->AtucPerfStatUasL+=0xffff - mib_pread.ATUR_PERF_STAT_SESL + RxMessage[4];
  7100. ATUC_PERF_STAT_UASL+=0xffff - mib_pread.ATUR_PERF_STAT_SESL + RxMessage[4];
  7101. mib_pread.ATUR_PERF_STAT_SESL = RxMessage[4];
  7102. }
  7103. }
  7104. #endif
  7105. mib_poll_end:
  7106. up(&mei_sema);
  7107. do_gettimeofday(&time_fini);
  7108. i = ((int)((time_fini.tv_sec-time_now.tv_sec)*1000)) + ((int)((time_fini.tv_usec-time_now.tv_usec)/1000)) ; //msec
  7109. }//showtime==1
  7110. }
  7111. }
  7112. int mib_poll_init(void)
  7113. {
  7114. printk("Starting mib_poll...\n");
  7115. kernel_thread(adsl_mib_poll, NULL, CLONE_FS | CLONE_FILES | CLONE_SIGNAL);
  7116. return 0;
  7117. }
  7118. #endif //IFX_SMALL_FOOTPRINT
  7119. //EXPORT_NO_SYMBOLS;
  7120. #ifdef ADSL_LED_SUPPORT
  7121. // adsl led -start
  7122. int led_status_on=0,led_need_to_flash=0;
  7123. int led_current_flashing=0;
  7124. unsigned long led_delay=0;
  7125. static int led_poll(void *unused)
  7126. {
  7127. stop_led_module=0; //begin polling ...
  7128. while(!stop_led_module){
  7129. if ((!led_status_on)&&(!led_need_to_flash)) interruptible_sleep_on_timeout (&wait_queue_led_polling,1000); //10 seconds timeout for waiting wakeup
  7130. // else printk("direct running task, no waiting");
  7131. run_task_queue(&tq_ifx_led);//joelin task
  7132. // printk("led and LOP polling...\n");
  7133. }
  7134. return 0;
  7135. }
  7136. static int led_poll_init(void)
  7137. {
  7138. // printk("Starting adsl led polling...\n");
  7139. //warning-led-start
  7140. // CLEAR_BIT((*((volatile u32 *)0xB0100B40)), 0x40); //Warning LED GPIO ON
  7141. //warning-led-end
  7142. kernel_thread(led_poll, NULL, CLONE_FS | CLONE_FILES | CLONE_SIGNAL);
  7143. return 0;
  7144. }
  7145. int adsl_led_flash(void)
  7146. {
  7147. int i;
  7148. if (!firmware_support_led) return 0; //joelin version check
  7149. if (led_status_on == 0 && led_need_to_flash == 0)
  7150. {
  7151. queue_task(&led_task, &tq_ifx_led);//joelin task
  7152. wake_up_interruptible(&wait_queue_led_polling); //wake up and clean led module
  7153. // printk("queue Task 1...\n"); //joelin test
  7154. }
  7155. led_need_to_flash=1;//asking to flash led
  7156. return 0;
  7157. }
  7158. int adsl_led_flash_task(void *ptr)
  7159. {
  7160. u16 one=1;
  7161. u16 zero=0;
  7162. u16 data=0x0600;
  7163. int kernel_use=1;
  7164. u16 CMVMSG[MSG_LENGTH];
  7165. //adsl-led-start for >v1.1.2.7.1.1
  7166. // printk("Task Running...\n"); //joelin test
  7167. if ((firmware_support_led==2)&&(led_support_check))
  7168. {
  7169. led_support_check=0;
  7170. data=0x0600;
  7171. makeCMV_local(H2D_CMV_WRITE, INFO, 91, 0, 1, &data,CMVMSG); //configure GPIO9 GPIO10 as outputs
  7172. mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, CMVMSG);
  7173. makeCMV_local(H2D_CMV_WRITE, INFO, 91, 2, 1, &data,CMVMSG); //enable writing to bit 9 and bit10
  7174. mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, CMVMSG);
  7175. data=0x0a01;
  7176. makeCMV_local(H2D_CMV_WRITE, INFO, 91, 4, 1, &data,CMVMSG); //use GPIO10 for TR68 .Enable and don't invert.
  7177. mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, CMVMSG);
  7178. #ifdef DATA_LED_ON_MODE
  7179. data=0x0903;//tecom //use GPIO9 for TR68 data led .turn on.
  7180. #else
  7181. data=0x0900;
  7182. #endif
  7183. makeCMV_local(H2D_CMV_WRITE, INFO, 91, 5, 1, &data,CMVMSG); //use GPIO9 for TR68 data led .turn off.
  7184. mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, CMVMSG);
  7185. }
  7186. if (!showtime) {led_need_to_flash=0; return 0;}
  7187. //adsl-led-end for >v1.1.2.7.1.1
  7188. if (led_status_on == 0 || led_need_to_flash == 1)
  7189. {
  7190. if (led_current_flashing==0)
  7191. {
  7192. if (firmware_support_led==1){//>1.1.2.3.1.1
  7193. makeCMV_local(H2D_CMV_WRITE, INFO, 91, 0, 1, &one,CMVMSG); //flash
  7194. mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, &CMVMSG);
  7195. }
  7196. else if (firmware_support_led==2){//>1.1.2.7.1.1
  7197. data=0x0901;//flash
  7198. makeCMV_local(H2D_CMV_WRITE, INFO, 91, 5, 1, &data,CMVMSG); //use GPIO9 for TR68 data led .flash.
  7199. mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, &CMVMSG);
  7200. }//(firmware_support_led==2)
  7201. led_current_flashing = 1;//turn on led
  7202. }
  7203. led_status_on=1;
  7204. do{//do nothing , waiting untill no data traffic
  7205. led_need_to_flash=0;
  7206. interruptible_sleep_on_timeout(&wait_queue_led, 25); //the time for LED Off , if no data traffic
  7207. }while(led_need_to_flash==1);
  7208. }else if (led_status_on == 1 && led_need_to_flash==0)
  7209. {
  7210. if (led_current_flashing==1)
  7211. {//turn off led
  7212. if (firmware_support_led==1){//>1.1.2.3.1.1
  7213. makeCMV_local(H2D_CMV_WRITE, INFO, 91, 0, 1, &zero,CMVMSG);//off
  7214. mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, &CMVMSG);
  7215. } //>1.1.2.3.1.1
  7216. else if (firmware_support_led==2){//>1.1.2.7.1.1
  7217. #ifdef DATA_LED_ON_MODE
  7218. data=0x0903;//tecom //use GPIO9 for TR68 data led .turn on.
  7219. #else
  7220. data=0x0900;//off
  7221. #endif
  7222. makeCMV_local(H2D_CMV_WRITE, INFO, 91, 5, 1, &data,CMVMSG); //use GPIO9 for TR68 data led .off.
  7223. mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_CMV_WINHOST, &CMVMSG);
  7224. }//(firmware_support_led==2)
  7225. led_status_on=0;
  7226. led_current_flashing = 0;
  7227. }
  7228. }
  7229. if (led_status_on == 1 || led_need_to_flash)
  7230. {//led flash job on going or led need to flash
  7231. queue_task(&led_task, &tq_ifx_led); //joelin task
  7232. // printk("queue Task 2...\n"); //joelin test
  7233. }
  7234. return 0;
  7235. }
  7236. //joelin adsl led-end
  7237. #else
  7238. int adsl_led_flash(void)
  7239. {
  7240. return 0;
  7241. }
  7242. #endif //ADSL_LED_SUPPORT
  7243. #ifdef IFX_DYING_GASP
  7244. static int lop_poll(void *unused)
  7245. {
  7246. while(1)
  7247. {
  7248. interruptible_sleep_on_timeout(&wait_queue_dying_gasp, 1);
  7249. #ifdef CONFIG_CPU_AMAZON_E //000003:fchang
  7250. if(showtime&&((*((volatile u32 *)0xB0100B14))&0x4)==0x0) {//000003:fchang
  7251. #else //000003:fchang
  7252. if(showtime&&((*((volatile u32 *)0xB0100B44))&0x8000)==0x0) {
  7253. #endif //CONFIG_CPU_AMAZON_E
  7254. mei_ioctl((struct inode *)0,NULL, AMAZON_MEI_WRITEDEBUG, &lop_debugwr);
  7255. printk("send dying gasp..\n");}
  7256. }
  7257. return 0;
  7258. }
  7259. static int lop_poll_init(void)
  7260. {
  7261. // printk("Starting LOP polling...\n");
  7262. kernel_thread(lop_poll, NULL, CLONE_FS | CLONE_FILES | CLONE_SIGNAL);
  7263. return 0;
  7264. }
  7265. #endif //IFX_DYING_GASP
  7266. //joelin 04/16/2005-satrt
  7267. static int unavailable_seconds_poll(void *unused)
  7268. {
  7269. while(1){
  7270. interruptible_sleep_on_timeout (&wait_queue_uas_poll,100); //1 second timeout for waiting wakeup
  7271. if (!showtime) unavailable_seconds++;
  7272. }
  7273. return 0;
  7274. }
  7275. static int unavailable_seconds_poll_init(void)
  7276. {
  7277. kernel_thread(unavailable_seconds_poll, NULL, CLONE_FS | CLONE_FILES | CLONE_SIGNAL);
  7278. return 0;
  7279. }
  7280. //joelin 04/16/2005-end
  7281. EXPORT_SYMBOL(meiDebugWrite);
  7282. EXPORT_SYMBOL(ifx_pop_eoc);
  7283. MODULE_LICENSE("GPL");
  7284. module_init(amazon_mei_init_module);
  7285. module_exit(amazon_mei_cleanup_module);