msm-dai-q6-v2.c 325 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786378737883789379037913792379337943795379637973798379938003801380238033804380538063807380838093810381138123813381438153816381738183819382038213822382338243825382638273828382938303831383238333834383538363837383838393840384138423843384438453846384738483849385038513852385338543855385638573858385938603861386238633864386538663867386838693870387138723873387438753876387738783879388038813882388338843885388638873888388938903891389238933894389538963897389838993900390139023903390439053906390739083909391039113912391339143915391639173918391939203921392239233924392539263927392839293930393139323933393439353936393739383939394039413942394339443945394639473948394939503951395239533954395539563957395839593960396139623963396439653966396739683969397039713972397339743975397639773978397939803981398239833984398539863987398839893990399139923993399439953996399739983999400040014002400340044005400640074008400940104011401240134014401540164017401840194020402140224023402440254026402740284029403040314032403340344035403640374038403940404041404240434044404540464047404840494050405140524053405440554056405740584059406040614062406340644065406640674068406940704071407240734074407540764077407840794080408140824083408440854086408740884089409040914092409340944095409640974098409941004101410241034104410541064107410841094110411141124113411441154116411741184119412041214122412341244125412641274128412941304131413241334134413541364137413841394140414141424143414441454146414741484149415041514152415341544155415641574158415941604161416241634164416541664167416841694170417141724173417441754176417741784179418041814182418341844185418641874188418941904191419241934194419541964197419841994200420142024203420442054206420742084209421042114212421342144215421642174218421942204221422242234224422542264227422842294230423142324233423442354236423742384239424042414242424342444245424642474248424942504251425242534254425542564257425842594260426142624263426442654266426742684269427042714272427342744275427642774278427942804281428242834284428542864287428842894290429142924293429442954296429742984299430043014302430343044305430643074308430943104311431243134314431543164317431843194320432143224323432443254326432743284329433043314332433343344335433643374338433943404341434243434344434543464347434843494350435143524353435443554356435743584359436043614362436343644365436643674368436943704371437243734374437543764377437843794380438143824383438443854386438743884389439043914392439343944395439643974398439944004401440244034404440544064407440844094410441144124413441444154416441744184419442044214422442344244425442644274428442944304431443244334434443544364437443844394440444144424443444444454446444744484449445044514452445344544455445644574458445944604461446244634464446544664467446844694470447144724473447444754476447744784479448044814482448344844485448644874488448944904491449244934494449544964497449844994500450145024503450445054506450745084509451045114512451345144515451645174518451945204521452245234524452545264527452845294530453145324533453445354536453745384539454045414542454345444545454645474548454945504551455245534554455545564557455845594560456145624563456445654566456745684569457045714572457345744575457645774578457945804581458245834584458545864587458845894590459145924593459445954596459745984599460046014602460346044605460646074608460946104611461246134614461546164617461846194620462146224623462446254626462746284629463046314632463346344635463646374638463946404641464246434644464546464647464846494650465146524653465446554656465746584659466046614662466346644665466646674668466946704671467246734674467546764677467846794680468146824683468446854686468746884689469046914692469346944695469646974698469947004701470247034704470547064707470847094710471147124713471447154716471747184719472047214722472347244725472647274728472947304731473247334734473547364737473847394740474147424743474447454746474747484749475047514752475347544755475647574758475947604761476247634764476547664767476847694770477147724773477447754776477747784779478047814782478347844785478647874788478947904791479247934794479547964797479847994800480148024803480448054806480748084809481048114812481348144815481648174818481948204821482248234824482548264827482848294830483148324833483448354836483748384839484048414842484348444845484648474848484948504851485248534854485548564857485848594860486148624863486448654866486748684869487048714872487348744875487648774878487948804881488248834884488548864887488848894890489148924893489448954896489748984899490049014902490349044905490649074908490949104911491249134914491549164917491849194920492149224923492449254926492749284929493049314932493349344935493649374938493949404941494249434944494549464947494849494950495149524953495449554956495749584959496049614962496349644965496649674968496949704971497249734974497549764977497849794980498149824983498449854986498749884989499049914992499349944995499649974998499950005001500250035004500550065007500850095010501150125013501450155016501750185019502050215022502350245025502650275028502950305031503250335034503550365037503850395040504150425043504450455046504750485049505050515052505350545055505650575058505950605061506250635064506550665067506850695070507150725073507450755076507750785079508050815082508350845085508650875088508950905091509250935094509550965097509850995100510151025103510451055106510751085109511051115112511351145115511651175118511951205121512251235124512551265127512851295130513151325133513451355136513751385139514051415142514351445145514651475148514951505151515251535154515551565157515851595160516151625163516451655166516751685169517051715172517351745175517651775178517951805181518251835184518551865187518851895190519151925193519451955196519751985199520052015202520352045205520652075208520952105211521252135214521552165217521852195220522152225223522452255226522752285229523052315232523352345235523652375238523952405241524252435244524552465247524852495250525152525253525452555256525752585259526052615262526352645265526652675268526952705271527252735274527552765277527852795280528152825283528452855286528752885289529052915292529352945295529652975298529953005301530253035304530553065307530853095310531153125313531453155316531753185319532053215322532353245325532653275328532953305331533253335334533553365337533853395340534153425343534453455346534753485349535053515352535353545355535653575358535953605361536253635364536553665367536853695370537153725373537453755376537753785379538053815382538353845385538653875388538953905391539253935394539553965397539853995400540154025403540454055406540754085409541054115412541354145415541654175418541954205421542254235424542554265427542854295430543154325433543454355436543754385439544054415442544354445445544654475448544954505451545254535454545554565457545854595460546154625463546454655466546754685469547054715472547354745475547654775478547954805481548254835484548554865487548854895490549154925493549454955496549754985499550055015502550355045505550655075508550955105511551255135514551555165517551855195520552155225523552455255526552755285529553055315532553355345535553655375538553955405541554255435544554555465547554855495550555155525553555455555556555755585559556055615562556355645565556655675568556955705571557255735574557555765577557855795580558155825583558455855586558755885589559055915592559355945595559655975598559956005601560256035604560556065607560856095610561156125613561456155616561756185619562056215622562356245625562656275628562956305631563256335634563556365637563856395640564156425643564456455646564756485649565056515652565356545655565656575658565956605661566256635664566556665667566856695670567156725673567456755676567756785679568056815682568356845685568656875688568956905691569256935694569556965697569856995700570157025703570457055706570757085709571057115712571357145715571657175718571957205721572257235724572557265727572857295730573157325733573457355736573757385739574057415742574357445745574657475748574957505751575257535754575557565757575857595760576157625763576457655766576757685769577057715772577357745775577657775778577957805781578257835784578557865787578857895790579157925793579457955796579757985799580058015802580358045805580658075808580958105811581258135814581558165817581858195820582158225823582458255826582758285829583058315832583358345835583658375838583958405841584258435844584558465847584858495850585158525853585458555856585758585859586058615862586358645865586658675868586958705871587258735874587558765877587858795880588158825883588458855886588758885889589058915892589358945895589658975898589959005901590259035904590559065907590859095910591159125913591459155916591759185919592059215922592359245925592659275928592959305931593259335934593559365937593859395940594159425943594459455946594759485949595059515952595359545955595659575958595959605961596259635964596559665967596859695970597159725973597459755976597759785979598059815982598359845985598659875988598959905991599259935994599559965997599859996000600160026003600460056006600760086009601060116012601360146015601660176018601960206021602260236024602560266027602860296030603160326033603460356036603760386039604060416042604360446045604660476048604960506051605260536054605560566057605860596060606160626063606460656066606760686069607060716072607360746075607660776078607960806081608260836084608560866087608860896090609160926093609460956096609760986099610061016102610361046105610661076108610961106111611261136114611561166117611861196120612161226123612461256126612761286129613061316132613361346135613661376138613961406141614261436144614561466147614861496150615161526153615461556156615761586159616061616162616361646165616661676168616961706171617261736174617561766177617861796180618161826183618461856186618761886189619061916192619361946195619661976198619962006201620262036204620562066207620862096210621162126213621462156216621762186219622062216222622362246225622662276228622962306231623262336234623562366237623862396240624162426243624462456246624762486249625062516252625362546255625662576258625962606261626262636264626562666267626862696270627162726273627462756276627762786279628062816282628362846285628662876288628962906291629262936294629562966297629862996300630163026303630463056306630763086309631063116312631363146315631663176318631963206321632263236324632563266327632863296330633163326333633463356336633763386339634063416342634363446345634663476348634963506351635263536354635563566357635863596360636163626363636463656366636763686369637063716372637363746375637663776378637963806381638263836384638563866387638863896390639163926393639463956396639763986399640064016402640364046405640664076408640964106411641264136414641564166417641864196420642164226423642464256426642764286429643064316432643364346435643664376438643964406441644264436444644564466447644864496450645164526453645464556456645764586459646064616462646364646465646664676468646964706471647264736474647564766477647864796480648164826483648464856486648764886489649064916492649364946495649664976498649965006501650265036504650565066507650865096510651165126513651465156516651765186519652065216522652365246525652665276528652965306531653265336534653565366537653865396540654165426543654465456546654765486549655065516552655365546555655665576558655965606561656265636564656565666567656865696570657165726573657465756576657765786579658065816582658365846585658665876588658965906591659265936594659565966597659865996600660166026603660466056606660766086609661066116612661366146615661666176618661966206621662266236624662566266627662866296630663166326633663466356636663766386639664066416642664366446645664666476648664966506651665266536654665566566657665866596660666166626663666466656666666766686669667066716672667366746675667666776678667966806681668266836684668566866687668866896690669166926693669466956696669766986699670067016702670367046705670667076708670967106711671267136714671567166717671867196720672167226723672467256726672767286729673067316732673367346735673667376738673967406741674267436744674567466747674867496750675167526753675467556756675767586759676067616762676367646765676667676768676967706771677267736774677567766777677867796780678167826783678467856786678767886789679067916792679367946795679667976798679968006801680268036804680568066807680868096810681168126813681468156816681768186819682068216822682368246825682668276828682968306831683268336834683568366837683868396840684168426843684468456846684768486849685068516852685368546855685668576858685968606861686268636864686568666867686868696870687168726873687468756876687768786879688068816882688368846885688668876888688968906891689268936894689568966897689868996900690169026903690469056906690769086909691069116912691369146915691669176918691969206921692269236924692569266927692869296930693169326933693469356936693769386939694069416942694369446945694669476948694969506951695269536954695569566957695869596960696169626963696469656966696769686969697069716972697369746975697669776978697969806981698269836984698569866987698869896990699169926993699469956996699769986999700070017002700370047005700670077008700970107011701270137014701570167017701870197020702170227023702470257026702770287029703070317032703370347035703670377038703970407041704270437044704570467047704870497050705170527053705470557056705770587059706070617062706370647065706670677068706970707071707270737074707570767077707870797080708170827083708470857086708770887089709070917092709370947095709670977098709971007101710271037104710571067107710871097110711171127113711471157116711771187119712071217122712371247125712671277128712971307131713271337134713571367137713871397140714171427143714471457146714771487149715071517152715371547155715671577158715971607161716271637164716571667167716871697170717171727173717471757176717771787179718071817182718371847185718671877188718971907191719271937194719571967197719871997200720172027203720472057206720772087209721072117212721372147215721672177218721972207221722272237224722572267227722872297230723172327233723472357236723772387239724072417242724372447245724672477248724972507251725272537254725572567257725872597260726172627263726472657266726772687269727072717272727372747275727672777278727972807281728272837284728572867287728872897290729172927293729472957296729772987299730073017302730373047305730673077308730973107311731273137314731573167317731873197320732173227323732473257326732773287329733073317332733373347335733673377338733973407341734273437344734573467347734873497350735173527353735473557356735773587359736073617362736373647365736673677368736973707371737273737374737573767377737873797380738173827383738473857386738773887389739073917392739373947395739673977398739974007401740274037404740574067407740874097410741174127413741474157416741774187419742074217422742374247425742674277428742974307431743274337434743574367437743874397440744174427443744474457446744774487449745074517452745374547455745674577458745974607461746274637464746574667467746874697470747174727473747474757476747774787479748074817482748374847485748674877488748974907491749274937494749574967497749874997500750175027503750475057506750775087509751075117512751375147515751675177518751975207521752275237524752575267527752875297530753175327533753475357536753775387539754075417542754375447545754675477548754975507551755275537554755575567557755875597560756175627563756475657566756775687569757075717572757375747575757675777578757975807581758275837584758575867587758875897590759175927593759475957596759775987599760076017602760376047605760676077608760976107611761276137614761576167617761876197620762176227623762476257626762776287629763076317632763376347635763676377638763976407641764276437644764576467647764876497650765176527653765476557656765776587659766076617662766376647665766676677668766976707671767276737674767576767677767876797680768176827683768476857686768776887689769076917692769376947695769676977698769977007701770277037704770577067707770877097710771177127713771477157716771777187719772077217722772377247725772677277728772977307731773277337734773577367737773877397740774177427743774477457746774777487749775077517752775377547755775677577758775977607761776277637764776577667767776877697770777177727773777477757776777777787779778077817782778377847785778677877788778977907791779277937794779577967797779877997800780178027803780478057806780778087809781078117812781378147815781678177818781978207821782278237824782578267827782878297830783178327833783478357836783778387839784078417842784378447845784678477848784978507851785278537854785578567857785878597860786178627863786478657866786778687869787078717872787378747875787678777878787978807881788278837884788578867887788878897890789178927893789478957896789778987899790079017902790379047905790679077908790979107911791279137914791579167917791879197920792179227923792479257926792779287929793079317932793379347935793679377938793979407941794279437944794579467947794879497950795179527953795479557956795779587959796079617962796379647965796679677968796979707971797279737974797579767977797879797980798179827983798479857986798779887989799079917992799379947995799679977998799980008001800280038004800580068007800880098010801180128013801480158016801780188019802080218022802380248025802680278028802980308031803280338034803580368037803880398040804180428043804480458046804780488049805080518052805380548055805680578058805980608061806280638064806580668067806880698070807180728073807480758076807780788079808080818082808380848085808680878088808980908091809280938094809580968097809880998100810181028103810481058106810781088109811081118112811381148115811681178118811981208121812281238124812581268127812881298130813181328133813481358136813781388139814081418142814381448145814681478148814981508151815281538154815581568157815881598160816181628163816481658166816781688169817081718172817381748175817681778178817981808181818281838184818581868187818881898190819181928193819481958196819781988199820082018202820382048205820682078208820982108211821282138214821582168217821882198220822182228223822482258226822782288229823082318232823382348235823682378238823982408241824282438244824582468247824882498250825182528253825482558256825782588259826082618262826382648265826682678268826982708271827282738274827582768277827882798280828182828283828482858286828782888289829082918292829382948295829682978298829983008301830283038304830583068307830883098310831183128313831483158316831783188319832083218322832383248325832683278328832983308331833283338334833583368337833883398340834183428343834483458346834783488349835083518352835383548355835683578358835983608361836283638364836583668367836883698370837183728373837483758376837783788379838083818382838383848385838683878388838983908391839283938394839583968397839883998400840184028403840484058406840784088409841084118412841384148415841684178418841984208421842284238424842584268427842884298430843184328433843484358436843784388439844084418442844384448445844684478448844984508451845284538454845584568457845884598460846184628463846484658466846784688469847084718472847384748475847684778478847984808481848284838484848584868487848884898490849184928493849484958496849784988499850085018502850385048505850685078508850985108511851285138514851585168517851885198520852185228523852485258526852785288529853085318532853385348535853685378538853985408541854285438544854585468547854885498550855185528553855485558556855785588559856085618562856385648565856685678568856985708571857285738574857585768577857885798580858185828583858485858586858785888589859085918592859385948595859685978598859986008601860286038604860586068607860886098610861186128613861486158616861786188619862086218622862386248625862686278628862986308631863286338634863586368637863886398640864186428643864486458646864786488649865086518652865386548655865686578658865986608661866286638664866586668667866886698670867186728673867486758676867786788679868086818682868386848685868686878688868986908691869286938694869586968697869886998700870187028703870487058706870787088709871087118712871387148715871687178718871987208721872287238724872587268727872887298730873187328733873487358736873787388739874087418742874387448745874687478748874987508751875287538754875587568757875887598760876187628763876487658766876787688769877087718772877387748775877687778778877987808781878287838784878587868787878887898790879187928793879487958796879787988799880088018802880388048805880688078808880988108811881288138814881588168817881888198820882188228823882488258826882788288829883088318832883388348835883688378838883988408841884288438844884588468847884888498850885188528853885488558856885788588859886088618862886388648865886688678868886988708871887288738874887588768877887888798880888188828883888488858886888788888889889088918892889388948895889688978898889989008901890289038904890589068907890889098910891189128913891489158916891789188919892089218922892389248925892689278928892989308931893289338934893589368937893889398940894189428943894489458946894789488949895089518952895389548955895689578958895989608961896289638964896589668967896889698970897189728973897489758976897789788979898089818982898389848985898689878988898989908991899289938994899589968997899889999000900190029003900490059006900790089009901090119012901390149015901690179018901990209021902290239024902590269027902890299030903190329033903490359036903790389039904090419042904390449045904690479048904990509051905290539054905590569057905890599060906190629063906490659066906790689069907090719072907390749075907690779078907990809081908290839084908590869087908890899090909190929093909490959096909790989099910091019102910391049105910691079108910991109111911291139114911591169117911891199120912191229123912491259126912791289129913091319132913391349135913691379138913991409141914291439144914591469147914891499150915191529153915491559156915791589159916091619162916391649165916691679168916991709171917291739174917591769177917891799180918191829183918491859186918791889189919091919192919391949195919691979198919992009201920292039204920592069207920892099210921192129213921492159216921792189219922092219222922392249225922692279228922992309231923292339234923592369237923892399240924192429243924492459246924792489249925092519252925392549255925692579258925992609261926292639264926592669267926892699270927192729273927492759276927792789279928092819282928392849285928692879288928992909291929292939294929592969297929892999300930193029303930493059306930793089309931093119312931393149315931693179318931993209321932293239324932593269327932893299330933193329333933493359336933793389339934093419342934393449345934693479348934993509351935293539354935593569357935893599360936193629363936493659366936793689369937093719372937393749375937693779378937993809381938293839384938593869387938893899390939193929393939493959396939793989399940094019402940394049405940694079408940994109411941294139414941594169417941894199420942194229423942494259426942794289429943094319432943394349435943694379438943994409441944294439444944594469447944894499450945194529453945494559456945794589459946094619462946394649465946694679468946994709471947294739474947594769477947894799480948194829483948494859486948794889489949094919492949394949495949694979498949995009501950295039504950595069507950895099510951195129513951495159516951795189519952095219522952395249525952695279528952995309531953295339534953595369537953895399540954195429543954495459546954795489549955095519552955395549555955695579558955995609561956295639564956595669567956895699570957195729573957495759576957795789579958095819582958395849585958695879588958995909591959295939594959595969597959895999600960196029603960496059606960796089609961096119612961396149615961696179618961996209621962296239624962596269627962896299630963196329633963496359636963796389639964096419642964396449645964696479648964996509651965296539654965596569657965896599660966196629663966496659666966796689669967096719672967396749675967696779678967996809681968296839684968596869687968896899690969196929693969496959696969796989699970097019702970397049705970697079708970997109711971297139714971597169717971897199720972197229723972497259726972797289729973097319732973397349735973697379738973997409741974297439744974597469747974897499750975197529753975497559756975797589759976097619762976397649765976697679768976997709771977297739774977597769777977897799780978197829783978497859786978797889789979097919792979397949795979697979798979998009801980298039804980598069807980898099810981198129813981498159816981798189819982098219822982398249825982698279828982998309831983298339834983598369837983898399840984198429843984498459846984798489849985098519852985398549855985698579858985998609861986298639864986598669867986898699870987198729873987498759876987798789879988098819882988398849885988698879888988998909891989298939894989598969897989898999900990199029903990499059906990799089909991099119912991399149915991699179918991999209921992299239924992599269927992899299930993199329933993499359936993799389939994099419942994399449945994699479948994999509951995299539954995599569957995899599960996199629963996499659966996799689969997099719972997399749975997699779978997999809981998299839984998599869987998899899990999199929993999499959996999799989999100001000110002100031000410005100061000710008100091001010011100121001310014100151001610017100181001910020100211002210023100241002510026100271002810029100301003110032100331003410035100361003710038100391004010041100421004310044100451004610047100481004910050100511005210053100541005510056100571005810059100601006110062100631006410065100661006710068100691007010071100721007310074100751007610077100781007910080100811008210083100841008510086100871008810089100901009110092100931009410095100961009710098100991010010101101021010310104101051010610107101081010910110101111011210113101141011510116101171011810119101201012110122101231012410125101261012710128101291013010131101321013310134101351013610137101381013910140101411014210143101441014510146101471014810149101501015110152101531015410155101561015710158101591016010161101621016310164101651016610167101681016910170101711017210173101741017510176101771017810179101801018110182101831018410185101861018710188101891019010191101921019310194101951019610197101981019910200102011020210203102041020510206102071020810209102101021110212102131021410215102161021710218102191022010221102221022310224102251022610227102281022910230102311023210233102341023510236102371023810239102401024110242102431024410245102461024710248102491025010251102521025310254102551025610257102581025910260102611026210263102641026510266102671026810269102701027110272102731027410275102761027710278102791028010281102821028310284102851028610287102881028910290102911029210293102941029510296102971029810299103001030110302103031030410305103061030710308103091031010311103121031310314103151031610317103181031910320103211032210323103241032510326103271032810329103301033110332103331033410335103361033710338103391034010341103421034310344103451034610347103481034910350103511035210353103541035510356103571035810359103601036110362103631036410365103661036710368103691037010371103721037310374103751037610377103781037910380103811038210383103841038510386103871038810389103901039110392103931039410395103961039710398103991040010401104021040310404104051040610407104081040910410104111041210413104141041510416104171041810419104201042110422104231042410425104261042710428104291043010431104321043310434104351043610437104381043910440104411044210443104441044510446104471044810449104501045110452104531045410455104561045710458104591046010461104621046310464104651046610467104681046910470104711047210473104741047510476104771047810479104801048110482104831048410485104861048710488104891049010491104921049310494104951049610497104981049910500105011050210503105041050510506105071050810509105101051110512105131051410515105161051710518105191052010521105221052310524105251052610527105281052910530105311053210533105341053510536105371053810539105401054110542105431054410545105461054710548105491055010551105521055310554105551055610557105581055910560105611056210563105641056510566105671056810569105701057110572105731057410575105761057710578105791058010581105821058310584105851058610587105881058910590105911059210593105941059510596105971059810599106001060110602106031060410605106061060710608106091061010611106121061310614106151061610617106181061910620106211062210623106241062510626106271062810629106301063110632106331063410635106361063710638106391064010641106421064310644106451064610647106481064910650106511065210653106541065510656106571065810659106601066110662106631066410665106661066710668106691067010671106721067310674106751067610677106781067910680106811068210683106841068510686106871068810689106901069110692106931069410695106961069710698106991070010701107021070310704107051070610707107081070910710107111071210713107141071510716107171071810719107201072110722107231072410725107261072710728107291073010731107321073310734107351073610737107381073910740107411074210743107441074510746107471074810749107501075110752107531075410755107561075710758107591076010761107621076310764107651076610767107681076910770107711077210773107741077510776107771077810779107801078110782107831078410785107861078710788107891079010791107921079310794107951079610797107981079910800108011080210803108041080510806108071080810809108101081110812108131081410815108161081710818108191082010821108221082310824108251082610827108281082910830108311083210833108341083510836108371083810839108401084110842108431084410845108461084710848108491085010851108521085310854108551085610857108581085910860108611086210863108641086510866108671086810869108701087110872108731087410875108761087710878108791088010881108821088310884108851088610887108881088910890108911089210893108941089510896108971089810899109001090110902109031090410905109061090710908109091091010911109121091310914109151091610917109181091910920109211092210923109241092510926109271092810929109301093110932109331093410935109361093710938109391094010941109421094310944109451094610947109481094910950109511095210953109541095510956109571095810959109601096110962109631096410965109661096710968109691097010971109721097310974109751097610977109781097910980109811098210983109841098510986109871098810989109901099110992109931099410995109961099710998109991100011001110021100311004110051100611007110081100911010110111101211013110141101511016110171101811019110201102111022110231102411025110261102711028110291103011031110321103311034110351103611037110381103911040110411104211043110441104511046110471104811049110501105111052110531105411055110561105711058110591106011061110621106311064110651106611067110681106911070110711107211073110741107511076110771107811079110801108111082110831108411085110861108711088110891109011091110921109311094110951109611097110981109911100111011110211103111041110511106111071110811109111101111111112111131111411115111161111711118111191112011121111221112311124111251112611127111281112911130111311113211133111341113511136111371113811139111401114111142111431114411145111461114711148111491115011151111521115311154111551115611157111581115911160111611116211163111641116511166111671116811169111701117111172111731117411175111761117711178111791118011181111821118311184111851118611187111881118911190111911119211193111941119511196111971119811199112001120111202112031120411205112061120711208112091121011211112121121311214112151121611217112181121911220112211122211223
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /* Copyright (c) 2012-2018, The Linux Foundation. All rights reserved.
  3. */
  4. #include <linux/init.h>
  5. #include <linux/module.h>
  6. #include <linux/device.h>
  7. #include <linux/platform_device.h>
  8. #include <linux/bitops.h>
  9. #include <linux/slab.h>
  10. #include <linux/clk.h>
  11. #include <linux/of_device.h>
  12. #include <sound/core.h>
  13. #include <sound/pcm.h>
  14. #include <sound/soc.h>
  15. #include <sound/pcm_params.h>
  16. #include <dsp/apr_audio-v2.h>
  17. #include <dsp/q6afe-v2.h>
  18. #include <dsp/q6core.h>
  19. #include "msm-dai-q6-v2.h"
  20. #include <asoc/core.h>
  21. #define MSM_DAI_PRI_AUXPCM_DT_DEV_ID 1
  22. #define MSM_DAI_SEC_AUXPCM_DT_DEV_ID 2
  23. #define MSM_DAI_TERT_AUXPCM_DT_DEV_ID 3
  24. #define MSM_DAI_QUAT_AUXPCM_DT_DEV_ID 4
  25. #define MSM_DAI_QUIN_AUXPCM_DT_DEV_ID 5
  26. #define MSM_DAI_TWS_CHANNEL_MODE_ONE 1
  27. #define MSM_DAI_TWS_CHANNEL_MODE_TWO 2
  28. #define spdif_clock_value(rate) (2*rate*32*2)
  29. #define CHANNEL_STATUS_SIZE 24
  30. #define CHANNEL_STATUS_MASK_INIT 0x0
  31. #define CHANNEL_STATUS_MASK 0x4
  32. #define AFE_API_VERSION_CLOCK_SET 1
  33. #define MSM_DAI_SYSFS_ENTRY_MAX_LEN 64
  34. #define DAI_FORMATS_S16_S24_S32_LE (SNDRV_PCM_FMTBIT_S16_LE | \
  35. SNDRV_PCM_FMTBIT_S24_LE | \
  36. SNDRV_PCM_FMTBIT_S32_LE)
  37. static int msm_mi2s_get_port_id(u32 mi2s_id, int stream, u16 *port_id);
  38. enum {
  39. ENC_FMT_NONE,
  40. DEC_FMT_NONE = ENC_FMT_NONE,
  41. ENC_FMT_SBC = ASM_MEDIA_FMT_SBC,
  42. DEC_FMT_SBC = ASM_MEDIA_FMT_SBC,
  43. ENC_FMT_AAC_V2 = ASM_MEDIA_FMT_AAC_V2,
  44. DEC_FMT_AAC_V2 = ASM_MEDIA_FMT_AAC_V2,
  45. ENC_FMT_APTX = ASM_MEDIA_FMT_APTX,
  46. ENC_FMT_APTX_HD = ASM_MEDIA_FMT_APTX_HD,
  47. ENC_FMT_CELT = ASM_MEDIA_FMT_CELT,
  48. ENC_FMT_LDAC = ASM_MEDIA_FMT_LDAC,
  49. ENC_FMT_APTX_ADAPTIVE = ASM_MEDIA_FMT_APTX_ADAPTIVE,
  50. DEC_FMT_APTX_ADAPTIVE = ASM_MEDIA_FMT_APTX_ADAPTIVE,
  51. DEC_FMT_MP3 = ASM_MEDIA_FMT_MP3,
  52. };
  53. enum {
  54. SPKR_1,
  55. SPKR_2,
  56. };
  57. static const struct afe_clk_set lpass_clk_set_default = {
  58. AFE_API_VERSION_CLOCK_SET,
  59. Q6AFE_LPASS_CLK_ID_PRI_PCM_IBIT,
  60. Q6AFE_LPASS_OSR_CLK_2_P048_MHZ,
  61. Q6AFE_LPASS_CLK_ATTRIBUTE_COUPLE_NO,
  62. Q6AFE_LPASS_CLK_ROOT_DEFAULT,
  63. 0,
  64. };
  65. static const struct afe_clk_cfg lpass_clk_cfg_default = {
  66. AFE_API_VERSION_I2S_CONFIG,
  67. Q6AFE_LPASS_OSR_CLK_2_P048_MHZ,
  68. 0,
  69. Q6AFE_LPASS_CLK_SRC_INTERNAL,
  70. Q6AFE_LPASS_CLK_ROOT_DEFAULT,
  71. Q6AFE_LPASS_MODE_CLK1_VALID,
  72. 0,
  73. };
  74. enum {
  75. STATUS_PORT_STARTED, /* track if AFE port has started */
  76. /* track AFE Tx port status for bi-directional transfers */
  77. STATUS_TX_PORT,
  78. /* track AFE Rx port status for bi-directional transfers */
  79. STATUS_RX_PORT,
  80. STATUS_MAX
  81. };
  82. enum {
  83. RATE_8KHZ,
  84. RATE_16KHZ,
  85. RATE_MAX_NUM_OF_AUX_PCM_RATES,
  86. };
  87. enum {
  88. IDX_PRIMARY_TDM_RX_0,
  89. IDX_PRIMARY_TDM_RX_1,
  90. IDX_PRIMARY_TDM_RX_2,
  91. IDX_PRIMARY_TDM_RX_3,
  92. IDX_PRIMARY_TDM_RX_4,
  93. IDX_PRIMARY_TDM_RX_5,
  94. IDX_PRIMARY_TDM_RX_6,
  95. IDX_PRIMARY_TDM_RX_7,
  96. IDX_PRIMARY_TDM_TX_0,
  97. IDX_PRIMARY_TDM_TX_1,
  98. IDX_PRIMARY_TDM_TX_2,
  99. IDX_PRIMARY_TDM_TX_3,
  100. IDX_PRIMARY_TDM_TX_4,
  101. IDX_PRIMARY_TDM_TX_5,
  102. IDX_PRIMARY_TDM_TX_6,
  103. IDX_PRIMARY_TDM_TX_7,
  104. IDX_SECONDARY_TDM_RX_0,
  105. IDX_SECONDARY_TDM_RX_1,
  106. IDX_SECONDARY_TDM_RX_2,
  107. IDX_SECONDARY_TDM_RX_3,
  108. IDX_SECONDARY_TDM_RX_4,
  109. IDX_SECONDARY_TDM_RX_5,
  110. IDX_SECONDARY_TDM_RX_6,
  111. IDX_SECONDARY_TDM_RX_7,
  112. IDX_SECONDARY_TDM_TX_0,
  113. IDX_SECONDARY_TDM_TX_1,
  114. IDX_SECONDARY_TDM_TX_2,
  115. IDX_SECONDARY_TDM_TX_3,
  116. IDX_SECONDARY_TDM_TX_4,
  117. IDX_SECONDARY_TDM_TX_5,
  118. IDX_SECONDARY_TDM_TX_6,
  119. IDX_SECONDARY_TDM_TX_7,
  120. IDX_TERTIARY_TDM_RX_0,
  121. IDX_TERTIARY_TDM_RX_1,
  122. IDX_TERTIARY_TDM_RX_2,
  123. IDX_TERTIARY_TDM_RX_3,
  124. IDX_TERTIARY_TDM_RX_4,
  125. IDX_TERTIARY_TDM_RX_5,
  126. IDX_TERTIARY_TDM_RX_6,
  127. IDX_TERTIARY_TDM_RX_7,
  128. IDX_TERTIARY_TDM_TX_0,
  129. IDX_TERTIARY_TDM_TX_1,
  130. IDX_TERTIARY_TDM_TX_2,
  131. IDX_TERTIARY_TDM_TX_3,
  132. IDX_TERTIARY_TDM_TX_4,
  133. IDX_TERTIARY_TDM_TX_5,
  134. IDX_TERTIARY_TDM_TX_6,
  135. IDX_TERTIARY_TDM_TX_7,
  136. IDX_QUATERNARY_TDM_RX_0,
  137. IDX_QUATERNARY_TDM_RX_1,
  138. IDX_QUATERNARY_TDM_RX_2,
  139. IDX_QUATERNARY_TDM_RX_3,
  140. IDX_QUATERNARY_TDM_RX_4,
  141. IDX_QUATERNARY_TDM_RX_5,
  142. IDX_QUATERNARY_TDM_RX_6,
  143. IDX_QUATERNARY_TDM_RX_7,
  144. IDX_QUATERNARY_TDM_TX_0,
  145. IDX_QUATERNARY_TDM_TX_1,
  146. IDX_QUATERNARY_TDM_TX_2,
  147. IDX_QUATERNARY_TDM_TX_3,
  148. IDX_QUATERNARY_TDM_TX_4,
  149. IDX_QUATERNARY_TDM_TX_5,
  150. IDX_QUATERNARY_TDM_TX_6,
  151. IDX_QUATERNARY_TDM_TX_7,
  152. IDX_QUINARY_TDM_RX_0,
  153. IDX_QUINARY_TDM_RX_1,
  154. IDX_QUINARY_TDM_RX_2,
  155. IDX_QUINARY_TDM_RX_3,
  156. IDX_QUINARY_TDM_RX_4,
  157. IDX_QUINARY_TDM_RX_5,
  158. IDX_QUINARY_TDM_RX_6,
  159. IDX_QUINARY_TDM_RX_7,
  160. IDX_QUINARY_TDM_TX_0,
  161. IDX_QUINARY_TDM_TX_1,
  162. IDX_QUINARY_TDM_TX_2,
  163. IDX_QUINARY_TDM_TX_3,
  164. IDX_QUINARY_TDM_TX_4,
  165. IDX_QUINARY_TDM_TX_5,
  166. IDX_QUINARY_TDM_TX_6,
  167. IDX_QUINARY_TDM_TX_7,
  168. IDX_TDM_MAX,
  169. };
  170. enum {
  171. IDX_GROUP_PRIMARY_TDM_RX,
  172. IDX_GROUP_PRIMARY_TDM_TX,
  173. IDX_GROUP_SECONDARY_TDM_RX,
  174. IDX_GROUP_SECONDARY_TDM_TX,
  175. IDX_GROUP_TERTIARY_TDM_RX,
  176. IDX_GROUP_TERTIARY_TDM_TX,
  177. IDX_GROUP_QUATERNARY_TDM_RX,
  178. IDX_GROUP_QUATERNARY_TDM_TX,
  179. IDX_GROUP_QUINARY_TDM_RX,
  180. IDX_GROUP_QUINARY_TDM_TX,
  181. IDX_GROUP_TDM_MAX,
  182. };
  183. struct msm_dai_q6_dai_data {
  184. DECLARE_BITMAP(status_mask, STATUS_MAX);
  185. DECLARE_BITMAP(hwfree_status, STATUS_MAX);
  186. u32 rate;
  187. u32 channels;
  188. u32 bitwidth;
  189. u32 cal_mode;
  190. u32 afe_rx_in_channels;
  191. u16 afe_rx_in_bitformat;
  192. u32 afe_tx_out_channels;
  193. u16 afe_tx_out_bitformat;
  194. struct afe_enc_config enc_config;
  195. struct afe_dec_config dec_config;
  196. union afe_port_config port_config;
  197. u16 vi_feed_mono;
  198. };
  199. struct msm_dai_q6_spdif_dai_data {
  200. DECLARE_BITMAP(status_mask, STATUS_MAX);
  201. u32 rate;
  202. u32 channels;
  203. u32 bitwidth;
  204. u16 port_id;
  205. struct afe_spdif_port_config spdif_port;
  206. struct afe_event_fmt_update fmt_event;
  207. struct kobject *kobj;
  208. };
  209. struct msm_dai_q6_spdif_event_msg {
  210. struct afe_port_mod_evt_rsp_hdr evt_hdr;
  211. struct afe_event_fmt_update fmt_event;
  212. };
  213. struct msm_dai_q6_mi2s_dai_config {
  214. u16 pdata_mi2s_lines;
  215. struct msm_dai_q6_dai_data mi2s_dai_data;
  216. };
  217. struct msm_dai_q6_mi2s_dai_data {
  218. u32 is_island_dai;
  219. struct msm_dai_q6_mi2s_dai_config tx_dai;
  220. struct msm_dai_q6_mi2s_dai_config rx_dai;
  221. };
  222. struct msm_dai_q6_cdc_dma_dai_data {
  223. DECLARE_BITMAP(status_mask, STATUS_MAX);
  224. DECLARE_BITMAP(hwfree_status, STATUS_MAX);
  225. u32 rate;
  226. u32 channels;
  227. u32 bitwidth;
  228. u32 is_island_dai;
  229. union afe_port_config port_config;
  230. };
  231. struct msm_dai_q6_auxpcm_dai_data {
  232. /* BITMAP to track Rx and Tx port usage count */
  233. DECLARE_BITMAP(auxpcm_port_status, STATUS_MAX);
  234. struct mutex rlock; /* auxpcm dev resource lock */
  235. u16 rx_pid; /* AUXPCM RX AFE port ID */
  236. u16 tx_pid; /* AUXPCM TX AFE port ID */
  237. u16 afe_clk_ver;
  238. u32 is_island_dai;
  239. struct afe_clk_cfg clk_cfg; /* hold LPASS clock configuration */
  240. struct afe_clk_set clk_set; /* hold LPASS clock configuration */
  241. struct msm_dai_q6_dai_data bdai_data; /* incoporate base DAI data */
  242. };
  243. struct msm_dai_q6_tdm_dai_data {
  244. DECLARE_BITMAP(status_mask, STATUS_MAX);
  245. u32 rate;
  246. u32 channels;
  247. u32 bitwidth;
  248. u32 num_group_ports;
  249. u32 is_island_dai;
  250. struct afe_clk_set clk_set; /* hold LPASS clock config. */
  251. union afe_port_group_config group_cfg; /* hold tdm group config */
  252. struct afe_tdm_port_config port_cfg; /* hold tdm config */
  253. };
  254. /* MI2S format field for AFE_PORT_CMD_I2S_CONFIG command
  255. * 0: linear PCM
  256. * 1: non-linear PCM
  257. * 2: PCM data in IEC 60968 container
  258. * 3: compressed data in IEC 60958 container
  259. */
  260. static const char *const mi2s_format[] = {
  261. "LPCM",
  262. "Compr",
  263. "LPCM-60958",
  264. "Compr-60958"
  265. };
  266. static const char *const mi2s_vi_feed_mono[] = {
  267. "Left",
  268. "Right",
  269. };
  270. static const struct soc_enum mi2s_config_enum[] = {
  271. SOC_ENUM_SINGLE_EXT(4, mi2s_format),
  272. SOC_ENUM_SINGLE_EXT(2, mi2s_vi_feed_mono),
  273. };
  274. static const char *const cdc_dma_format[] = {
  275. "UNPACKED",
  276. "PACKED_16B",
  277. };
  278. static const struct soc_enum cdc_dma_config_enum[] = {
  279. SOC_ENUM_SINGLE_EXT(2, cdc_dma_format),
  280. };
  281. static const char *const sb_format[] = {
  282. "UNPACKED",
  283. "PACKED_16B",
  284. "DSD_DOP",
  285. };
  286. static const struct soc_enum sb_config_enum[] = {
  287. SOC_ENUM_SINGLE_EXT(3, sb_format),
  288. };
  289. static const char *const tdm_data_format[] = {
  290. "LPCM",
  291. "Compr",
  292. "Gen Compr"
  293. };
  294. static const char *const tdm_header_type[] = {
  295. "Invalid",
  296. "Default",
  297. "Entertainment",
  298. };
  299. static const struct soc_enum tdm_config_enum[] = {
  300. SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(tdm_data_format), tdm_data_format),
  301. SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(tdm_header_type), tdm_header_type),
  302. };
  303. static DEFINE_MUTEX(tdm_mutex);
  304. static atomic_t tdm_group_ref[IDX_GROUP_TDM_MAX];
  305. /* cache of group cfg per parent node */
  306. static struct afe_param_id_group_device_tdm_cfg tdm_group_cfg = {
  307. AFE_API_VERSION_GROUP_DEVICE_TDM_CONFIG,
  308. AFE_GROUP_DEVICE_ID_QUATERNARY_TDM_RX,
  309. 0,
  310. {AFE_PORT_ID_QUATERNARY_TDM_RX,
  311. AFE_PORT_ID_QUATERNARY_TDM_RX_1,
  312. AFE_PORT_ID_QUATERNARY_TDM_RX_2,
  313. AFE_PORT_ID_QUATERNARY_TDM_RX_3,
  314. AFE_PORT_ID_QUATERNARY_TDM_RX_4,
  315. AFE_PORT_ID_QUATERNARY_TDM_RX_5,
  316. AFE_PORT_ID_QUATERNARY_TDM_RX_6,
  317. AFE_PORT_ID_QUATERNARY_TDM_RX_7},
  318. 8,
  319. 48000,
  320. 32,
  321. 8,
  322. 32,
  323. 0xFF,
  324. };
  325. static u32 num_tdm_group_ports;
  326. static struct afe_clk_set tdm_clk_set = {
  327. AFE_API_VERSION_CLOCK_SET,
  328. Q6AFE_LPASS_CLK_ID_QUAD_TDM_EBIT,
  329. Q6AFE_LPASS_IBIT_CLK_DISABLE,
  330. Q6AFE_LPASS_CLK_ATTRIBUTE_INVERT_COUPLE_NO,
  331. Q6AFE_LPASS_CLK_ROOT_DEFAULT,
  332. 0,
  333. };
  334. static int msm_dai_q6_get_tdm_clk_ref(u16 id)
  335. {
  336. switch (id) {
  337. case IDX_GROUP_PRIMARY_TDM_RX:
  338. case IDX_GROUP_PRIMARY_TDM_TX:
  339. return atomic_read(&tdm_group_ref[IDX_GROUP_PRIMARY_TDM_RX]) +
  340. atomic_read(&tdm_group_ref[IDX_GROUP_PRIMARY_TDM_TX]);
  341. case IDX_GROUP_SECONDARY_TDM_RX:
  342. case IDX_GROUP_SECONDARY_TDM_TX:
  343. return atomic_read(&tdm_group_ref[IDX_GROUP_SECONDARY_TDM_RX]) +
  344. atomic_read(&tdm_group_ref[IDX_GROUP_SECONDARY_TDM_TX]);
  345. case IDX_GROUP_TERTIARY_TDM_RX:
  346. case IDX_GROUP_TERTIARY_TDM_TX:
  347. return atomic_read(&tdm_group_ref[IDX_GROUP_TERTIARY_TDM_RX]) +
  348. atomic_read(&tdm_group_ref[IDX_GROUP_TERTIARY_TDM_TX]);
  349. case IDX_GROUP_QUATERNARY_TDM_RX:
  350. case IDX_GROUP_QUATERNARY_TDM_TX:
  351. return atomic_read(&tdm_group_ref[IDX_GROUP_QUATERNARY_TDM_RX]) +
  352. atomic_read(&tdm_group_ref[IDX_GROUP_QUATERNARY_TDM_TX]);
  353. case IDX_GROUP_QUINARY_TDM_RX:
  354. case IDX_GROUP_QUINARY_TDM_TX:
  355. return atomic_read(&tdm_group_ref[IDX_GROUP_QUINARY_TDM_RX]) +
  356. atomic_read(&tdm_group_ref[IDX_GROUP_QUINARY_TDM_TX]);
  357. default: return -EINVAL;
  358. }
  359. }
  360. int msm_dai_q6_get_group_idx(u16 id)
  361. {
  362. switch (id) {
  363. case AFE_GROUP_DEVICE_ID_PRIMARY_TDM_RX:
  364. case AFE_PORT_ID_PRIMARY_TDM_RX:
  365. case AFE_PORT_ID_PRIMARY_TDM_RX_1:
  366. case AFE_PORT_ID_PRIMARY_TDM_RX_2:
  367. case AFE_PORT_ID_PRIMARY_TDM_RX_3:
  368. case AFE_PORT_ID_PRIMARY_TDM_RX_4:
  369. case AFE_PORT_ID_PRIMARY_TDM_RX_5:
  370. case AFE_PORT_ID_PRIMARY_TDM_RX_6:
  371. case AFE_PORT_ID_PRIMARY_TDM_RX_7:
  372. return IDX_GROUP_PRIMARY_TDM_RX;
  373. case AFE_GROUP_DEVICE_ID_PRIMARY_TDM_TX:
  374. case AFE_PORT_ID_PRIMARY_TDM_TX:
  375. case AFE_PORT_ID_PRIMARY_TDM_TX_1:
  376. case AFE_PORT_ID_PRIMARY_TDM_TX_2:
  377. case AFE_PORT_ID_PRIMARY_TDM_TX_3:
  378. case AFE_PORT_ID_PRIMARY_TDM_TX_4:
  379. case AFE_PORT_ID_PRIMARY_TDM_TX_5:
  380. case AFE_PORT_ID_PRIMARY_TDM_TX_6:
  381. case AFE_PORT_ID_PRIMARY_TDM_TX_7:
  382. return IDX_GROUP_PRIMARY_TDM_TX;
  383. case AFE_GROUP_DEVICE_ID_SECONDARY_TDM_RX:
  384. case AFE_PORT_ID_SECONDARY_TDM_RX:
  385. case AFE_PORT_ID_SECONDARY_TDM_RX_1:
  386. case AFE_PORT_ID_SECONDARY_TDM_RX_2:
  387. case AFE_PORT_ID_SECONDARY_TDM_RX_3:
  388. case AFE_PORT_ID_SECONDARY_TDM_RX_4:
  389. case AFE_PORT_ID_SECONDARY_TDM_RX_5:
  390. case AFE_PORT_ID_SECONDARY_TDM_RX_6:
  391. case AFE_PORT_ID_SECONDARY_TDM_RX_7:
  392. return IDX_GROUP_SECONDARY_TDM_RX;
  393. case AFE_GROUP_DEVICE_ID_SECONDARY_TDM_TX:
  394. case AFE_PORT_ID_SECONDARY_TDM_TX:
  395. case AFE_PORT_ID_SECONDARY_TDM_TX_1:
  396. case AFE_PORT_ID_SECONDARY_TDM_TX_2:
  397. case AFE_PORT_ID_SECONDARY_TDM_TX_3:
  398. case AFE_PORT_ID_SECONDARY_TDM_TX_4:
  399. case AFE_PORT_ID_SECONDARY_TDM_TX_5:
  400. case AFE_PORT_ID_SECONDARY_TDM_TX_6:
  401. case AFE_PORT_ID_SECONDARY_TDM_TX_7:
  402. return IDX_GROUP_SECONDARY_TDM_TX;
  403. case AFE_GROUP_DEVICE_ID_TERTIARY_TDM_RX:
  404. case AFE_PORT_ID_TERTIARY_TDM_RX:
  405. case AFE_PORT_ID_TERTIARY_TDM_RX_1:
  406. case AFE_PORT_ID_TERTIARY_TDM_RX_2:
  407. case AFE_PORT_ID_TERTIARY_TDM_RX_3:
  408. case AFE_PORT_ID_TERTIARY_TDM_RX_4:
  409. case AFE_PORT_ID_TERTIARY_TDM_RX_5:
  410. case AFE_PORT_ID_TERTIARY_TDM_RX_6:
  411. case AFE_PORT_ID_TERTIARY_TDM_RX_7:
  412. return IDX_GROUP_TERTIARY_TDM_RX;
  413. case AFE_GROUP_DEVICE_ID_TERTIARY_TDM_TX:
  414. case AFE_PORT_ID_TERTIARY_TDM_TX:
  415. case AFE_PORT_ID_TERTIARY_TDM_TX_1:
  416. case AFE_PORT_ID_TERTIARY_TDM_TX_2:
  417. case AFE_PORT_ID_TERTIARY_TDM_TX_3:
  418. case AFE_PORT_ID_TERTIARY_TDM_TX_4:
  419. case AFE_PORT_ID_TERTIARY_TDM_TX_5:
  420. case AFE_PORT_ID_TERTIARY_TDM_TX_6:
  421. case AFE_PORT_ID_TERTIARY_TDM_TX_7:
  422. return IDX_GROUP_TERTIARY_TDM_TX;
  423. case AFE_GROUP_DEVICE_ID_QUATERNARY_TDM_RX:
  424. case AFE_PORT_ID_QUATERNARY_TDM_RX:
  425. case AFE_PORT_ID_QUATERNARY_TDM_RX_1:
  426. case AFE_PORT_ID_QUATERNARY_TDM_RX_2:
  427. case AFE_PORT_ID_QUATERNARY_TDM_RX_3:
  428. case AFE_PORT_ID_QUATERNARY_TDM_RX_4:
  429. case AFE_PORT_ID_QUATERNARY_TDM_RX_5:
  430. case AFE_PORT_ID_QUATERNARY_TDM_RX_6:
  431. case AFE_PORT_ID_QUATERNARY_TDM_RX_7:
  432. return IDX_GROUP_QUATERNARY_TDM_RX;
  433. case AFE_GROUP_DEVICE_ID_QUATERNARY_TDM_TX:
  434. case AFE_PORT_ID_QUATERNARY_TDM_TX:
  435. case AFE_PORT_ID_QUATERNARY_TDM_TX_1:
  436. case AFE_PORT_ID_QUATERNARY_TDM_TX_2:
  437. case AFE_PORT_ID_QUATERNARY_TDM_TX_3:
  438. case AFE_PORT_ID_QUATERNARY_TDM_TX_4:
  439. case AFE_PORT_ID_QUATERNARY_TDM_TX_5:
  440. case AFE_PORT_ID_QUATERNARY_TDM_TX_6:
  441. case AFE_PORT_ID_QUATERNARY_TDM_TX_7:
  442. return IDX_GROUP_QUATERNARY_TDM_TX;
  443. case AFE_GROUP_DEVICE_ID_QUINARY_TDM_RX:
  444. case AFE_PORT_ID_QUINARY_TDM_RX:
  445. case AFE_PORT_ID_QUINARY_TDM_RX_1:
  446. case AFE_PORT_ID_QUINARY_TDM_RX_2:
  447. case AFE_PORT_ID_QUINARY_TDM_RX_3:
  448. case AFE_PORT_ID_QUINARY_TDM_RX_4:
  449. case AFE_PORT_ID_QUINARY_TDM_RX_5:
  450. case AFE_PORT_ID_QUINARY_TDM_RX_6:
  451. case AFE_PORT_ID_QUINARY_TDM_RX_7:
  452. return IDX_GROUP_QUINARY_TDM_RX;
  453. case AFE_GROUP_DEVICE_ID_QUINARY_TDM_TX:
  454. case AFE_PORT_ID_QUINARY_TDM_TX:
  455. case AFE_PORT_ID_QUINARY_TDM_TX_1:
  456. case AFE_PORT_ID_QUINARY_TDM_TX_2:
  457. case AFE_PORT_ID_QUINARY_TDM_TX_3:
  458. case AFE_PORT_ID_QUINARY_TDM_TX_4:
  459. case AFE_PORT_ID_QUINARY_TDM_TX_5:
  460. case AFE_PORT_ID_QUINARY_TDM_TX_6:
  461. case AFE_PORT_ID_QUINARY_TDM_TX_7:
  462. return IDX_GROUP_QUINARY_TDM_TX;
  463. default: return -EINVAL;
  464. }
  465. }
  466. int msm_dai_q6_get_port_idx(u16 id)
  467. {
  468. switch (id) {
  469. case AFE_PORT_ID_PRIMARY_TDM_RX:
  470. return IDX_PRIMARY_TDM_RX_0;
  471. case AFE_PORT_ID_PRIMARY_TDM_TX:
  472. return IDX_PRIMARY_TDM_TX_0;
  473. case AFE_PORT_ID_PRIMARY_TDM_RX_1:
  474. return IDX_PRIMARY_TDM_RX_1;
  475. case AFE_PORT_ID_PRIMARY_TDM_TX_1:
  476. return IDX_PRIMARY_TDM_TX_1;
  477. case AFE_PORT_ID_PRIMARY_TDM_RX_2:
  478. return IDX_PRIMARY_TDM_RX_2;
  479. case AFE_PORT_ID_PRIMARY_TDM_TX_2:
  480. return IDX_PRIMARY_TDM_TX_2;
  481. case AFE_PORT_ID_PRIMARY_TDM_RX_3:
  482. return IDX_PRIMARY_TDM_RX_3;
  483. case AFE_PORT_ID_PRIMARY_TDM_TX_3:
  484. return IDX_PRIMARY_TDM_TX_3;
  485. case AFE_PORT_ID_PRIMARY_TDM_RX_4:
  486. return IDX_PRIMARY_TDM_RX_4;
  487. case AFE_PORT_ID_PRIMARY_TDM_TX_4:
  488. return IDX_PRIMARY_TDM_TX_4;
  489. case AFE_PORT_ID_PRIMARY_TDM_RX_5:
  490. return IDX_PRIMARY_TDM_RX_5;
  491. case AFE_PORT_ID_PRIMARY_TDM_TX_5:
  492. return IDX_PRIMARY_TDM_TX_5;
  493. case AFE_PORT_ID_PRIMARY_TDM_RX_6:
  494. return IDX_PRIMARY_TDM_RX_6;
  495. case AFE_PORT_ID_PRIMARY_TDM_TX_6:
  496. return IDX_PRIMARY_TDM_TX_6;
  497. case AFE_PORT_ID_PRIMARY_TDM_RX_7:
  498. return IDX_PRIMARY_TDM_RX_7;
  499. case AFE_PORT_ID_PRIMARY_TDM_TX_7:
  500. return IDX_PRIMARY_TDM_TX_7;
  501. case AFE_PORT_ID_SECONDARY_TDM_RX:
  502. return IDX_SECONDARY_TDM_RX_0;
  503. case AFE_PORT_ID_SECONDARY_TDM_TX:
  504. return IDX_SECONDARY_TDM_TX_0;
  505. case AFE_PORT_ID_SECONDARY_TDM_RX_1:
  506. return IDX_SECONDARY_TDM_RX_1;
  507. case AFE_PORT_ID_SECONDARY_TDM_TX_1:
  508. return IDX_SECONDARY_TDM_TX_1;
  509. case AFE_PORT_ID_SECONDARY_TDM_RX_2:
  510. return IDX_SECONDARY_TDM_RX_2;
  511. case AFE_PORT_ID_SECONDARY_TDM_TX_2:
  512. return IDX_SECONDARY_TDM_TX_2;
  513. case AFE_PORT_ID_SECONDARY_TDM_RX_3:
  514. return IDX_SECONDARY_TDM_RX_3;
  515. case AFE_PORT_ID_SECONDARY_TDM_TX_3:
  516. return IDX_SECONDARY_TDM_TX_3;
  517. case AFE_PORT_ID_SECONDARY_TDM_RX_4:
  518. return IDX_SECONDARY_TDM_RX_4;
  519. case AFE_PORT_ID_SECONDARY_TDM_TX_4:
  520. return IDX_SECONDARY_TDM_TX_4;
  521. case AFE_PORT_ID_SECONDARY_TDM_RX_5:
  522. return IDX_SECONDARY_TDM_RX_5;
  523. case AFE_PORT_ID_SECONDARY_TDM_TX_5:
  524. return IDX_SECONDARY_TDM_TX_5;
  525. case AFE_PORT_ID_SECONDARY_TDM_RX_6:
  526. return IDX_SECONDARY_TDM_RX_6;
  527. case AFE_PORT_ID_SECONDARY_TDM_TX_6:
  528. return IDX_SECONDARY_TDM_TX_6;
  529. case AFE_PORT_ID_SECONDARY_TDM_RX_7:
  530. return IDX_SECONDARY_TDM_RX_7;
  531. case AFE_PORT_ID_SECONDARY_TDM_TX_7:
  532. return IDX_SECONDARY_TDM_TX_7;
  533. case AFE_PORT_ID_TERTIARY_TDM_RX:
  534. return IDX_TERTIARY_TDM_RX_0;
  535. case AFE_PORT_ID_TERTIARY_TDM_TX:
  536. return IDX_TERTIARY_TDM_TX_0;
  537. case AFE_PORT_ID_TERTIARY_TDM_RX_1:
  538. return IDX_TERTIARY_TDM_RX_1;
  539. case AFE_PORT_ID_TERTIARY_TDM_TX_1:
  540. return IDX_TERTIARY_TDM_TX_1;
  541. case AFE_PORT_ID_TERTIARY_TDM_RX_2:
  542. return IDX_TERTIARY_TDM_RX_2;
  543. case AFE_PORT_ID_TERTIARY_TDM_TX_2:
  544. return IDX_TERTIARY_TDM_TX_2;
  545. case AFE_PORT_ID_TERTIARY_TDM_RX_3:
  546. return IDX_TERTIARY_TDM_RX_3;
  547. case AFE_PORT_ID_TERTIARY_TDM_TX_3:
  548. return IDX_TERTIARY_TDM_TX_3;
  549. case AFE_PORT_ID_TERTIARY_TDM_RX_4:
  550. return IDX_TERTIARY_TDM_RX_4;
  551. case AFE_PORT_ID_TERTIARY_TDM_TX_4:
  552. return IDX_TERTIARY_TDM_TX_4;
  553. case AFE_PORT_ID_TERTIARY_TDM_RX_5:
  554. return IDX_TERTIARY_TDM_RX_5;
  555. case AFE_PORT_ID_TERTIARY_TDM_TX_5:
  556. return IDX_TERTIARY_TDM_TX_5;
  557. case AFE_PORT_ID_TERTIARY_TDM_RX_6:
  558. return IDX_TERTIARY_TDM_RX_6;
  559. case AFE_PORT_ID_TERTIARY_TDM_TX_6:
  560. return IDX_TERTIARY_TDM_TX_6;
  561. case AFE_PORT_ID_TERTIARY_TDM_RX_7:
  562. return IDX_TERTIARY_TDM_RX_7;
  563. case AFE_PORT_ID_TERTIARY_TDM_TX_7:
  564. return IDX_TERTIARY_TDM_TX_7;
  565. case AFE_PORT_ID_QUATERNARY_TDM_RX:
  566. return IDX_QUATERNARY_TDM_RX_0;
  567. case AFE_PORT_ID_QUATERNARY_TDM_TX:
  568. return IDX_QUATERNARY_TDM_TX_0;
  569. case AFE_PORT_ID_QUATERNARY_TDM_RX_1:
  570. return IDX_QUATERNARY_TDM_RX_1;
  571. case AFE_PORT_ID_QUATERNARY_TDM_TX_1:
  572. return IDX_QUATERNARY_TDM_TX_1;
  573. case AFE_PORT_ID_QUATERNARY_TDM_RX_2:
  574. return IDX_QUATERNARY_TDM_RX_2;
  575. case AFE_PORT_ID_QUATERNARY_TDM_TX_2:
  576. return IDX_QUATERNARY_TDM_TX_2;
  577. case AFE_PORT_ID_QUATERNARY_TDM_RX_3:
  578. return IDX_QUATERNARY_TDM_RX_3;
  579. case AFE_PORT_ID_QUATERNARY_TDM_TX_3:
  580. return IDX_QUATERNARY_TDM_TX_3;
  581. case AFE_PORT_ID_QUATERNARY_TDM_RX_4:
  582. return IDX_QUATERNARY_TDM_RX_4;
  583. case AFE_PORT_ID_QUATERNARY_TDM_TX_4:
  584. return IDX_QUATERNARY_TDM_TX_4;
  585. case AFE_PORT_ID_QUATERNARY_TDM_RX_5:
  586. return IDX_QUATERNARY_TDM_RX_5;
  587. case AFE_PORT_ID_QUATERNARY_TDM_TX_5:
  588. return IDX_QUATERNARY_TDM_TX_5;
  589. case AFE_PORT_ID_QUATERNARY_TDM_RX_6:
  590. return IDX_QUATERNARY_TDM_RX_6;
  591. case AFE_PORT_ID_QUATERNARY_TDM_TX_6:
  592. return IDX_QUATERNARY_TDM_TX_6;
  593. case AFE_PORT_ID_QUATERNARY_TDM_RX_7:
  594. return IDX_QUATERNARY_TDM_RX_7;
  595. case AFE_PORT_ID_QUATERNARY_TDM_TX_7:
  596. return IDX_QUATERNARY_TDM_TX_7;
  597. case AFE_PORT_ID_QUINARY_TDM_RX:
  598. return IDX_QUINARY_TDM_RX_0;
  599. case AFE_PORT_ID_QUINARY_TDM_TX:
  600. return IDX_QUINARY_TDM_TX_0;
  601. case AFE_PORT_ID_QUINARY_TDM_RX_1:
  602. return IDX_QUINARY_TDM_RX_1;
  603. case AFE_PORT_ID_QUINARY_TDM_TX_1:
  604. return IDX_QUINARY_TDM_TX_1;
  605. case AFE_PORT_ID_QUINARY_TDM_RX_2:
  606. return IDX_QUINARY_TDM_RX_2;
  607. case AFE_PORT_ID_QUINARY_TDM_TX_2:
  608. return IDX_QUINARY_TDM_TX_2;
  609. case AFE_PORT_ID_QUINARY_TDM_RX_3:
  610. return IDX_QUINARY_TDM_RX_3;
  611. case AFE_PORT_ID_QUINARY_TDM_TX_3:
  612. return IDX_QUINARY_TDM_TX_3;
  613. case AFE_PORT_ID_QUINARY_TDM_RX_4:
  614. return IDX_QUINARY_TDM_RX_4;
  615. case AFE_PORT_ID_QUINARY_TDM_TX_4:
  616. return IDX_QUINARY_TDM_TX_4;
  617. case AFE_PORT_ID_QUINARY_TDM_RX_5:
  618. return IDX_QUINARY_TDM_RX_5;
  619. case AFE_PORT_ID_QUINARY_TDM_TX_5:
  620. return IDX_QUINARY_TDM_TX_5;
  621. case AFE_PORT_ID_QUINARY_TDM_RX_6:
  622. return IDX_QUINARY_TDM_RX_6;
  623. case AFE_PORT_ID_QUINARY_TDM_TX_6:
  624. return IDX_QUINARY_TDM_TX_6;
  625. case AFE_PORT_ID_QUINARY_TDM_RX_7:
  626. return IDX_QUINARY_TDM_RX_7;
  627. case AFE_PORT_ID_QUINARY_TDM_TX_7:
  628. return IDX_QUINARY_TDM_TX_7;
  629. default: return -EINVAL;
  630. }
  631. }
  632. static u16 msm_dai_q6_max_num_slot(int frame_rate)
  633. {
  634. /* Max num of slots is bits per frame divided
  635. * by bits per sample which is 16
  636. */
  637. switch (frame_rate) {
  638. case AFE_PORT_PCM_BITS_PER_FRAME_8:
  639. return 0;
  640. case AFE_PORT_PCM_BITS_PER_FRAME_16:
  641. return 1;
  642. case AFE_PORT_PCM_BITS_PER_FRAME_32:
  643. return 2;
  644. case AFE_PORT_PCM_BITS_PER_FRAME_64:
  645. return 4;
  646. case AFE_PORT_PCM_BITS_PER_FRAME_128:
  647. return 8;
  648. case AFE_PORT_PCM_BITS_PER_FRAME_256:
  649. return 16;
  650. default:
  651. pr_err("%s Invalid bits per frame %d\n",
  652. __func__, frame_rate);
  653. return 0;
  654. }
  655. }
  656. static int msm_dai_q6_dai_add_route(struct snd_soc_dai *dai)
  657. {
  658. struct snd_soc_dapm_route intercon;
  659. struct snd_soc_dapm_context *dapm;
  660. if (!dai) {
  661. pr_err("%s: Invalid params dai\n", __func__);
  662. return -EINVAL;
  663. }
  664. if (!dai->driver) {
  665. pr_err("%s: Invalid params dai driver\n", __func__);
  666. return -EINVAL;
  667. }
  668. dapm = snd_soc_component_get_dapm(dai->component);
  669. memset(&intercon, 0, sizeof(intercon));
  670. if (dai->driver->playback.stream_name &&
  671. dai->driver->playback.aif_name) {
  672. dev_dbg(dai->dev, "%s: add route for widget %s",
  673. __func__, dai->driver->playback.stream_name);
  674. intercon.source = dai->driver->playback.aif_name;
  675. intercon.sink = dai->driver->playback.stream_name;
  676. dev_dbg(dai->dev, "%s: src %s sink %s\n",
  677. __func__, intercon.source, intercon.sink);
  678. snd_soc_dapm_add_routes(dapm, &intercon, 1);
  679. }
  680. if (dai->driver->capture.stream_name &&
  681. dai->driver->capture.aif_name) {
  682. dev_dbg(dai->dev, "%s: add route for widget %s",
  683. __func__, dai->driver->capture.stream_name);
  684. intercon.sink = dai->driver->capture.aif_name;
  685. intercon.source = dai->driver->capture.stream_name;
  686. dev_dbg(dai->dev, "%s: src %s sink %s\n",
  687. __func__, intercon.source, intercon.sink);
  688. snd_soc_dapm_add_routes(dapm, &intercon, 1);
  689. }
  690. return 0;
  691. }
  692. static int msm_dai_q6_auxpcm_hw_params(
  693. struct snd_pcm_substream *substream,
  694. struct snd_pcm_hw_params *params,
  695. struct snd_soc_dai *dai)
  696. {
  697. struct msm_dai_q6_auxpcm_dai_data *aux_dai_data =
  698. dev_get_drvdata(dai->dev);
  699. struct msm_dai_q6_dai_data *dai_data = &aux_dai_data->bdai_data;
  700. struct msm_dai_auxpcm_pdata *auxpcm_pdata =
  701. (struct msm_dai_auxpcm_pdata *) dai->dev->platform_data;
  702. int rc = 0, slot_mapping_copy_len = 0;
  703. if (params_channels(params) != 1 || (params_rate(params) != 8000 &&
  704. params_rate(params) != 16000)) {
  705. dev_err(dai->dev, "%s: invalid param chan %d rate %d\n",
  706. __func__, params_channels(params), params_rate(params));
  707. return -EINVAL;
  708. }
  709. mutex_lock(&aux_dai_data->rlock);
  710. if (test_bit(STATUS_TX_PORT, aux_dai_data->auxpcm_port_status) ||
  711. test_bit(STATUS_RX_PORT, aux_dai_data->auxpcm_port_status)) {
  712. /* AUXPCM DAI in use */
  713. if (dai_data->rate != params_rate(params)) {
  714. dev_err(dai->dev, "%s: rate mismatch of running DAI\n",
  715. __func__);
  716. rc = -EINVAL;
  717. }
  718. mutex_unlock(&aux_dai_data->rlock);
  719. return rc;
  720. }
  721. dai_data->channels = params_channels(params);
  722. dai_data->rate = params_rate(params);
  723. if (dai_data->rate == 8000) {
  724. dai_data->port_config.pcm.pcm_cfg_minor_version =
  725. AFE_API_VERSION_PCM_CONFIG;
  726. dai_data->port_config.pcm.aux_mode = auxpcm_pdata->mode_8k.mode;
  727. dai_data->port_config.pcm.sync_src = auxpcm_pdata->mode_8k.sync;
  728. dai_data->port_config.pcm.frame_setting =
  729. auxpcm_pdata->mode_8k.frame;
  730. dai_data->port_config.pcm.quantype =
  731. auxpcm_pdata->mode_8k.quant;
  732. dai_data->port_config.pcm.ctrl_data_out_enable =
  733. auxpcm_pdata->mode_8k.data;
  734. dai_data->port_config.pcm.sample_rate = dai_data->rate;
  735. dai_data->port_config.pcm.num_channels = dai_data->channels;
  736. dai_data->port_config.pcm.bit_width = 16;
  737. if (ARRAY_SIZE(dai_data->port_config.pcm.slot_number_mapping) <=
  738. auxpcm_pdata->mode_8k.num_slots)
  739. slot_mapping_copy_len =
  740. ARRAY_SIZE(
  741. dai_data->port_config.pcm.slot_number_mapping)
  742. * sizeof(uint16_t);
  743. else
  744. slot_mapping_copy_len = auxpcm_pdata->mode_8k.num_slots
  745. * sizeof(uint16_t);
  746. if (auxpcm_pdata->mode_8k.slot_mapping) {
  747. memcpy(dai_data->port_config.pcm.slot_number_mapping,
  748. auxpcm_pdata->mode_8k.slot_mapping,
  749. slot_mapping_copy_len);
  750. } else {
  751. dev_err(dai->dev, "%s 8khz slot mapping is NULL\n",
  752. __func__);
  753. mutex_unlock(&aux_dai_data->rlock);
  754. return -EINVAL;
  755. }
  756. } else {
  757. dai_data->port_config.pcm.pcm_cfg_minor_version =
  758. AFE_API_VERSION_PCM_CONFIG;
  759. dai_data->port_config.pcm.aux_mode =
  760. auxpcm_pdata->mode_16k.mode;
  761. dai_data->port_config.pcm.sync_src =
  762. auxpcm_pdata->mode_16k.sync;
  763. dai_data->port_config.pcm.frame_setting =
  764. auxpcm_pdata->mode_16k.frame;
  765. dai_data->port_config.pcm.quantype =
  766. auxpcm_pdata->mode_16k.quant;
  767. dai_data->port_config.pcm.ctrl_data_out_enable =
  768. auxpcm_pdata->mode_16k.data;
  769. dai_data->port_config.pcm.sample_rate = dai_data->rate;
  770. dai_data->port_config.pcm.num_channels = dai_data->channels;
  771. dai_data->port_config.pcm.bit_width = 16;
  772. if (ARRAY_SIZE(dai_data->port_config.pcm.slot_number_mapping) <=
  773. auxpcm_pdata->mode_16k.num_slots)
  774. slot_mapping_copy_len =
  775. ARRAY_SIZE(
  776. dai_data->port_config.pcm.slot_number_mapping)
  777. * sizeof(uint16_t);
  778. else
  779. slot_mapping_copy_len = auxpcm_pdata->mode_16k.num_slots
  780. * sizeof(uint16_t);
  781. if (auxpcm_pdata->mode_16k.slot_mapping) {
  782. memcpy(dai_data->port_config.pcm.slot_number_mapping,
  783. auxpcm_pdata->mode_16k.slot_mapping,
  784. slot_mapping_copy_len);
  785. } else {
  786. dev_err(dai->dev, "%s 16khz slot mapping is NULL\n",
  787. __func__);
  788. mutex_unlock(&aux_dai_data->rlock);
  789. return -EINVAL;
  790. }
  791. }
  792. dev_dbg(dai->dev, "%s: aux_mode 0x%x sync_src 0x%x frame_setting 0x%x\n",
  793. __func__, dai_data->port_config.pcm.aux_mode,
  794. dai_data->port_config.pcm.sync_src,
  795. dai_data->port_config.pcm.frame_setting);
  796. dev_dbg(dai->dev, "%s: qtype 0x%x dout 0x%x num_map[0] 0x%x\n"
  797. "num_map[1] 0x%x num_map[2] 0x%x num_map[3] 0x%x\n",
  798. __func__, dai_data->port_config.pcm.quantype,
  799. dai_data->port_config.pcm.ctrl_data_out_enable,
  800. dai_data->port_config.pcm.slot_number_mapping[0],
  801. dai_data->port_config.pcm.slot_number_mapping[1],
  802. dai_data->port_config.pcm.slot_number_mapping[2],
  803. dai_data->port_config.pcm.slot_number_mapping[3]);
  804. mutex_unlock(&aux_dai_data->rlock);
  805. return rc;
  806. }
  807. static int msm_dai_q6_auxpcm_set_clk(
  808. struct msm_dai_q6_auxpcm_dai_data *aux_dai_data,
  809. u16 port_id, bool enable)
  810. {
  811. int rc;
  812. pr_debug("%s: afe_clk_ver: %d, port_id: %d, enable: %d\n", __func__,
  813. aux_dai_data->afe_clk_ver, port_id, enable);
  814. if (aux_dai_data->afe_clk_ver == AFE_CLK_VERSION_V2) {
  815. aux_dai_data->clk_set.enable = enable;
  816. rc = afe_set_lpass_clock_v2(port_id,
  817. &aux_dai_data->clk_set);
  818. } else {
  819. if (!enable)
  820. aux_dai_data->clk_cfg.clk_val1 = 0;
  821. rc = afe_set_lpass_clock(port_id,
  822. &aux_dai_data->clk_cfg);
  823. }
  824. return rc;
  825. }
  826. static void msm_dai_q6_auxpcm_shutdown(struct snd_pcm_substream *substream,
  827. struct snd_soc_dai *dai)
  828. {
  829. int rc = 0;
  830. struct msm_dai_q6_auxpcm_dai_data *aux_dai_data =
  831. dev_get_drvdata(dai->dev);
  832. mutex_lock(&aux_dai_data->rlock);
  833. if (!(test_bit(STATUS_TX_PORT, aux_dai_data->auxpcm_port_status) ||
  834. test_bit(STATUS_RX_PORT, aux_dai_data->auxpcm_port_status))) {
  835. dev_dbg(dai->dev, "%s(): dai->id %d PCM ports already closed\n",
  836. __func__, dai->id);
  837. goto exit;
  838. }
  839. if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) {
  840. if (test_bit(STATUS_TX_PORT, aux_dai_data->auxpcm_port_status))
  841. clear_bit(STATUS_TX_PORT,
  842. aux_dai_data->auxpcm_port_status);
  843. else {
  844. dev_dbg(dai->dev, "%s: PCM_TX port already closed\n",
  845. __func__);
  846. goto exit;
  847. }
  848. } else if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
  849. if (test_bit(STATUS_RX_PORT, aux_dai_data->auxpcm_port_status))
  850. clear_bit(STATUS_RX_PORT,
  851. aux_dai_data->auxpcm_port_status);
  852. else {
  853. dev_dbg(dai->dev, "%s: PCM_RX port already closed\n",
  854. __func__);
  855. goto exit;
  856. }
  857. }
  858. if (test_bit(STATUS_TX_PORT, aux_dai_data->auxpcm_port_status) ||
  859. test_bit(STATUS_RX_PORT, aux_dai_data->auxpcm_port_status)) {
  860. dev_dbg(dai->dev, "%s: cannot shutdown PCM ports\n",
  861. __func__);
  862. goto exit;
  863. }
  864. dev_dbg(dai->dev, "%s: dai->id = %d closing PCM AFE ports\n",
  865. __func__, dai->id);
  866. rc = afe_close(aux_dai_data->rx_pid); /* can block */
  867. if (rc < 0)
  868. dev_err(dai->dev, "fail to close PCM_RX AFE port\n");
  869. rc = afe_close(aux_dai_data->tx_pid);
  870. if (rc < 0)
  871. dev_err(dai->dev, "fail to close AUX PCM TX port\n");
  872. msm_dai_q6_auxpcm_set_clk(aux_dai_data, aux_dai_data->rx_pid, false);
  873. msm_dai_q6_auxpcm_set_clk(aux_dai_data, aux_dai_data->tx_pid, false);
  874. exit:
  875. mutex_unlock(&aux_dai_data->rlock);
  876. }
  877. static int msm_dai_q6_auxpcm_prepare(struct snd_pcm_substream *substream,
  878. struct snd_soc_dai *dai)
  879. {
  880. struct msm_dai_q6_auxpcm_dai_data *aux_dai_data =
  881. dev_get_drvdata(dai->dev);
  882. struct msm_dai_q6_dai_data *dai_data = &aux_dai_data->bdai_data;
  883. struct msm_dai_auxpcm_pdata *auxpcm_pdata = NULL;
  884. int rc = 0;
  885. u32 pcm_clk_rate;
  886. auxpcm_pdata = dai->dev->platform_data;
  887. mutex_lock(&aux_dai_data->rlock);
  888. if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) {
  889. if (test_bit(STATUS_TX_PORT,
  890. aux_dai_data->auxpcm_port_status)) {
  891. dev_dbg(dai->dev, "%s: PCM_TX port already ON\n",
  892. __func__);
  893. goto exit;
  894. } else
  895. set_bit(STATUS_TX_PORT,
  896. aux_dai_data->auxpcm_port_status);
  897. } else if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
  898. if (test_bit(STATUS_RX_PORT,
  899. aux_dai_data->auxpcm_port_status)) {
  900. dev_dbg(dai->dev, "%s: PCM_RX port already ON\n",
  901. __func__);
  902. goto exit;
  903. } else
  904. set_bit(STATUS_RX_PORT,
  905. aux_dai_data->auxpcm_port_status);
  906. }
  907. if (test_bit(STATUS_TX_PORT, aux_dai_data->auxpcm_port_status) &&
  908. test_bit(STATUS_RX_PORT, aux_dai_data->auxpcm_port_status)) {
  909. dev_dbg(dai->dev, "%s: PCM ports already set\n", __func__);
  910. goto exit;
  911. }
  912. dev_dbg(dai->dev, "%s: dai->id:%d opening afe ports\n",
  913. __func__, dai->id);
  914. rc = afe_q6_interface_prepare();
  915. if (rc < 0) {
  916. dev_err(dai->dev, "fail to open AFE APR\n");
  917. goto fail;
  918. }
  919. /*
  920. * For AUX PCM Interface the below sequence of clk
  921. * settings and afe_open is a strict requirement.
  922. *
  923. * Also using afe_open instead of afe_port_start_nowait
  924. * to make sure the port is open before deasserting the
  925. * clock line. This is required because pcm register is
  926. * not written before clock deassert. Hence the hw does
  927. * not get updated with new setting if the below clock
  928. * assert/deasset and afe_open sequence is not followed.
  929. */
  930. if (dai_data->rate == 8000) {
  931. pcm_clk_rate = auxpcm_pdata->mode_8k.pcm_clk_rate;
  932. } else if (dai_data->rate == 16000) {
  933. pcm_clk_rate = (auxpcm_pdata->mode_16k.pcm_clk_rate);
  934. } else {
  935. dev_err(dai->dev, "%s: Invalid AUX PCM rate %d\n", __func__,
  936. dai_data->rate);
  937. rc = -EINVAL;
  938. goto fail;
  939. }
  940. if (aux_dai_data->afe_clk_ver == AFE_CLK_VERSION_V2) {
  941. memcpy(&aux_dai_data->clk_set, &lpass_clk_set_default,
  942. sizeof(struct afe_clk_set));
  943. aux_dai_data->clk_set.clk_freq_in_hz = pcm_clk_rate;
  944. switch (dai->id) {
  945. case MSM_DAI_PRI_AUXPCM_DT_DEV_ID:
  946. if (pcm_clk_rate)
  947. aux_dai_data->clk_set.clk_id =
  948. Q6AFE_LPASS_CLK_ID_PRI_PCM_IBIT;
  949. else
  950. aux_dai_data->clk_set.clk_id =
  951. Q6AFE_LPASS_CLK_ID_PRI_PCM_EBIT;
  952. break;
  953. case MSM_DAI_SEC_AUXPCM_DT_DEV_ID:
  954. if (pcm_clk_rate)
  955. aux_dai_data->clk_set.clk_id =
  956. Q6AFE_LPASS_CLK_ID_SEC_PCM_IBIT;
  957. else
  958. aux_dai_data->clk_set.clk_id =
  959. Q6AFE_LPASS_CLK_ID_SEC_PCM_EBIT;
  960. break;
  961. case MSM_DAI_TERT_AUXPCM_DT_DEV_ID:
  962. if (pcm_clk_rate)
  963. aux_dai_data->clk_set.clk_id =
  964. Q6AFE_LPASS_CLK_ID_TER_PCM_IBIT;
  965. else
  966. aux_dai_data->clk_set.clk_id =
  967. Q6AFE_LPASS_CLK_ID_TER_PCM_EBIT;
  968. break;
  969. case MSM_DAI_QUAT_AUXPCM_DT_DEV_ID:
  970. if (pcm_clk_rate)
  971. aux_dai_data->clk_set.clk_id =
  972. Q6AFE_LPASS_CLK_ID_QUAD_PCM_IBIT;
  973. else
  974. aux_dai_data->clk_set.clk_id =
  975. Q6AFE_LPASS_CLK_ID_QUAD_PCM_EBIT;
  976. break;
  977. case MSM_DAI_QUIN_AUXPCM_DT_DEV_ID:
  978. if (pcm_clk_rate)
  979. aux_dai_data->clk_set.clk_id =
  980. Q6AFE_LPASS_CLK_ID_QUIN_PCM_IBIT;
  981. else
  982. aux_dai_data->clk_set.clk_id =
  983. Q6AFE_LPASS_CLK_ID_QUIN_PCM_EBIT;
  984. break;
  985. default:
  986. dev_err(dai->dev, "%s: AUXPCM id: %d not supported\n",
  987. __func__, dai->id);
  988. break;
  989. }
  990. } else {
  991. memcpy(&aux_dai_data->clk_cfg, &lpass_clk_cfg_default,
  992. sizeof(struct afe_clk_cfg));
  993. aux_dai_data->clk_cfg.clk_val1 = pcm_clk_rate;
  994. }
  995. rc = msm_dai_q6_auxpcm_set_clk(aux_dai_data,
  996. aux_dai_data->rx_pid, true);
  997. if (rc < 0) {
  998. dev_err(dai->dev,
  999. "%s:afe_set_lpass_clock on RX pcm_src_clk failed\n",
  1000. __func__);
  1001. goto fail;
  1002. }
  1003. rc = msm_dai_q6_auxpcm_set_clk(aux_dai_data,
  1004. aux_dai_data->tx_pid, true);
  1005. if (rc < 0) {
  1006. dev_err(dai->dev,
  1007. "%s:afe_set_lpass_clock on TX pcm_src_clk failed\n",
  1008. __func__);
  1009. goto fail;
  1010. }
  1011. afe_open(aux_dai_data->rx_pid, &dai_data->port_config, dai_data->rate);
  1012. if (q6core_get_avcs_api_version_per_service(
  1013. APRV2_IDS_SERVICE_ID_ADSP_AFE_V) >= AFE_API_VERSION_V4) {
  1014. /*
  1015. * send island mode config
  1016. * This should be the first configuration
  1017. */
  1018. rc = afe_send_port_island_mode(aux_dai_data->tx_pid);
  1019. if (rc)
  1020. dev_err(dai->dev, "%s: afe send island mode failed %d\n",
  1021. __func__, rc);
  1022. }
  1023. afe_open(aux_dai_data->tx_pid, &dai_data->port_config, dai_data->rate);
  1024. goto exit;
  1025. fail:
  1026. if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
  1027. clear_bit(STATUS_TX_PORT, aux_dai_data->auxpcm_port_status);
  1028. else if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
  1029. clear_bit(STATUS_RX_PORT, aux_dai_data->auxpcm_port_status);
  1030. exit:
  1031. mutex_unlock(&aux_dai_data->rlock);
  1032. return rc;
  1033. }
  1034. static int msm_dai_q6_auxpcm_trigger(struct snd_pcm_substream *substream,
  1035. int cmd, struct snd_soc_dai *dai)
  1036. {
  1037. int rc = 0;
  1038. pr_debug("%s:port:%d cmd:%d\n",
  1039. __func__, dai->id, cmd);
  1040. switch (cmd) {
  1041. case SNDRV_PCM_TRIGGER_START:
  1042. case SNDRV_PCM_TRIGGER_RESUME:
  1043. case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
  1044. /* afe_open will be called from prepare */
  1045. return 0;
  1046. case SNDRV_PCM_TRIGGER_STOP:
  1047. case SNDRV_PCM_TRIGGER_SUSPEND:
  1048. case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
  1049. return 0;
  1050. default:
  1051. pr_err("%s: cmd %d\n", __func__, cmd);
  1052. rc = -EINVAL;
  1053. }
  1054. return rc;
  1055. }
  1056. static int msm_dai_q6_dai_auxpcm_remove(struct snd_soc_dai *dai)
  1057. {
  1058. struct msm_dai_q6_auxpcm_dai_data *aux_dai_data;
  1059. int rc;
  1060. aux_dai_data = dev_get_drvdata(dai->dev);
  1061. dev_dbg(dai->dev, "%s: dai->id %d closing afe\n",
  1062. __func__, dai->id);
  1063. if (test_bit(STATUS_TX_PORT, aux_dai_data->auxpcm_port_status) ||
  1064. test_bit(STATUS_RX_PORT, aux_dai_data->auxpcm_port_status)) {
  1065. rc = afe_close(aux_dai_data->rx_pid); /* can block */
  1066. if (rc < 0)
  1067. dev_err(dai->dev, "fail to close AUXPCM RX AFE port\n");
  1068. rc = afe_close(aux_dai_data->tx_pid);
  1069. if (rc < 0)
  1070. dev_err(dai->dev, "fail to close AUXPCM TX AFE port\n");
  1071. clear_bit(STATUS_TX_PORT, aux_dai_data->auxpcm_port_status);
  1072. clear_bit(STATUS_RX_PORT, aux_dai_data->auxpcm_port_status);
  1073. }
  1074. msm_dai_q6_auxpcm_set_clk(aux_dai_data, aux_dai_data->rx_pid, false);
  1075. msm_dai_q6_auxpcm_set_clk(aux_dai_data, aux_dai_data->tx_pid, false);
  1076. return 0;
  1077. }
  1078. static int msm_dai_q6_island_mode_put(struct snd_kcontrol *kcontrol,
  1079. struct snd_ctl_elem_value *ucontrol)
  1080. {
  1081. int value = ucontrol->value.integer.value[0];
  1082. u16 port_id = (u16)kcontrol->private_value;
  1083. pr_debug("%s: island mode = %d\n", __func__, value);
  1084. afe_set_island_mode_cfg(port_id, value);
  1085. return 0;
  1086. }
  1087. static int msm_dai_q6_island_mode_get(struct snd_kcontrol *kcontrol,
  1088. struct snd_ctl_elem_value *ucontrol)
  1089. {
  1090. int value;
  1091. u16 port_id = (u16)kcontrol->private_value;
  1092. afe_get_island_mode_cfg(port_id, &value);
  1093. ucontrol->value.integer.value[0] = value;
  1094. return 0;
  1095. }
  1096. static void island_mx_ctl_private_free(struct snd_kcontrol *kcontrol)
  1097. {
  1098. struct snd_kcontrol_new *knew = snd_kcontrol_chip(kcontrol);
  1099. kfree(knew);
  1100. }
  1101. static int msm_dai_q6_add_island_mx_ctls(struct snd_card *card,
  1102. const char *dai_name,
  1103. int dai_id, void *dai_data)
  1104. {
  1105. const char *mx_ctl_name = "TX island";
  1106. char *mixer_str = NULL;
  1107. int dai_str_len = 0, ctl_len = 0;
  1108. int rc = 0;
  1109. struct snd_kcontrol_new *knew = NULL;
  1110. struct snd_kcontrol *kctl = NULL;
  1111. dai_str_len = strlen(dai_name) + 1;
  1112. /* Add island related mixer controls */
  1113. ctl_len = dai_str_len + strlen(mx_ctl_name) + 1;
  1114. mixer_str = kzalloc(ctl_len, GFP_KERNEL);
  1115. if (!mixer_str)
  1116. return -ENOMEM;
  1117. snprintf(mixer_str, ctl_len, "%s %s", dai_name, mx_ctl_name);
  1118. knew = kzalloc(sizeof(struct snd_kcontrol_new), GFP_KERNEL);
  1119. if (!knew) {
  1120. kfree(mixer_str);
  1121. return -ENOMEM;
  1122. }
  1123. knew->iface = SNDRV_CTL_ELEM_IFACE_MIXER;
  1124. knew->info = snd_ctl_boolean_mono_info;
  1125. knew->get = msm_dai_q6_island_mode_get;
  1126. knew->put = msm_dai_q6_island_mode_put;
  1127. knew->name = mixer_str;
  1128. knew->private_value = dai_id;
  1129. kctl = snd_ctl_new1(knew, knew);
  1130. if (!kctl) {
  1131. kfree(knew);
  1132. kfree(mixer_str);
  1133. return -ENOMEM;
  1134. }
  1135. kctl->private_free = island_mx_ctl_private_free;
  1136. rc = snd_ctl_add(card, kctl);
  1137. if (rc < 0)
  1138. pr_err("%s: err add config ctl, DAI = %s\n",
  1139. __func__, dai_name);
  1140. kfree(mixer_str);
  1141. return rc;
  1142. }
  1143. /*
  1144. * For single CPU DAI registration, the dai id needs to be
  1145. * set explicitly in the dai probe as ASoC does not read
  1146. * the cpu->driver->id field rather it assigns the dai id
  1147. * from the device name that is in the form %s.%d. This dai
  1148. * id should be assigned to back-end AFE port id and used
  1149. * during dai prepare. For multiple dai registration, it
  1150. * is not required to call this function, however the dai->
  1151. * driver->id field must be defined and set to corresponding
  1152. * AFE Port id.
  1153. */
  1154. static inline void msm_dai_q6_set_dai_id(struct snd_soc_dai *dai)
  1155. {
  1156. if (!dai->driver) {
  1157. dev_err(dai->dev, "DAI driver is not set\n");
  1158. return;
  1159. }
  1160. if (!dai->driver->id) {
  1161. dev_dbg(dai->dev, "DAI driver id is not set\n");
  1162. return;
  1163. }
  1164. dai->id = dai->driver->id;
  1165. }
  1166. static int msm_dai_q6_aux_pcm_probe(struct snd_soc_dai *dai)
  1167. {
  1168. int rc = 0;
  1169. struct msm_dai_q6_auxpcm_dai_data *dai_data = NULL;
  1170. if (!dai) {
  1171. pr_err("%s: Invalid params dai\n", __func__);
  1172. return -EINVAL;
  1173. }
  1174. if (!dai->dev) {
  1175. pr_err("%s: Invalid params dai dev\n", __func__);
  1176. return -EINVAL;
  1177. }
  1178. msm_dai_q6_set_dai_id(dai);
  1179. dai_data = dev_get_drvdata(dai->dev);
  1180. if (dai_data->is_island_dai)
  1181. rc = msm_dai_q6_add_island_mx_ctls(
  1182. dai->component->card->snd_card,
  1183. dai->name, dai_data->tx_pid,
  1184. (void *)dai_data);
  1185. rc = msm_dai_q6_dai_add_route(dai);
  1186. return rc;
  1187. }
  1188. static struct snd_soc_dai_ops msm_dai_q6_auxpcm_ops = {
  1189. .prepare = msm_dai_q6_auxpcm_prepare,
  1190. .trigger = msm_dai_q6_auxpcm_trigger,
  1191. .hw_params = msm_dai_q6_auxpcm_hw_params,
  1192. .shutdown = msm_dai_q6_auxpcm_shutdown,
  1193. };
  1194. static const struct snd_soc_component_driver
  1195. msm_dai_q6_aux_pcm_dai_component = {
  1196. .name = "msm-auxpcm-dev",
  1197. };
  1198. static struct snd_soc_dai_driver msm_dai_q6_aux_pcm_dai[] = {
  1199. {
  1200. .playback = {
  1201. .stream_name = "AUX PCM Playback",
  1202. .aif_name = "AUX_PCM_RX",
  1203. .rates = (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000),
  1204. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  1205. .channels_min = 1,
  1206. .channels_max = 1,
  1207. .rate_max = 16000,
  1208. .rate_min = 8000,
  1209. },
  1210. .capture = {
  1211. .stream_name = "AUX PCM Capture",
  1212. .aif_name = "AUX_PCM_TX",
  1213. .rates = (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000),
  1214. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  1215. .channels_min = 1,
  1216. .channels_max = 1,
  1217. .rate_max = 16000,
  1218. .rate_min = 8000,
  1219. },
  1220. .id = MSM_DAI_PRI_AUXPCM_DT_DEV_ID,
  1221. .name = "Pri AUX PCM",
  1222. .ops = &msm_dai_q6_auxpcm_ops,
  1223. .probe = msm_dai_q6_aux_pcm_probe,
  1224. .remove = msm_dai_q6_dai_auxpcm_remove,
  1225. },
  1226. {
  1227. .playback = {
  1228. .stream_name = "Sec AUX PCM Playback",
  1229. .aif_name = "SEC_AUX_PCM_RX",
  1230. .rates = (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000),
  1231. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  1232. .channels_min = 1,
  1233. .channels_max = 1,
  1234. .rate_max = 16000,
  1235. .rate_min = 8000,
  1236. },
  1237. .capture = {
  1238. .stream_name = "Sec AUX PCM Capture",
  1239. .aif_name = "SEC_AUX_PCM_TX",
  1240. .rates = (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000),
  1241. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  1242. .channels_min = 1,
  1243. .channels_max = 1,
  1244. .rate_max = 16000,
  1245. .rate_min = 8000,
  1246. },
  1247. .id = MSM_DAI_SEC_AUXPCM_DT_DEV_ID,
  1248. .name = "Sec AUX PCM",
  1249. .ops = &msm_dai_q6_auxpcm_ops,
  1250. .probe = msm_dai_q6_aux_pcm_probe,
  1251. .remove = msm_dai_q6_dai_auxpcm_remove,
  1252. },
  1253. {
  1254. .playback = {
  1255. .stream_name = "Tert AUX PCM Playback",
  1256. .aif_name = "TERT_AUX_PCM_RX",
  1257. .rates = (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000),
  1258. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  1259. .channels_min = 1,
  1260. .channels_max = 1,
  1261. .rate_max = 16000,
  1262. .rate_min = 8000,
  1263. },
  1264. .capture = {
  1265. .stream_name = "Tert AUX PCM Capture",
  1266. .aif_name = "TERT_AUX_PCM_TX",
  1267. .rates = (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000),
  1268. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  1269. .channels_min = 1,
  1270. .channels_max = 1,
  1271. .rate_max = 16000,
  1272. .rate_min = 8000,
  1273. },
  1274. .id = MSM_DAI_TERT_AUXPCM_DT_DEV_ID,
  1275. .name = "Tert AUX PCM",
  1276. .ops = &msm_dai_q6_auxpcm_ops,
  1277. .probe = msm_dai_q6_aux_pcm_probe,
  1278. .remove = msm_dai_q6_dai_auxpcm_remove,
  1279. },
  1280. {
  1281. .playback = {
  1282. .stream_name = "Quat AUX PCM Playback",
  1283. .aif_name = "QUAT_AUX_PCM_RX",
  1284. .rates = (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000),
  1285. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  1286. .channels_min = 1,
  1287. .channels_max = 1,
  1288. .rate_max = 16000,
  1289. .rate_min = 8000,
  1290. },
  1291. .capture = {
  1292. .stream_name = "Quat AUX PCM Capture",
  1293. .aif_name = "QUAT_AUX_PCM_TX",
  1294. .rates = (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000),
  1295. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  1296. .channels_min = 1,
  1297. .channels_max = 1,
  1298. .rate_max = 16000,
  1299. .rate_min = 8000,
  1300. },
  1301. .id = MSM_DAI_QUAT_AUXPCM_DT_DEV_ID,
  1302. .name = "Quat AUX PCM",
  1303. .ops = &msm_dai_q6_auxpcm_ops,
  1304. .probe = msm_dai_q6_aux_pcm_probe,
  1305. .remove = msm_dai_q6_dai_auxpcm_remove,
  1306. },
  1307. {
  1308. .playback = {
  1309. .stream_name = "Quin AUX PCM Playback",
  1310. .aif_name = "QUIN_AUX_PCM_RX",
  1311. .rates = (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000),
  1312. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  1313. .channels_min = 1,
  1314. .channels_max = 1,
  1315. .rate_max = 16000,
  1316. .rate_min = 8000,
  1317. },
  1318. .capture = {
  1319. .stream_name = "Quin AUX PCM Capture",
  1320. .aif_name = "QUIN_AUX_PCM_TX",
  1321. .rates = (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000),
  1322. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  1323. .channels_min = 1,
  1324. .channels_max = 1,
  1325. .rate_max = 16000,
  1326. .rate_min = 8000,
  1327. },
  1328. .id = MSM_DAI_QUIN_AUXPCM_DT_DEV_ID,
  1329. .name = "Quin AUX PCM",
  1330. .ops = &msm_dai_q6_auxpcm_ops,
  1331. .probe = msm_dai_q6_aux_pcm_probe,
  1332. .remove = msm_dai_q6_dai_auxpcm_remove,
  1333. },
  1334. };
  1335. static int msm_dai_q6_spdif_format_put(struct snd_kcontrol *kcontrol,
  1336. struct snd_ctl_elem_value *ucontrol)
  1337. {
  1338. struct msm_dai_q6_spdif_dai_data *dai_data = kcontrol->private_data;
  1339. int value = ucontrol->value.integer.value[0];
  1340. dai_data->spdif_port.cfg.data_format = value;
  1341. pr_debug("%s: value = %d\n", __func__, value);
  1342. return 0;
  1343. }
  1344. static int msm_dai_q6_spdif_format_get(struct snd_kcontrol *kcontrol,
  1345. struct snd_ctl_elem_value *ucontrol)
  1346. {
  1347. struct msm_dai_q6_spdif_dai_data *dai_data = kcontrol->private_data;
  1348. ucontrol->value.integer.value[0] =
  1349. dai_data->spdif_port.cfg.data_format;
  1350. return 0;
  1351. }
  1352. static int msm_dai_q6_spdif_source_put(struct snd_kcontrol *kcontrol,
  1353. struct snd_ctl_elem_value *ucontrol)
  1354. {
  1355. struct msm_dai_q6_spdif_dai_data *dai_data = kcontrol->private_data;
  1356. int value = ucontrol->value.integer.value[0];
  1357. dai_data->spdif_port.cfg.src_sel = value;
  1358. pr_debug("%s: value = %d\n", __func__, value);
  1359. return 0;
  1360. }
  1361. static int msm_dai_q6_spdif_source_get(struct snd_kcontrol *kcontrol,
  1362. struct snd_ctl_elem_value *ucontrol)
  1363. {
  1364. struct msm_dai_q6_spdif_dai_data *dai_data = kcontrol->private_data;
  1365. ucontrol->value.integer.value[0] =
  1366. dai_data->spdif_port.cfg.src_sel;
  1367. return 0;
  1368. }
  1369. static const char * const spdif_format[] = {
  1370. "LPCM",
  1371. "Compr"
  1372. };
  1373. static const char * const spdif_source[] = {
  1374. "Optical", "EXT-ARC", "Coaxial", "VT-ARC"
  1375. };
  1376. static const struct soc_enum spdif_rx_config_enum[] = {
  1377. SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(spdif_format), spdif_format),
  1378. };
  1379. static const struct soc_enum spdif_tx_config_enum[] = {
  1380. SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(spdif_source), spdif_source),
  1381. SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(spdif_format), spdif_format),
  1382. };
  1383. static int msm_dai_q6_spdif_chstatus_put(struct snd_kcontrol *kcontrol,
  1384. struct snd_ctl_elem_value *ucontrol)
  1385. {
  1386. struct msm_dai_q6_spdif_dai_data *dai_data = kcontrol->private_data;
  1387. int ret = 0;
  1388. dai_data->spdif_port.ch_status.status_type =
  1389. AFE_API_VERSION_SPDIF_CH_STATUS_CONFIG;
  1390. memset(dai_data->spdif_port.ch_status.status_mask,
  1391. CHANNEL_STATUS_MASK_INIT, CHANNEL_STATUS_SIZE);
  1392. dai_data->spdif_port.ch_status.status_mask[0] =
  1393. CHANNEL_STATUS_MASK;
  1394. memcpy(dai_data->spdif_port.ch_status.status_bits,
  1395. ucontrol->value.iec958.status, CHANNEL_STATUS_SIZE);
  1396. if (test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  1397. pr_debug("%s: Port already started. Dynamic update\n",
  1398. __func__);
  1399. ret = afe_send_spdif_ch_status_cfg(
  1400. &dai_data->spdif_port.ch_status,
  1401. dai_data->port_id);
  1402. }
  1403. return ret;
  1404. }
  1405. static int msm_dai_q6_spdif_chstatus_get(struct snd_kcontrol *kcontrol,
  1406. struct snd_ctl_elem_value *ucontrol)
  1407. {
  1408. struct msm_dai_q6_spdif_dai_data *dai_data = kcontrol->private_data;
  1409. memcpy(ucontrol->value.iec958.status,
  1410. dai_data->spdif_port.ch_status.status_bits,
  1411. CHANNEL_STATUS_SIZE);
  1412. return 0;
  1413. }
  1414. static int msm_dai_q6_spdif_chstatus_info(struct snd_kcontrol *kcontrol,
  1415. struct snd_ctl_elem_info *uinfo)
  1416. {
  1417. uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958;
  1418. uinfo->count = 1;
  1419. return 0;
  1420. }
  1421. static const struct snd_kcontrol_new spdif_rx_config_controls[] = {
  1422. /* Primary SPDIF output */
  1423. {
  1424. .access = (SNDRV_CTL_ELEM_ACCESS_READWRITE |
  1425. SNDRV_CTL_ELEM_ACCESS_INACTIVE),
  1426. .iface = SNDRV_CTL_ELEM_IFACE_PCM,
  1427. .name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, PCM_STREAM),
  1428. .info = msm_dai_q6_spdif_chstatus_info,
  1429. .get = msm_dai_q6_spdif_chstatus_get,
  1430. .put = msm_dai_q6_spdif_chstatus_put,
  1431. },
  1432. SOC_ENUM_EXT("PRI SPDIF RX Format", spdif_rx_config_enum[0],
  1433. msm_dai_q6_spdif_format_get,
  1434. msm_dai_q6_spdif_format_put),
  1435. /* Secondary SPDIF output */
  1436. {
  1437. .access = (SNDRV_CTL_ELEM_ACCESS_READWRITE |
  1438. SNDRV_CTL_ELEM_ACCESS_INACTIVE),
  1439. .iface = SNDRV_CTL_ELEM_IFACE_PCM,
  1440. .name = SNDRV_CTL_NAME_IEC958("SEC", PLAYBACK, PCM_STREAM),
  1441. .info = msm_dai_q6_spdif_chstatus_info,
  1442. .get = msm_dai_q6_spdif_chstatus_get,
  1443. .put = msm_dai_q6_spdif_chstatus_put,
  1444. },
  1445. SOC_ENUM_EXT("SEC SPDIF RX Format", spdif_rx_config_enum[0],
  1446. msm_dai_q6_spdif_format_get,
  1447. msm_dai_q6_spdif_format_put)
  1448. };
  1449. static const struct snd_kcontrol_new spdif_tx_config_controls[] = {
  1450. SOC_ENUM_EXT("PRI SPDIF TX Source", spdif_tx_config_enum[0],
  1451. msm_dai_q6_spdif_source_get,
  1452. msm_dai_q6_spdif_source_put),
  1453. SOC_ENUM_EXT("PRI SPDIF TX Format", spdif_tx_config_enum[1],
  1454. msm_dai_q6_spdif_format_get,
  1455. msm_dai_q6_spdif_format_put),
  1456. SOC_ENUM_EXT("SEC SPDIF TX Source", spdif_tx_config_enum[0],
  1457. msm_dai_q6_spdif_source_get,
  1458. msm_dai_q6_spdif_source_put),
  1459. SOC_ENUM_EXT("SEC SPDIF TX Format", spdif_tx_config_enum[1],
  1460. msm_dai_q6_spdif_format_get,
  1461. msm_dai_q6_spdif_format_put)
  1462. };
  1463. static void msm_dai_q6_spdif_process_event(uint32_t opcode, uint32_t token,
  1464. uint32_t *payload, void *private_data)
  1465. {
  1466. struct msm_dai_q6_spdif_event_msg *evt;
  1467. struct msm_dai_q6_spdif_dai_data *dai_data;
  1468. evt = (struct msm_dai_q6_spdif_event_msg *)payload;
  1469. dai_data = (struct msm_dai_q6_spdif_dai_data *)private_data;
  1470. pr_debug("%s: old state %d, fmt %d, rate %d\n",
  1471. __func__, dai_data->fmt_event.status,
  1472. dai_data->fmt_event.data_format,
  1473. dai_data->fmt_event.sample_rate);
  1474. pr_debug("%s: new state %d, fmt %d, rate %d\n",
  1475. __func__, evt->fmt_event.status,
  1476. evt->fmt_event.data_format,
  1477. evt->fmt_event.sample_rate);
  1478. dai_data->fmt_event.status = evt->fmt_event.status;
  1479. dai_data->fmt_event.data_format = evt->fmt_event.data_format;
  1480. dai_data->fmt_event.sample_rate = evt->fmt_event.sample_rate;
  1481. }
  1482. static int msm_dai_q6_spdif_hw_params(struct snd_pcm_substream *substream,
  1483. struct snd_pcm_hw_params *params,
  1484. struct snd_soc_dai *dai)
  1485. {
  1486. struct msm_dai_q6_spdif_dai_data *dai_data = dev_get_drvdata(dai->dev);
  1487. dai_data->channels = params_channels(params);
  1488. dai_data->spdif_port.cfg.num_channels = dai_data->channels;
  1489. switch (params_format(params)) {
  1490. case SNDRV_PCM_FORMAT_S16_LE:
  1491. dai_data->spdif_port.cfg.bit_width = 16;
  1492. break;
  1493. case SNDRV_PCM_FORMAT_S24_LE:
  1494. case SNDRV_PCM_FORMAT_S24_3LE:
  1495. dai_data->spdif_port.cfg.bit_width = 24;
  1496. break;
  1497. default:
  1498. pr_err("%s: format %d\n",
  1499. __func__, params_format(params));
  1500. return -EINVAL;
  1501. }
  1502. dai_data->rate = params_rate(params);
  1503. dai_data->bitwidth = dai_data->spdif_port.cfg.bit_width;
  1504. dai_data->spdif_port.cfg.sample_rate = dai_data->rate;
  1505. dai_data->spdif_port.cfg.spdif_cfg_minor_version =
  1506. AFE_API_VERSION_SPDIF_CONFIG_V2;
  1507. dev_dbg(dai->dev, " channel %d sample rate %d bit width %d\n",
  1508. dai_data->channels, dai_data->rate,
  1509. dai_data->spdif_port.cfg.bit_width);
  1510. dai_data->spdif_port.cfg.reserved = 0;
  1511. return 0;
  1512. }
  1513. static void msm_dai_q6_spdif_shutdown(struct snd_pcm_substream *substream,
  1514. struct snd_soc_dai *dai)
  1515. {
  1516. struct msm_dai_q6_spdif_dai_data *dai_data = dev_get_drvdata(dai->dev);
  1517. int rc = 0;
  1518. if (!test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  1519. pr_info("%s: afe port not started. dai_data->status_mask = %ld\n",
  1520. __func__, *dai_data->status_mask);
  1521. return;
  1522. }
  1523. rc = afe_close(dai->id);
  1524. if (rc < 0)
  1525. dev_err(dai->dev, "fail to close AFE port\n");
  1526. dai_data->fmt_event.status = 0; /* report invalid line state */
  1527. pr_debug("%s: dai_data->status_mask = %ld\n", __func__,
  1528. *dai_data->status_mask);
  1529. clear_bit(STATUS_PORT_STARTED, dai_data->status_mask);
  1530. }
  1531. static int msm_dai_q6_spdif_prepare(struct snd_pcm_substream *substream,
  1532. struct snd_soc_dai *dai)
  1533. {
  1534. struct msm_dai_q6_spdif_dai_data *dai_data = dev_get_drvdata(dai->dev);
  1535. int rc = 0;
  1536. if (!test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  1537. rc = afe_spdif_reg_event_cfg(dai->id,
  1538. AFE_MODULE_REGISTER_EVENT_FLAG,
  1539. msm_dai_q6_spdif_process_event,
  1540. dai_data);
  1541. if (rc < 0)
  1542. dev_err(dai->dev,
  1543. "fail to register event for port 0x%x\n",
  1544. dai->id);
  1545. rc = afe_spdif_port_start(dai->id, &dai_data->spdif_port,
  1546. dai_data->rate);
  1547. if (rc < 0)
  1548. dev_err(dai->dev, "fail to open AFE port 0x%x\n",
  1549. dai->id);
  1550. else
  1551. set_bit(STATUS_PORT_STARTED,
  1552. dai_data->status_mask);
  1553. }
  1554. return rc;
  1555. }
  1556. static ssize_t msm_dai_q6_spdif_sysfs_rda_audio_state(struct device *dev,
  1557. struct device_attribute *attr, char *buf)
  1558. {
  1559. ssize_t ret;
  1560. struct msm_dai_q6_spdif_dai_data *dai_data = dev_get_drvdata(dev);
  1561. if (!dai_data) {
  1562. pr_err("%s: invalid input\n", __func__);
  1563. return -EINVAL;
  1564. }
  1565. ret = snprintf(buf, MSM_DAI_SYSFS_ENTRY_MAX_LEN, "%d\n",
  1566. dai_data->fmt_event.status);
  1567. pr_debug("%s: '%d'\n", __func__, dai_data->fmt_event.status);
  1568. return ret;
  1569. }
  1570. static ssize_t msm_dai_q6_spdif_sysfs_rda_audio_format(struct device *dev,
  1571. struct device_attribute *attr, char *buf)
  1572. {
  1573. ssize_t ret;
  1574. struct msm_dai_q6_spdif_dai_data *dai_data = dev_get_drvdata(dev);
  1575. if (!dai_data) {
  1576. pr_err("%s: invalid input\n", __func__);
  1577. return -EINVAL;
  1578. }
  1579. ret = snprintf(buf, MSM_DAI_SYSFS_ENTRY_MAX_LEN, "%d\n",
  1580. dai_data->fmt_event.data_format);
  1581. pr_debug("%s: '%d'\n", __func__, dai_data->fmt_event.data_format);
  1582. return ret;
  1583. }
  1584. static ssize_t msm_dai_q6_spdif_sysfs_rda_audio_rate(struct device *dev,
  1585. struct device_attribute *attr, char *buf)
  1586. {
  1587. ssize_t ret;
  1588. struct msm_dai_q6_spdif_dai_data *dai_data = dev_get_drvdata(dev);
  1589. if (!dai_data) {
  1590. pr_err("%s: invalid input\n", __func__);
  1591. return -EINVAL;
  1592. }
  1593. ret = snprintf(buf, MSM_DAI_SYSFS_ENTRY_MAX_LEN, "%d\n",
  1594. dai_data->fmt_event.sample_rate);
  1595. pr_debug("%s: '%d'\n", __func__, dai_data->fmt_event.sample_rate);
  1596. return ret;
  1597. }
  1598. static DEVICE_ATTR(audio_state, 0444, msm_dai_q6_spdif_sysfs_rda_audio_state,
  1599. NULL);
  1600. static DEVICE_ATTR(audio_format, 0444, msm_dai_q6_spdif_sysfs_rda_audio_format,
  1601. NULL);
  1602. static DEVICE_ATTR(audio_rate, 0444, msm_dai_q6_spdif_sysfs_rda_audio_rate,
  1603. NULL);
  1604. static struct attribute *msm_dai_q6_spdif_fs_attrs[] = {
  1605. &dev_attr_audio_state.attr,
  1606. &dev_attr_audio_format.attr,
  1607. &dev_attr_audio_rate.attr,
  1608. NULL,
  1609. };
  1610. static struct attribute_group msm_dai_q6_spdif_fs_attrs_group = {
  1611. .attrs = msm_dai_q6_spdif_fs_attrs,
  1612. };
  1613. static int msm_dai_q6_spdif_sysfs_create(struct snd_soc_dai *dai,
  1614. struct msm_dai_q6_spdif_dai_data *dai_data)
  1615. {
  1616. int rc;
  1617. rc = sysfs_create_group(&dai->dev->kobj,
  1618. &msm_dai_q6_spdif_fs_attrs_group);
  1619. if (rc) {
  1620. pr_err("%s: failed, rc=%d\n", __func__, rc);
  1621. return rc;
  1622. }
  1623. dai_data->kobj = &dai->dev->kobj;
  1624. return 0;
  1625. }
  1626. static void msm_dai_q6_spdif_sysfs_remove(struct snd_soc_dai *dai,
  1627. struct msm_dai_q6_spdif_dai_data *dai_data)
  1628. {
  1629. if (dai_data->kobj)
  1630. sysfs_remove_group(dai_data->kobj,
  1631. &msm_dai_q6_spdif_fs_attrs_group);
  1632. dai_data->kobj = NULL;
  1633. }
  1634. static int msm_dai_q6_spdif_dai_probe(struct snd_soc_dai *dai)
  1635. {
  1636. struct msm_dai_q6_spdif_dai_data *dai_data;
  1637. int rc = 0;
  1638. struct snd_soc_dapm_route intercon;
  1639. struct snd_soc_dapm_context *dapm;
  1640. if (!dai) {
  1641. pr_err("%s: dai not found!!\n", __func__);
  1642. return -EINVAL;
  1643. }
  1644. if (!dai->dev) {
  1645. pr_err("%s: Invalid params dai dev\n", __func__);
  1646. return -EINVAL;
  1647. }
  1648. dai_data = kzalloc(sizeof(struct msm_dai_q6_spdif_dai_data),
  1649. GFP_KERNEL);
  1650. if (!dai_data)
  1651. return -ENOMEM;
  1652. else
  1653. dev_set_drvdata(dai->dev, dai_data);
  1654. msm_dai_q6_set_dai_id(dai);
  1655. dai_data->port_id = dai->id;
  1656. switch (dai->id) {
  1657. case AFE_PORT_ID_PRIMARY_SPDIF_RX:
  1658. rc = snd_ctl_add(dai->component->card->snd_card,
  1659. snd_ctl_new1(&spdif_rx_config_controls[1],
  1660. dai_data));
  1661. break;
  1662. case AFE_PORT_ID_SECONDARY_SPDIF_RX:
  1663. rc = snd_ctl_add(dai->component->card->snd_card,
  1664. snd_ctl_new1(&spdif_rx_config_controls[3],
  1665. dai_data));
  1666. break;
  1667. case AFE_PORT_ID_PRIMARY_SPDIF_TX:
  1668. rc = msm_dai_q6_spdif_sysfs_create(dai, dai_data);
  1669. rc = snd_ctl_add(dai->component->card->snd_card,
  1670. snd_ctl_new1(&spdif_tx_config_controls[0],
  1671. dai_data));
  1672. rc = snd_ctl_add(dai->component->card->snd_card,
  1673. snd_ctl_new1(&spdif_tx_config_controls[1],
  1674. dai_data));
  1675. break;
  1676. case AFE_PORT_ID_SECONDARY_SPDIF_TX:
  1677. rc = msm_dai_q6_spdif_sysfs_create(dai, dai_data);
  1678. rc = snd_ctl_add(dai->component->card->snd_card,
  1679. snd_ctl_new1(&spdif_tx_config_controls[2],
  1680. dai_data));
  1681. rc = snd_ctl_add(dai->component->card->snd_card,
  1682. snd_ctl_new1(&spdif_tx_config_controls[3],
  1683. dai_data));
  1684. break;
  1685. }
  1686. if (rc < 0)
  1687. dev_err(dai->dev,
  1688. "%s: err add config ctl, DAI = %s\n",
  1689. __func__, dai->name);
  1690. dapm = snd_soc_component_get_dapm(dai->component);
  1691. memset(&intercon, 0, sizeof(intercon));
  1692. if (!rc && dai && dai->driver) {
  1693. if (dai->driver->playback.stream_name &&
  1694. dai->driver->playback.aif_name) {
  1695. dev_dbg(dai->dev, "%s: add route for widget %s",
  1696. __func__, dai->driver->playback.stream_name);
  1697. intercon.source = dai->driver->playback.aif_name;
  1698. intercon.sink = dai->driver->playback.stream_name;
  1699. dev_dbg(dai->dev, "%s: src %s sink %s\n",
  1700. __func__, intercon.source, intercon.sink);
  1701. snd_soc_dapm_add_routes(dapm, &intercon, 1);
  1702. }
  1703. if (dai->driver->capture.stream_name &&
  1704. dai->driver->capture.aif_name) {
  1705. dev_dbg(dai->dev, "%s: add route for widget %s",
  1706. __func__, dai->driver->capture.stream_name);
  1707. intercon.sink = dai->driver->capture.aif_name;
  1708. intercon.source = dai->driver->capture.stream_name;
  1709. dev_dbg(dai->dev, "%s: src %s sink %s\n",
  1710. __func__, intercon.source, intercon.sink);
  1711. snd_soc_dapm_add_routes(dapm, &intercon, 1);
  1712. }
  1713. }
  1714. return rc;
  1715. }
  1716. static int msm_dai_q6_spdif_dai_remove(struct snd_soc_dai *dai)
  1717. {
  1718. struct msm_dai_q6_spdif_dai_data *dai_data;
  1719. int rc;
  1720. dai_data = dev_get_drvdata(dai->dev);
  1721. /* If AFE port is still up, close it */
  1722. if (test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  1723. rc = afe_spdif_reg_event_cfg(dai->id,
  1724. AFE_MODULE_DEREGISTER_EVENT_FLAG,
  1725. NULL,
  1726. dai_data);
  1727. if (rc < 0)
  1728. dev_err(dai->dev,
  1729. "fail to deregister event for port 0x%x\n",
  1730. dai->id);
  1731. rc = afe_close(dai->id); /* can block */
  1732. if (rc < 0)
  1733. dev_err(dai->dev, "fail to close AFE port\n");
  1734. clear_bit(STATUS_PORT_STARTED, dai_data->status_mask);
  1735. }
  1736. msm_dai_q6_spdif_sysfs_remove(dai, dai_data);
  1737. kfree(dai_data);
  1738. return 0;
  1739. }
  1740. static struct snd_soc_dai_ops msm_dai_q6_spdif_ops = {
  1741. .prepare = msm_dai_q6_spdif_prepare,
  1742. .hw_params = msm_dai_q6_spdif_hw_params,
  1743. .shutdown = msm_dai_q6_spdif_shutdown,
  1744. };
  1745. static struct snd_soc_dai_driver msm_dai_q6_spdif_spdif_rx_dai[] = {
  1746. {
  1747. .playback = {
  1748. .stream_name = "Primary SPDIF Playback",
  1749. .aif_name = "PRI_SPDIF_RX",
  1750. .rates = SNDRV_PCM_RATE_32000 |
  1751. SNDRV_PCM_RATE_44100 |
  1752. SNDRV_PCM_RATE_48000 |
  1753. SNDRV_PCM_RATE_88200 |
  1754. SNDRV_PCM_RATE_96000 |
  1755. SNDRV_PCM_RATE_176400 |
  1756. SNDRV_PCM_RATE_192000,
  1757. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  1758. SNDRV_PCM_FMTBIT_S24_LE,
  1759. .channels_min = 1,
  1760. .channels_max = 2,
  1761. .rate_min = 32000,
  1762. .rate_max = 192000,
  1763. },
  1764. .name = "PRI_SPDIF_RX",
  1765. .ops = &msm_dai_q6_spdif_ops,
  1766. .id = AFE_PORT_ID_PRIMARY_SPDIF_RX,
  1767. .probe = msm_dai_q6_spdif_dai_probe,
  1768. .remove = msm_dai_q6_spdif_dai_remove,
  1769. },
  1770. {
  1771. .playback = {
  1772. .stream_name = "Secondary SPDIF Playback",
  1773. .aif_name = "SEC_SPDIF_RX",
  1774. .rates = SNDRV_PCM_RATE_32000 |
  1775. SNDRV_PCM_RATE_44100 |
  1776. SNDRV_PCM_RATE_48000 |
  1777. SNDRV_PCM_RATE_88200 |
  1778. SNDRV_PCM_RATE_96000 |
  1779. SNDRV_PCM_RATE_176400 |
  1780. SNDRV_PCM_RATE_192000,
  1781. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  1782. SNDRV_PCM_FMTBIT_S24_LE,
  1783. .channels_min = 1,
  1784. .channels_max = 2,
  1785. .rate_min = 32000,
  1786. .rate_max = 192000,
  1787. },
  1788. .name = "SEC_SPDIF_RX",
  1789. .ops = &msm_dai_q6_spdif_ops,
  1790. .id = AFE_PORT_ID_SECONDARY_SPDIF_RX,
  1791. .probe = msm_dai_q6_spdif_dai_probe,
  1792. .remove = msm_dai_q6_spdif_dai_remove,
  1793. },
  1794. };
  1795. static struct snd_soc_dai_driver msm_dai_q6_spdif_spdif_tx_dai[] = {
  1796. {
  1797. .capture = {
  1798. .stream_name = "Primary SPDIF Capture",
  1799. .aif_name = "PRI_SPDIF_TX",
  1800. .rates = SNDRV_PCM_RATE_32000 |
  1801. SNDRV_PCM_RATE_44100 |
  1802. SNDRV_PCM_RATE_48000 |
  1803. SNDRV_PCM_RATE_88200 |
  1804. SNDRV_PCM_RATE_96000 |
  1805. SNDRV_PCM_RATE_176400 |
  1806. SNDRV_PCM_RATE_192000,
  1807. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  1808. SNDRV_PCM_FMTBIT_S24_LE,
  1809. .channels_min = 1,
  1810. .channels_max = 2,
  1811. .rate_min = 32000,
  1812. .rate_max = 192000,
  1813. },
  1814. .name = "PRI_SPDIF_TX",
  1815. .ops = &msm_dai_q6_spdif_ops,
  1816. .id = AFE_PORT_ID_PRIMARY_SPDIF_TX,
  1817. .probe = msm_dai_q6_spdif_dai_probe,
  1818. .remove = msm_dai_q6_spdif_dai_remove,
  1819. },
  1820. {
  1821. .capture = {
  1822. .stream_name = "Secondary SPDIF Capture",
  1823. .aif_name = "SEC_SPDIF_TX",
  1824. .rates = SNDRV_PCM_RATE_32000 |
  1825. SNDRV_PCM_RATE_44100 |
  1826. SNDRV_PCM_RATE_48000 |
  1827. SNDRV_PCM_RATE_88200 |
  1828. SNDRV_PCM_RATE_96000 |
  1829. SNDRV_PCM_RATE_176400 |
  1830. SNDRV_PCM_RATE_192000,
  1831. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  1832. SNDRV_PCM_FMTBIT_S24_LE,
  1833. .channels_min = 1,
  1834. .channels_max = 2,
  1835. .rate_min = 32000,
  1836. .rate_max = 192000,
  1837. },
  1838. .name = "SEC_SPDIF_TX",
  1839. .ops = &msm_dai_q6_spdif_ops,
  1840. .id = AFE_PORT_ID_SECONDARY_SPDIF_TX,
  1841. .probe = msm_dai_q6_spdif_dai_probe,
  1842. .remove = msm_dai_q6_spdif_dai_remove,
  1843. },
  1844. };
  1845. static const struct snd_soc_component_driver msm_dai_spdif_q6_component = {
  1846. .name = "msm-dai-q6-spdif",
  1847. };
  1848. static int msm_dai_q6_prepare(struct snd_pcm_substream *substream,
  1849. struct snd_soc_dai *dai)
  1850. {
  1851. struct msm_dai_q6_dai_data *dai_data = dev_get_drvdata(dai->dev);
  1852. int rc = 0;
  1853. if (!test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  1854. if (dai_data->enc_config.format != ENC_FMT_NONE) {
  1855. int bitwidth = 0;
  1856. switch (dai_data->afe_rx_in_bitformat) {
  1857. case SNDRV_PCM_FORMAT_S32_LE:
  1858. bitwidth = 32;
  1859. break;
  1860. case SNDRV_PCM_FORMAT_S24_LE:
  1861. bitwidth = 24;
  1862. break;
  1863. case SNDRV_PCM_FORMAT_S16_LE:
  1864. default:
  1865. bitwidth = 16;
  1866. break;
  1867. }
  1868. pr_debug("%s: calling AFE_PORT_START_V2 with enc_format: %d\n",
  1869. __func__, dai_data->enc_config.format);
  1870. rc = afe_port_start_v2(dai->id, &dai_data->port_config,
  1871. dai_data->rate,
  1872. dai_data->afe_rx_in_channels,
  1873. bitwidth,
  1874. &dai_data->enc_config, NULL);
  1875. if (rc < 0)
  1876. pr_err("%s: afe_port_start_v2 failed error: %d\n",
  1877. __func__, rc);
  1878. } else if (dai_data->dec_config.format != DEC_FMT_NONE) {
  1879. int bitwidth = 0;
  1880. /*
  1881. * If bitwidth is not configured set default value to
  1882. * zero, so that decoder port config uses slim device
  1883. * bit width value in afe decoder config.
  1884. */
  1885. switch (dai_data->afe_tx_out_bitformat) {
  1886. case SNDRV_PCM_FORMAT_S32_LE:
  1887. bitwidth = 32;
  1888. break;
  1889. case SNDRV_PCM_FORMAT_S24_LE:
  1890. bitwidth = 24;
  1891. break;
  1892. case SNDRV_PCM_FORMAT_S16_LE:
  1893. bitwidth = 16;
  1894. break;
  1895. default:
  1896. bitwidth = 0;
  1897. break;
  1898. }
  1899. pr_debug("%s: calling AFE_PORT_START_V2 with dec format: %d\n",
  1900. __func__, dai_data->dec_config.format);
  1901. rc = afe_port_start_v2(dai->id, &dai_data->port_config,
  1902. dai_data->rate,
  1903. dai_data->afe_tx_out_channels,
  1904. bitwidth,
  1905. NULL, &dai_data->dec_config);
  1906. if (rc < 0) {
  1907. pr_err("%s: fail to open AFE port 0x%x\n",
  1908. __func__, dai->id);
  1909. }
  1910. } else {
  1911. rc = afe_port_start(dai->id, &dai_data->port_config,
  1912. dai_data->rate);
  1913. }
  1914. if (rc < 0)
  1915. dev_err(dai->dev, "fail to open AFE port 0x%x\n",
  1916. dai->id);
  1917. else
  1918. set_bit(STATUS_PORT_STARTED,
  1919. dai_data->status_mask);
  1920. }
  1921. return rc;
  1922. }
  1923. static int msm_dai_q6_cdc_hw_params(struct snd_pcm_hw_params *params,
  1924. struct snd_soc_dai *dai, int stream)
  1925. {
  1926. struct msm_dai_q6_dai_data *dai_data = dev_get_drvdata(dai->dev);
  1927. dai_data->channels = params_channels(params);
  1928. switch (dai_data->channels) {
  1929. case 2:
  1930. dai_data->port_config.i2s.mono_stereo = MSM_AFE_STEREO;
  1931. break;
  1932. case 1:
  1933. dai_data->port_config.i2s.mono_stereo = MSM_AFE_MONO;
  1934. break;
  1935. default:
  1936. return -EINVAL;
  1937. pr_err("%s: err channels %d\n",
  1938. __func__, dai_data->channels);
  1939. break;
  1940. }
  1941. switch (params_format(params)) {
  1942. case SNDRV_PCM_FORMAT_S16_LE:
  1943. case SNDRV_PCM_FORMAT_SPECIAL:
  1944. dai_data->port_config.i2s.bit_width = 16;
  1945. break;
  1946. case SNDRV_PCM_FORMAT_S24_LE:
  1947. case SNDRV_PCM_FORMAT_S24_3LE:
  1948. dai_data->port_config.i2s.bit_width = 24;
  1949. break;
  1950. default:
  1951. pr_err("%s: format %d\n",
  1952. __func__, params_format(params));
  1953. return -EINVAL;
  1954. }
  1955. dai_data->rate = params_rate(params);
  1956. dai_data->port_config.i2s.sample_rate = dai_data->rate;
  1957. dai_data->port_config.i2s.i2s_cfg_minor_version =
  1958. AFE_API_VERSION_I2S_CONFIG;
  1959. dai_data->port_config.i2s.data_format = AFE_LINEAR_PCM_DATA;
  1960. dev_dbg(dai->dev, " channel %d sample rate %d entered\n",
  1961. dai_data->channels, dai_data->rate);
  1962. dai_data->port_config.i2s.channel_mode = 1;
  1963. return 0;
  1964. }
  1965. static u16 num_of_bits_set(u16 sd_line_mask)
  1966. {
  1967. u8 num_bits_set = 0;
  1968. while (sd_line_mask) {
  1969. num_bits_set++;
  1970. sd_line_mask = sd_line_mask & (sd_line_mask - 1);
  1971. }
  1972. return num_bits_set;
  1973. }
  1974. static int msm_dai_q6_i2s_hw_params(struct snd_pcm_hw_params *params,
  1975. struct snd_soc_dai *dai, int stream)
  1976. {
  1977. struct msm_dai_q6_dai_data *dai_data = dev_get_drvdata(dai->dev);
  1978. struct msm_i2s_data *i2s_pdata =
  1979. (struct msm_i2s_data *) dai->dev->platform_data;
  1980. dai_data->channels = params_channels(params);
  1981. if (num_of_bits_set(i2s_pdata->sd_lines) == 1) {
  1982. switch (dai_data->channels) {
  1983. case 2:
  1984. dai_data->port_config.i2s.mono_stereo = MSM_AFE_STEREO;
  1985. break;
  1986. case 1:
  1987. dai_data->port_config.i2s.mono_stereo = MSM_AFE_MONO;
  1988. break;
  1989. default:
  1990. pr_warn("%s: greater than stereo has not been validated %d",
  1991. __func__, dai_data->channels);
  1992. break;
  1993. }
  1994. }
  1995. dai_data->rate = params_rate(params);
  1996. dai_data->port_config.i2s.sample_rate = dai_data->rate;
  1997. dai_data->port_config.i2s.i2s_cfg_minor_version =
  1998. AFE_API_VERSION_I2S_CONFIG;
  1999. dai_data->port_config.i2s.data_format = AFE_LINEAR_PCM_DATA;
  2000. /* Q6 only supports 16 as now */
  2001. dai_data->port_config.i2s.bit_width = 16;
  2002. dai_data->port_config.i2s.channel_mode = 1;
  2003. return 0;
  2004. }
  2005. static int msm_dai_q6_slim_bus_hw_params(struct snd_pcm_hw_params *params,
  2006. struct snd_soc_dai *dai, int stream)
  2007. {
  2008. struct msm_dai_q6_dai_data *dai_data = dev_get_drvdata(dai->dev);
  2009. dai_data->channels = params_channels(params);
  2010. dai_data->rate = params_rate(params);
  2011. switch (params_format(params)) {
  2012. case SNDRV_PCM_FORMAT_S16_LE:
  2013. case SNDRV_PCM_FORMAT_SPECIAL:
  2014. dai_data->port_config.slim_sch.bit_width = 16;
  2015. break;
  2016. case SNDRV_PCM_FORMAT_S24_LE:
  2017. case SNDRV_PCM_FORMAT_S24_3LE:
  2018. dai_data->port_config.slim_sch.bit_width = 24;
  2019. break;
  2020. case SNDRV_PCM_FORMAT_S32_LE:
  2021. dai_data->port_config.slim_sch.bit_width = 32;
  2022. break;
  2023. default:
  2024. pr_err("%s: format %d\n",
  2025. __func__, params_format(params));
  2026. return -EINVAL;
  2027. }
  2028. dai_data->port_config.slim_sch.sb_cfg_minor_version =
  2029. AFE_API_VERSION_SLIMBUS_CONFIG;
  2030. dai_data->port_config.slim_sch.sample_rate = dai_data->rate;
  2031. dai_data->port_config.slim_sch.num_channels = dai_data->channels;
  2032. switch (dai->id) {
  2033. case SLIMBUS_7_RX:
  2034. case SLIMBUS_7_TX:
  2035. case SLIMBUS_8_RX:
  2036. case SLIMBUS_8_TX:
  2037. case SLIMBUS_9_RX:
  2038. case SLIMBUS_9_TX:
  2039. dai_data->port_config.slim_sch.slimbus_dev_id =
  2040. AFE_SLIMBUS_DEVICE_2;
  2041. break;
  2042. default:
  2043. dai_data->port_config.slim_sch.slimbus_dev_id =
  2044. AFE_SLIMBUS_DEVICE_1;
  2045. break;
  2046. }
  2047. dev_dbg(dai->dev, "%s:slimbus_dev_id[%hu] bit_wd[%hu] format[%hu]\n"
  2048. "num_channel %hu shared_ch_mapping[0] %hu\n"
  2049. "slave_port_mapping[1] %hu slave_port_mapping[2] %hu\n"
  2050. "sample_rate %d\n", __func__,
  2051. dai_data->port_config.slim_sch.slimbus_dev_id,
  2052. dai_data->port_config.slim_sch.bit_width,
  2053. dai_data->port_config.slim_sch.data_format,
  2054. dai_data->port_config.slim_sch.num_channels,
  2055. dai_data->port_config.slim_sch.shared_ch_mapping[0],
  2056. dai_data->port_config.slim_sch.shared_ch_mapping[1],
  2057. dai_data->port_config.slim_sch.shared_ch_mapping[2],
  2058. dai_data->rate);
  2059. return 0;
  2060. }
  2061. static int msm_dai_q6_usb_audio_hw_params(struct snd_pcm_hw_params *params,
  2062. struct snd_soc_dai *dai, int stream)
  2063. {
  2064. struct msm_dai_q6_dai_data *dai_data = dev_get_drvdata(dai->dev);
  2065. dai_data->channels = params_channels(params);
  2066. dai_data->rate = params_rate(params);
  2067. switch (params_format(params)) {
  2068. case SNDRV_PCM_FORMAT_S16_LE:
  2069. case SNDRV_PCM_FORMAT_SPECIAL:
  2070. dai_data->port_config.usb_audio.bit_width = 16;
  2071. break;
  2072. case SNDRV_PCM_FORMAT_S24_LE:
  2073. case SNDRV_PCM_FORMAT_S24_3LE:
  2074. dai_data->port_config.usb_audio.bit_width = 24;
  2075. break;
  2076. case SNDRV_PCM_FORMAT_S32_LE:
  2077. dai_data->port_config.usb_audio.bit_width = 32;
  2078. break;
  2079. default:
  2080. dev_err(dai->dev, "%s: invalid format %d\n",
  2081. __func__, params_format(params));
  2082. return -EINVAL;
  2083. }
  2084. dai_data->port_config.usb_audio.cfg_minor_version =
  2085. AFE_API_MINOR_VERSION_USB_AUDIO_CONFIG;
  2086. dai_data->port_config.usb_audio.num_channels = dai_data->channels;
  2087. dai_data->port_config.usb_audio.sample_rate = dai_data->rate;
  2088. dev_dbg(dai->dev, "%s: dev_id[0x%x] bit_wd[%hu] format[%hu]\n"
  2089. "num_channel %hu sample_rate %d\n", __func__,
  2090. dai_data->port_config.usb_audio.dev_token,
  2091. dai_data->port_config.usb_audio.bit_width,
  2092. dai_data->port_config.usb_audio.data_format,
  2093. dai_data->port_config.usb_audio.num_channels,
  2094. dai_data->port_config.usb_audio.sample_rate);
  2095. return 0;
  2096. }
  2097. static int msm_dai_q6_bt_fm_hw_params(struct snd_pcm_hw_params *params,
  2098. struct snd_soc_dai *dai, int stream)
  2099. {
  2100. struct msm_dai_q6_dai_data *dai_data = dev_get_drvdata(dai->dev);
  2101. dai_data->channels = params_channels(params);
  2102. dai_data->rate = params_rate(params);
  2103. dev_dbg(dai->dev, "channels %d sample rate %d entered\n",
  2104. dai_data->channels, dai_data->rate);
  2105. memset(&dai_data->port_config, 0, sizeof(dai_data->port_config));
  2106. pr_debug("%s: setting bt_fm parameters\n", __func__);
  2107. dai_data->port_config.int_bt_fm.bt_fm_cfg_minor_version =
  2108. AFE_API_VERSION_INTERNAL_BT_FM_CONFIG;
  2109. dai_data->port_config.int_bt_fm.num_channels = dai_data->channels;
  2110. dai_data->port_config.int_bt_fm.sample_rate = dai_data->rate;
  2111. dai_data->port_config.int_bt_fm.bit_width = 16;
  2112. return 0;
  2113. }
  2114. static int msm_dai_q6_afe_rtproxy_hw_params(struct snd_pcm_hw_params *params,
  2115. struct snd_soc_dai *dai)
  2116. {
  2117. struct msm_dai_q6_dai_data *dai_data = dev_get_drvdata(dai->dev);
  2118. dai_data->rate = params_rate(params);
  2119. dai_data->port_config.rtproxy.num_channels = params_channels(params);
  2120. dai_data->port_config.rtproxy.sample_rate = params_rate(params);
  2121. pr_debug("channel %d entered,dai_id: %d,rate: %d\n",
  2122. dai_data->port_config.rtproxy.num_channels, dai->id, dai_data->rate);
  2123. dai_data->port_config.rtproxy.rt_proxy_cfg_minor_version =
  2124. AFE_API_VERSION_RT_PROXY_CONFIG;
  2125. dai_data->port_config.rtproxy.bit_width = 16; /* Q6 only supports 16 */
  2126. dai_data->port_config.rtproxy.interleaved = 1;
  2127. dai_data->port_config.rtproxy.frame_size = params_period_bytes(params);
  2128. dai_data->port_config.rtproxy.jitter_allowance =
  2129. dai_data->port_config.rtproxy.frame_size/2;
  2130. dai_data->port_config.rtproxy.low_water_mark = 0;
  2131. dai_data->port_config.rtproxy.high_water_mark = 0;
  2132. return 0;
  2133. }
  2134. static int msm_dai_q6_pseudo_port_hw_params(struct snd_pcm_hw_params *params,
  2135. struct snd_soc_dai *dai, int stream)
  2136. {
  2137. struct msm_dai_q6_dai_data *dai_data = dev_get_drvdata(dai->dev);
  2138. dai_data->channels = params_channels(params);
  2139. dai_data->rate = params_rate(params);
  2140. /* Q6 only supports 16 as now */
  2141. dai_data->port_config.pseudo_port.pseud_port_cfg_minor_version =
  2142. AFE_API_VERSION_PSEUDO_PORT_CONFIG;
  2143. dai_data->port_config.pseudo_port.num_channels =
  2144. params_channels(params);
  2145. dai_data->port_config.pseudo_port.bit_width = 16;
  2146. dai_data->port_config.pseudo_port.data_format = 0;
  2147. dai_data->port_config.pseudo_port.timing_mode =
  2148. AFE_PSEUDOPORT_TIMING_MODE_TIMER;
  2149. dai_data->port_config.pseudo_port.sample_rate = params_rate(params);
  2150. dev_dbg(dai->dev, "%s: bit_wd[%hu] num_channels [%hu] format[%hu]\n"
  2151. "timing Mode %hu sample_rate %d\n", __func__,
  2152. dai_data->port_config.pseudo_port.bit_width,
  2153. dai_data->port_config.pseudo_port.num_channels,
  2154. dai_data->port_config.pseudo_port.data_format,
  2155. dai_data->port_config.pseudo_port.timing_mode,
  2156. dai_data->port_config.pseudo_port.sample_rate);
  2157. return 0;
  2158. }
  2159. /* Current implementation assumes hw_param is called once
  2160. * This may not be the case but what to do when ADM and AFE
  2161. * port are already opened and parameter changes
  2162. */
  2163. static int msm_dai_q6_hw_params(struct snd_pcm_substream *substream,
  2164. struct snd_pcm_hw_params *params,
  2165. struct snd_soc_dai *dai)
  2166. {
  2167. int rc = 0;
  2168. switch (dai->id) {
  2169. case PRIMARY_I2S_TX:
  2170. case PRIMARY_I2S_RX:
  2171. case SECONDARY_I2S_RX:
  2172. rc = msm_dai_q6_cdc_hw_params(params, dai, substream->stream);
  2173. break;
  2174. case MI2S_RX:
  2175. rc = msm_dai_q6_i2s_hw_params(params, dai, substream->stream);
  2176. break;
  2177. case SLIMBUS_0_RX:
  2178. case SLIMBUS_1_RX:
  2179. case SLIMBUS_2_RX:
  2180. case SLIMBUS_3_RX:
  2181. case SLIMBUS_4_RX:
  2182. case SLIMBUS_5_RX:
  2183. case SLIMBUS_6_RX:
  2184. case SLIMBUS_7_RX:
  2185. case SLIMBUS_8_RX:
  2186. case SLIMBUS_9_RX:
  2187. case SLIMBUS_0_TX:
  2188. case SLIMBUS_1_TX:
  2189. case SLIMBUS_2_TX:
  2190. case SLIMBUS_3_TX:
  2191. case SLIMBUS_4_TX:
  2192. case SLIMBUS_5_TX:
  2193. case SLIMBUS_6_TX:
  2194. case SLIMBUS_7_TX:
  2195. case SLIMBUS_8_TX:
  2196. case SLIMBUS_9_TX:
  2197. rc = msm_dai_q6_slim_bus_hw_params(params, dai,
  2198. substream->stream);
  2199. break;
  2200. case INT_BT_SCO_RX:
  2201. case INT_BT_SCO_TX:
  2202. case INT_BT_A2DP_RX:
  2203. case INT_FM_RX:
  2204. case INT_FM_TX:
  2205. rc = msm_dai_q6_bt_fm_hw_params(params, dai, substream->stream);
  2206. break;
  2207. case AFE_PORT_ID_USB_RX:
  2208. case AFE_PORT_ID_USB_TX:
  2209. rc = msm_dai_q6_usb_audio_hw_params(params, dai,
  2210. substream->stream);
  2211. break;
  2212. case RT_PROXY_DAI_001_TX:
  2213. case RT_PROXY_DAI_001_RX:
  2214. case RT_PROXY_DAI_002_TX:
  2215. case RT_PROXY_DAI_002_RX:
  2216. rc = msm_dai_q6_afe_rtproxy_hw_params(params, dai);
  2217. break;
  2218. case VOICE_PLAYBACK_TX:
  2219. case VOICE2_PLAYBACK_TX:
  2220. case VOICE_RECORD_RX:
  2221. case VOICE_RECORD_TX:
  2222. rc = msm_dai_q6_pseudo_port_hw_params(params,
  2223. dai, substream->stream);
  2224. break;
  2225. default:
  2226. dev_err(dai->dev, "invalid AFE port ID 0x%x\n", dai->id);
  2227. rc = -EINVAL;
  2228. break;
  2229. }
  2230. return rc;
  2231. }
  2232. static void msm_dai_q6_shutdown(struct snd_pcm_substream *substream,
  2233. struct snd_soc_dai *dai)
  2234. {
  2235. struct msm_dai_q6_dai_data *dai_data = dev_get_drvdata(dai->dev);
  2236. int rc = 0;
  2237. if (test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  2238. pr_debug("%s: stop pseudo port:%d\n", __func__, dai->id);
  2239. rc = afe_close(dai->id); /* can block */
  2240. if (rc < 0)
  2241. dev_err(dai->dev, "fail to close AFE port\n");
  2242. pr_debug("%s: dai_data->status_mask = %ld\n", __func__,
  2243. *dai_data->status_mask);
  2244. clear_bit(STATUS_PORT_STARTED, dai_data->status_mask);
  2245. }
  2246. }
  2247. static int msm_dai_q6_cdc_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
  2248. {
  2249. struct msm_dai_q6_dai_data *dai_data = dev_get_drvdata(dai->dev);
  2250. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  2251. case SND_SOC_DAIFMT_CBS_CFS:
  2252. dai_data->port_config.i2s.ws_src = 1; /* CPU is master */
  2253. break;
  2254. case SND_SOC_DAIFMT_CBM_CFM:
  2255. dai_data->port_config.i2s.ws_src = 0; /* CPU is slave */
  2256. break;
  2257. default:
  2258. pr_err("%s: fmt 0x%x\n",
  2259. __func__, fmt & SND_SOC_DAIFMT_MASTER_MASK);
  2260. return -EINVAL;
  2261. }
  2262. return 0;
  2263. }
  2264. static int msm_dai_q6_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
  2265. {
  2266. int rc = 0;
  2267. dev_dbg(dai->dev, "%s: id = %d fmt[%d]\n", __func__,
  2268. dai->id, fmt);
  2269. switch (dai->id) {
  2270. case PRIMARY_I2S_TX:
  2271. case PRIMARY_I2S_RX:
  2272. case MI2S_RX:
  2273. case SECONDARY_I2S_RX:
  2274. rc = msm_dai_q6_cdc_set_fmt(dai, fmt);
  2275. break;
  2276. default:
  2277. dev_err(dai->dev, "invalid cpu_dai id 0x%x\n", dai->id);
  2278. rc = -EINVAL;
  2279. break;
  2280. }
  2281. return rc;
  2282. }
  2283. static int msm_dai_q6_set_channel_map(struct snd_soc_dai *dai,
  2284. unsigned int tx_num, unsigned int *tx_slot,
  2285. unsigned int rx_num, unsigned int *rx_slot)
  2286. {
  2287. int rc = 0;
  2288. struct msm_dai_q6_dai_data *dai_data = dev_get_drvdata(dai->dev);
  2289. unsigned int i = 0;
  2290. dev_dbg(dai->dev, "%s: id = %d\n", __func__, dai->id);
  2291. switch (dai->id) {
  2292. case SLIMBUS_0_RX:
  2293. case SLIMBUS_1_RX:
  2294. case SLIMBUS_2_RX:
  2295. case SLIMBUS_3_RX:
  2296. case SLIMBUS_4_RX:
  2297. case SLIMBUS_5_RX:
  2298. case SLIMBUS_6_RX:
  2299. case SLIMBUS_7_RX:
  2300. case SLIMBUS_8_RX:
  2301. case SLIMBUS_9_RX:
  2302. /*
  2303. * channel number to be between 128 and 255.
  2304. * For RX port use channel numbers
  2305. * from 138 to 144 for pre-Taiko
  2306. * from 144 to 159 for Taiko
  2307. */
  2308. if (!rx_slot) {
  2309. pr_err("%s: rx slot not found\n", __func__);
  2310. return -EINVAL;
  2311. }
  2312. if (rx_num > AFE_PORT_MAX_AUDIO_CHAN_CNT) {
  2313. pr_err("%s: invalid rx num %d\n", __func__, rx_num);
  2314. return -EINVAL;
  2315. }
  2316. for (i = 0; i < rx_num; i++) {
  2317. dai_data->port_config.slim_sch.shared_ch_mapping[i] =
  2318. rx_slot[i];
  2319. pr_debug("%s: find number of channels[%d] ch[%d]\n",
  2320. __func__, i, rx_slot[i]);
  2321. }
  2322. dai_data->port_config.slim_sch.num_channels = rx_num;
  2323. pr_debug("%s: SLIMBUS_%d_RX cnt[%d] ch[%d %d]\n", __func__,
  2324. (dai->id - SLIMBUS_0_RX) / 2, rx_num,
  2325. dai_data->port_config.slim_sch.shared_ch_mapping[0],
  2326. dai_data->port_config.slim_sch.shared_ch_mapping[1]);
  2327. break;
  2328. case SLIMBUS_0_TX:
  2329. case SLIMBUS_1_TX:
  2330. case SLIMBUS_2_TX:
  2331. case SLIMBUS_3_TX:
  2332. case SLIMBUS_4_TX:
  2333. case SLIMBUS_5_TX:
  2334. case SLIMBUS_6_TX:
  2335. case SLIMBUS_7_TX:
  2336. case SLIMBUS_8_TX:
  2337. case SLIMBUS_9_TX:
  2338. /*
  2339. * channel number to be between 128 and 255.
  2340. * For TX port use channel numbers
  2341. * from 128 to 137 for pre-Taiko
  2342. * from 128 to 143 for Taiko
  2343. */
  2344. if (!tx_slot) {
  2345. pr_err("%s: tx slot not found\n", __func__);
  2346. return -EINVAL;
  2347. }
  2348. if (tx_num > AFE_PORT_MAX_AUDIO_CHAN_CNT) {
  2349. pr_err("%s: invalid tx num %d\n", __func__, tx_num);
  2350. return -EINVAL;
  2351. }
  2352. for (i = 0; i < tx_num; i++) {
  2353. dai_data->port_config.slim_sch.shared_ch_mapping[i] =
  2354. tx_slot[i];
  2355. pr_debug("%s: find number of channels[%d] ch[%d]\n",
  2356. __func__, i, tx_slot[i]);
  2357. }
  2358. dai_data->port_config.slim_sch.num_channels = tx_num;
  2359. pr_debug("%s:SLIMBUS_%d_TX cnt[%d] ch[%d %d]\n", __func__,
  2360. (dai->id - SLIMBUS_0_TX) / 2, tx_num,
  2361. dai_data->port_config.slim_sch.shared_ch_mapping[0],
  2362. dai_data->port_config.slim_sch.shared_ch_mapping[1]);
  2363. break;
  2364. default:
  2365. dev_err(dai->dev, "invalid cpu_dai id 0x%x\n", dai->id);
  2366. rc = -EINVAL;
  2367. break;
  2368. }
  2369. return rc;
  2370. }
  2371. static struct snd_soc_dai_ops msm_dai_q6_ops = {
  2372. .prepare = msm_dai_q6_prepare,
  2373. .hw_params = msm_dai_q6_hw_params,
  2374. .shutdown = msm_dai_q6_shutdown,
  2375. .set_fmt = msm_dai_q6_set_fmt,
  2376. .set_channel_map = msm_dai_q6_set_channel_map,
  2377. };
  2378. static int msm_dai_q6_cal_info_put(struct snd_kcontrol *kcontrol,
  2379. struct snd_ctl_elem_value *ucontrol)
  2380. {
  2381. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2382. u16 port_id = ((struct soc_enum *)
  2383. kcontrol->private_value)->reg;
  2384. dai_data->cal_mode = ucontrol->value.integer.value[0];
  2385. pr_debug("%s: setting cal_mode to %d\n",
  2386. __func__, dai_data->cal_mode);
  2387. afe_set_cal_mode(port_id, dai_data->cal_mode);
  2388. return 0;
  2389. }
  2390. static int msm_dai_q6_cal_info_get(struct snd_kcontrol *kcontrol,
  2391. struct snd_ctl_elem_value *ucontrol)
  2392. {
  2393. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2394. ucontrol->value.integer.value[0] = dai_data->cal_mode;
  2395. return 0;
  2396. }
  2397. static int msm_dai_q6_sb_format_put(struct snd_kcontrol *kcontrol,
  2398. struct snd_ctl_elem_value *ucontrol)
  2399. {
  2400. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2401. int value = ucontrol->value.integer.value[0];
  2402. if (dai_data) {
  2403. dai_data->port_config.slim_sch.data_format = value;
  2404. pr_debug("%s: format = %d\n", __func__, value);
  2405. }
  2406. return 0;
  2407. }
  2408. static int msm_dai_q6_sb_format_get(struct snd_kcontrol *kcontrol,
  2409. struct snd_ctl_elem_value *ucontrol)
  2410. {
  2411. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2412. if (dai_data)
  2413. ucontrol->value.integer.value[0] =
  2414. dai_data->port_config.slim_sch.data_format;
  2415. return 0;
  2416. }
  2417. static int msm_dai_q6_usb_audio_cfg_put(struct snd_kcontrol *kcontrol,
  2418. struct snd_ctl_elem_value *ucontrol)
  2419. {
  2420. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2421. u32 val = ucontrol->value.integer.value[0];
  2422. if (dai_data) {
  2423. dai_data->port_config.usb_audio.dev_token = val;
  2424. pr_debug("%s: dev_token = 0x%x\n", __func__,
  2425. dai_data->port_config.usb_audio.dev_token);
  2426. } else {
  2427. pr_err("%s: dai_data is NULL\n", __func__);
  2428. }
  2429. return 0;
  2430. }
  2431. static int msm_dai_q6_usb_audio_cfg_get(struct snd_kcontrol *kcontrol,
  2432. struct snd_ctl_elem_value *ucontrol)
  2433. {
  2434. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2435. if (dai_data) {
  2436. ucontrol->value.integer.value[0] =
  2437. dai_data->port_config.usb_audio.dev_token;
  2438. pr_debug("%s: dev_token = 0x%x\n", __func__,
  2439. dai_data->port_config.usb_audio.dev_token);
  2440. } else {
  2441. pr_err("%s: dai_data is NULL\n", __func__);
  2442. }
  2443. return 0;
  2444. }
  2445. static int msm_dai_q6_usb_audio_endian_cfg_put(struct snd_kcontrol *kcontrol,
  2446. struct snd_ctl_elem_value *ucontrol)
  2447. {
  2448. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2449. u32 val = ucontrol->value.integer.value[0];
  2450. if (dai_data) {
  2451. dai_data->port_config.usb_audio.endian = val;
  2452. pr_debug("%s: endian = 0x%x\n", __func__,
  2453. dai_data->port_config.usb_audio.endian);
  2454. } else {
  2455. pr_err("%s: dai_data is NULL\n", __func__);
  2456. return -EINVAL;
  2457. }
  2458. return 0;
  2459. }
  2460. static int msm_dai_q6_usb_audio_endian_cfg_get(struct snd_kcontrol *kcontrol,
  2461. struct snd_ctl_elem_value *ucontrol)
  2462. {
  2463. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2464. if (dai_data) {
  2465. ucontrol->value.integer.value[0] =
  2466. dai_data->port_config.usb_audio.endian;
  2467. pr_debug("%s: endian = 0x%x\n", __func__,
  2468. dai_data->port_config.usb_audio.endian);
  2469. } else {
  2470. pr_err("%s: dai_data is NULL\n", __func__);
  2471. return -EINVAL;
  2472. }
  2473. return 0;
  2474. }
  2475. static int msm_dai_q6_usb_audio_svc_interval_put(struct snd_kcontrol *kcontrol,
  2476. struct snd_ctl_elem_value *ucontrol)
  2477. {
  2478. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2479. u32 val = ucontrol->value.integer.value[0];
  2480. if (!dai_data) {
  2481. pr_err("%s: dai_data is NULL\n", __func__);
  2482. return -EINVAL;
  2483. }
  2484. dai_data->port_config.usb_audio.service_interval = val;
  2485. pr_debug("%s: new service interval = %u\n", __func__,
  2486. dai_data->port_config.usb_audio.service_interval);
  2487. return 0;
  2488. }
  2489. static int msm_dai_q6_usb_audio_svc_interval_get(struct snd_kcontrol *kcontrol,
  2490. struct snd_ctl_elem_value *ucontrol)
  2491. {
  2492. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2493. if (!dai_data) {
  2494. pr_err("%s: dai_data is NULL\n", __func__);
  2495. return -EINVAL;
  2496. }
  2497. ucontrol->value.integer.value[0] =
  2498. dai_data->port_config.usb_audio.service_interval;
  2499. pr_debug("%s: service interval = %d\n", __func__,
  2500. dai_data->port_config.usb_audio.service_interval);
  2501. return 0;
  2502. }
  2503. static int msm_dai_q6_afe_enc_cfg_info(struct snd_kcontrol *kcontrol,
  2504. struct snd_ctl_elem_info *uinfo)
  2505. {
  2506. uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
  2507. uinfo->count = sizeof(struct afe_enc_config);
  2508. return 0;
  2509. }
  2510. static int msm_dai_q6_afe_enc_cfg_get(struct snd_kcontrol *kcontrol,
  2511. struct snd_ctl_elem_value *ucontrol)
  2512. {
  2513. int ret = 0;
  2514. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2515. if (dai_data) {
  2516. int format_size = sizeof(dai_data->enc_config.format);
  2517. pr_debug("%s: encoder config for %d format\n",
  2518. __func__, dai_data->enc_config.format);
  2519. memcpy(ucontrol->value.bytes.data,
  2520. &dai_data->enc_config.format,
  2521. format_size);
  2522. switch (dai_data->enc_config.format) {
  2523. case ENC_FMT_SBC:
  2524. memcpy(ucontrol->value.bytes.data + format_size,
  2525. &dai_data->enc_config.data,
  2526. sizeof(struct asm_sbc_enc_cfg_t));
  2527. break;
  2528. case ENC_FMT_AAC_V2:
  2529. memcpy(ucontrol->value.bytes.data + format_size,
  2530. &dai_data->enc_config.data,
  2531. sizeof(struct asm_aac_enc_cfg_v2_t));
  2532. break;
  2533. case ENC_FMT_APTX:
  2534. memcpy(ucontrol->value.bytes.data + format_size,
  2535. &dai_data->enc_config.data,
  2536. sizeof(struct asm_aptx_enc_cfg_t));
  2537. break;
  2538. case ENC_FMT_APTX_HD:
  2539. memcpy(ucontrol->value.bytes.data + format_size,
  2540. &dai_data->enc_config.data,
  2541. sizeof(struct asm_custom_enc_cfg_t));
  2542. break;
  2543. case ENC_FMT_CELT:
  2544. memcpy(ucontrol->value.bytes.data + format_size,
  2545. &dai_data->enc_config.data,
  2546. sizeof(struct asm_celt_enc_cfg_t));
  2547. break;
  2548. case ENC_FMT_LDAC:
  2549. memcpy(ucontrol->value.bytes.data + format_size,
  2550. &dai_data->enc_config.data,
  2551. sizeof(struct asm_ldac_enc_cfg_t));
  2552. break;
  2553. case ENC_FMT_APTX_ADAPTIVE:
  2554. memcpy(ucontrol->value.bytes.data + format_size,
  2555. &dai_data->enc_config.data,
  2556. sizeof(struct asm_aptx_ad_enc_cfg_t));
  2557. break;
  2558. default:
  2559. pr_debug("%s: unknown format = %d\n",
  2560. __func__, dai_data->enc_config.format);
  2561. ret = -EINVAL;
  2562. break;
  2563. }
  2564. }
  2565. return ret;
  2566. }
  2567. static int msm_dai_q6_afe_enc_cfg_put(struct snd_kcontrol *kcontrol,
  2568. struct snd_ctl_elem_value *ucontrol)
  2569. {
  2570. int ret = 0;
  2571. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2572. if (dai_data) {
  2573. int format_size = sizeof(dai_data->enc_config.format);
  2574. memset(&dai_data->enc_config, 0x0,
  2575. sizeof(struct afe_enc_config));
  2576. memcpy(&dai_data->enc_config.format,
  2577. ucontrol->value.bytes.data,
  2578. format_size);
  2579. pr_debug("%s: Received encoder config for %d format\n",
  2580. __func__, dai_data->enc_config.format);
  2581. switch (dai_data->enc_config.format) {
  2582. case ENC_FMT_SBC:
  2583. memcpy(&dai_data->enc_config.data,
  2584. ucontrol->value.bytes.data + format_size,
  2585. sizeof(struct asm_sbc_enc_cfg_t));
  2586. break;
  2587. case ENC_FMT_AAC_V2:
  2588. memcpy(&dai_data->enc_config.data,
  2589. ucontrol->value.bytes.data + format_size,
  2590. sizeof(struct asm_aac_enc_cfg_v2_t));
  2591. break;
  2592. case ENC_FMT_APTX:
  2593. memcpy(&dai_data->enc_config.data,
  2594. ucontrol->value.bytes.data + format_size,
  2595. sizeof(struct asm_aptx_enc_cfg_t));
  2596. break;
  2597. case ENC_FMT_APTX_HD:
  2598. memcpy(&dai_data->enc_config.data,
  2599. ucontrol->value.bytes.data + format_size,
  2600. sizeof(struct asm_custom_enc_cfg_t));
  2601. break;
  2602. case ENC_FMT_CELT:
  2603. memcpy(&dai_data->enc_config.data,
  2604. ucontrol->value.bytes.data + format_size,
  2605. sizeof(struct asm_celt_enc_cfg_t));
  2606. break;
  2607. case ENC_FMT_LDAC:
  2608. memcpy(&dai_data->enc_config.data,
  2609. ucontrol->value.bytes.data + format_size,
  2610. sizeof(struct asm_ldac_enc_cfg_t));
  2611. break;
  2612. case ENC_FMT_APTX_ADAPTIVE:
  2613. memcpy(&dai_data->enc_config.data,
  2614. ucontrol->value.bytes.data + format_size,
  2615. sizeof(struct asm_aptx_ad_enc_cfg_t));
  2616. break;
  2617. default:
  2618. pr_debug("%s: Ignore enc config for unknown format = %d\n",
  2619. __func__, dai_data->enc_config.format);
  2620. ret = -EINVAL;
  2621. break;
  2622. }
  2623. } else
  2624. ret = -EINVAL;
  2625. return ret;
  2626. }
  2627. static const char *const afe_chs_text[] = {"Zero", "One", "Two"};
  2628. static const struct soc_enum afe_chs_enum[] = {
  2629. SOC_ENUM_SINGLE_EXT(3, afe_chs_text),
  2630. };
  2631. static const char *const afe_bit_format_text[] = {"S16_LE", "S24_LE",
  2632. "S32_LE"};
  2633. static const struct soc_enum afe_bit_format_enum[] = {
  2634. SOC_ENUM_SINGLE_EXT(3, afe_bit_format_text),
  2635. };
  2636. static const char *const tws_chs_mode_text[] = {"Zero", "One", "Two"};
  2637. static const struct soc_enum tws_chs_mode_enum[] = {
  2638. SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(tws_chs_mode_text), tws_chs_mode_text),
  2639. };
  2640. static int msm_dai_q6_afe_input_channel_get(struct snd_kcontrol *kcontrol,
  2641. struct snd_ctl_elem_value *ucontrol)
  2642. {
  2643. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2644. if (dai_data) {
  2645. ucontrol->value.integer.value[0] = dai_data->afe_rx_in_channels;
  2646. pr_debug("%s:afe input channel = %d\n",
  2647. __func__, dai_data->afe_rx_in_channels);
  2648. }
  2649. return 0;
  2650. }
  2651. static int msm_dai_q6_afe_input_channel_put(struct snd_kcontrol *kcontrol,
  2652. struct snd_ctl_elem_value *ucontrol)
  2653. {
  2654. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2655. if (dai_data) {
  2656. dai_data->afe_rx_in_channels = ucontrol->value.integer.value[0];
  2657. pr_debug("%s: updating afe input channel : %d\n",
  2658. __func__, dai_data->afe_rx_in_channels);
  2659. }
  2660. return 0;
  2661. }
  2662. static int msm_dai_q6_tws_channel_mode_get(struct snd_kcontrol *kcontrol,
  2663. struct snd_ctl_elem_value *ucontrol)
  2664. {
  2665. struct snd_soc_dai *dai = kcontrol->private_data;
  2666. struct msm_dai_q6_dai_data *dai_data = NULL;
  2667. if (dai)
  2668. dai_data = dev_get_drvdata(dai->dev);
  2669. if (dai_data) {
  2670. ucontrol->value.integer.value[0] =
  2671. dai_data->enc_config.mono_mode;
  2672. pr_debug("%s:tws channel mode = %d\n",
  2673. __func__, dai_data->enc_config.mono_mode);
  2674. }
  2675. return 0;
  2676. }
  2677. static int msm_dai_q6_tws_channel_mode_put(struct snd_kcontrol *kcontrol,
  2678. struct snd_ctl_elem_value *ucontrol)
  2679. {
  2680. struct snd_soc_dai *dai = kcontrol->private_data;
  2681. struct msm_dai_q6_dai_data *dai_data = NULL;
  2682. int ret = 0;
  2683. if (dai)
  2684. dai_data = dev_get_drvdata(dai->dev);
  2685. if (dai_data && (dai_data->enc_config.format == ENC_FMT_APTX)) {
  2686. if (test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  2687. ret = afe_set_tws_channel_mode(dai->id,
  2688. ucontrol->value.integer.value[0]);
  2689. if (ret < 0) {
  2690. pr_err("%s: channel mode setting failed for TWS\n",
  2691. __func__);
  2692. goto exit;
  2693. } else {
  2694. pr_debug("%s: updating tws channel mode : %d\n",
  2695. __func__, dai_data->enc_config.mono_mode);
  2696. }
  2697. }
  2698. if (ucontrol->value.integer.value[0] ==
  2699. MSM_DAI_TWS_CHANNEL_MODE_ONE ||
  2700. ucontrol->value.integer.value[0] ==
  2701. MSM_DAI_TWS_CHANNEL_MODE_TWO)
  2702. dai_data->enc_config.mono_mode =
  2703. ucontrol->value.integer.value[0];
  2704. else
  2705. return -EINVAL;
  2706. }
  2707. exit:
  2708. return ret;
  2709. }
  2710. static int msm_dai_q6_afe_input_bit_format_get(
  2711. struct snd_kcontrol *kcontrol,
  2712. struct snd_ctl_elem_value *ucontrol)
  2713. {
  2714. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2715. if (!dai_data) {
  2716. pr_err("%s: Invalid dai data\n", __func__);
  2717. return -EINVAL;
  2718. }
  2719. switch (dai_data->afe_rx_in_bitformat) {
  2720. case SNDRV_PCM_FORMAT_S32_LE:
  2721. ucontrol->value.integer.value[0] = 2;
  2722. break;
  2723. case SNDRV_PCM_FORMAT_S24_LE:
  2724. ucontrol->value.integer.value[0] = 1;
  2725. break;
  2726. case SNDRV_PCM_FORMAT_S16_LE:
  2727. default:
  2728. ucontrol->value.integer.value[0] = 0;
  2729. break;
  2730. }
  2731. pr_debug("%s: afe input bit format : %ld\n",
  2732. __func__, ucontrol->value.integer.value[0]);
  2733. return 0;
  2734. }
  2735. static int msm_dai_q6_afe_input_bit_format_put(
  2736. struct snd_kcontrol *kcontrol,
  2737. struct snd_ctl_elem_value *ucontrol)
  2738. {
  2739. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2740. if (!dai_data) {
  2741. pr_err("%s: Invalid dai data\n", __func__);
  2742. return -EINVAL;
  2743. }
  2744. switch (ucontrol->value.integer.value[0]) {
  2745. case 2:
  2746. dai_data->afe_rx_in_bitformat = SNDRV_PCM_FORMAT_S32_LE;
  2747. break;
  2748. case 1:
  2749. dai_data->afe_rx_in_bitformat = SNDRV_PCM_FORMAT_S24_LE;
  2750. break;
  2751. case 0:
  2752. default:
  2753. dai_data->afe_rx_in_bitformat = SNDRV_PCM_FORMAT_S16_LE;
  2754. break;
  2755. }
  2756. pr_debug("%s: updating afe input bit format : %d\n",
  2757. __func__, dai_data->afe_rx_in_bitformat);
  2758. return 0;
  2759. }
  2760. static int msm_dai_q6_afe_output_bit_format_get(
  2761. struct snd_kcontrol *kcontrol,
  2762. struct snd_ctl_elem_value *ucontrol)
  2763. {
  2764. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2765. if (!dai_data) {
  2766. pr_err("%s: Invalid dai data\n", __func__);
  2767. return -EINVAL;
  2768. }
  2769. switch (dai_data->afe_tx_out_bitformat) {
  2770. case SNDRV_PCM_FORMAT_S32_LE:
  2771. ucontrol->value.integer.value[0] = 2;
  2772. break;
  2773. case SNDRV_PCM_FORMAT_S24_LE:
  2774. ucontrol->value.integer.value[0] = 1;
  2775. break;
  2776. case SNDRV_PCM_FORMAT_S16_LE:
  2777. default:
  2778. ucontrol->value.integer.value[0] = 0;
  2779. break;
  2780. }
  2781. pr_debug("%s: afe output bit format : %ld\n",
  2782. __func__, ucontrol->value.integer.value[0]);
  2783. return 0;
  2784. }
  2785. static int msm_dai_q6_afe_output_bit_format_put(
  2786. struct snd_kcontrol *kcontrol,
  2787. struct snd_ctl_elem_value *ucontrol)
  2788. {
  2789. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2790. if (!dai_data) {
  2791. pr_err("%s: Invalid dai data\n", __func__);
  2792. return -EINVAL;
  2793. }
  2794. switch (ucontrol->value.integer.value[0]) {
  2795. case 2:
  2796. dai_data->afe_tx_out_bitformat = SNDRV_PCM_FORMAT_S32_LE;
  2797. break;
  2798. case 1:
  2799. dai_data->afe_tx_out_bitformat = SNDRV_PCM_FORMAT_S24_LE;
  2800. break;
  2801. case 0:
  2802. default:
  2803. dai_data->afe_tx_out_bitformat = SNDRV_PCM_FORMAT_S16_LE;
  2804. break;
  2805. }
  2806. pr_debug("%s: updating afe output bit format : %d\n",
  2807. __func__, dai_data->afe_tx_out_bitformat);
  2808. return 0;
  2809. }
  2810. static int msm_dai_q6_afe_output_channel_get(struct snd_kcontrol *kcontrol,
  2811. struct snd_ctl_elem_value *ucontrol)
  2812. {
  2813. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2814. if (dai_data) {
  2815. ucontrol->value.integer.value[0] =
  2816. dai_data->afe_tx_out_channels;
  2817. pr_debug("%s:afe output channel = %d\n",
  2818. __func__, dai_data->afe_tx_out_channels);
  2819. }
  2820. return 0;
  2821. }
  2822. static int msm_dai_q6_afe_output_channel_put(struct snd_kcontrol *kcontrol,
  2823. struct snd_ctl_elem_value *ucontrol)
  2824. {
  2825. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2826. if (dai_data) {
  2827. dai_data->afe_tx_out_channels =
  2828. ucontrol->value.integer.value[0];
  2829. pr_debug("%s: updating afe output channel : %d\n",
  2830. __func__, dai_data->afe_tx_out_channels);
  2831. }
  2832. return 0;
  2833. }
  2834. static int msm_dai_q6_afe_scrambler_mode_get(
  2835. struct snd_kcontrol *kcontrol,
  2836. struct snd_ctl_elem_value *ucontrol)
  2837. {
  2838. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2839. if (!dai_data) {
  2840. pr_err("%s: Invalid dai data\n", __func__);
  2841. return -EINVAL;
  2842. }
  2843. ucontrol->value.integer.value[0] = dai_data->enc_config.scrambler_mode;
  2844. return 0;
  2845. }
  2846. static int msm_dai_q6_afe_scrambler_mode_put(
  2847. struct snd_kcontrol *kcontrol,
  2848. struct snd_ctl_elem_value *ucontrol)
  2849. {
  2850. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2851. if (!dai_data) {
  2852. pr_err("%s: Invalid dai data\n", __func__);
  2853. return -EINVAL;
  2854. }
  2855. dai_data->enc_config.scrambler_mode = ucontrol->value.integer.value[0];
  2856. pr_debug("%s: afe scrambler mode : %d\n",
  2857. __func__, dai_data->enc_config.scrambler_mode);
  2858. return 0;
  2859. }
  2860. static const struct snd_kcontrol_new afe_enc_config_controls[] = {
  2861. {
  2862. .access = (SNDRV_CTL_ELEM_ACCESS_READWRITE |
  2863. SNDRV_CTL_ELEM_ACCESS_INACTIVE),
  2864. .iface = SNDRV_CTL_ELEM_IFACE_PCM,
  2865. .name = "SLIM_7_RX Encoder Config",
  2866. .info = msm_dai_q6_afe_enc_cfg_info,
  2867. .get = msm_dai_q6_afe_enc_cfg_get,
  2868. .put = msm_dai_q6_afe_enc_cfg_put,
  2869. },
  2870. SOC_ENUM_EXT("AFE Input Channels", afe_chs_enum[0],
  2871. msm_dai_q6_afe_input_channel_get,
  2872. msm_dai_q6_afe_input_channel_put),
  2873. SOC_ENUM_EXT("AFE Input Bit Format", afe_bit_format_enum[0],
  2874. msm_dai_q6_afe_input_bit_format_get,
  2875. msm_dai_q6_afe_input_bit_format_put),
  2876. SOC_SINGLE_EXT("AFE Scrambler Mode",
  2877. 0, 0, 1, 0,
  2878. msm_dai_q6_afe_scrambler_mode_get,
  2879. msm_dai_q6_afe_scrambler_mode_put),
  2880. SOC_ENUM_EXT("TWS Channel Mode", tws_chs_mode_enum[0],
  2881. msm_dai_q6_tws_channel_mode_get,
  2882. msm_dai_q6_tws_channel_mode_put)
  2883. };
  2884. static int msm_dai_q6_afe_dec_cfg_info(struct snd_kcontrol *kcontrol,
  2885. struct snd_ctl_elem_info *uinfo)
  2886. {
  2887. uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
  2888. uinfo->count = sizeof(struct afe_dec_config);
  2889. return 0;
  2890. }
  2891. static int msm_dai_q6_afe_dec_cfg_get(struct snd_kcontrol *kcontrol,
  2892. struct snd_ctl_elem_value *ucontrol)
  2893. {
  2894. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2895. u32 format_size = 0;
  2896. if (!dai_data) {
  2897. pr_err("%s: Invalid dai data\n", __func__);
  2898. return -EINVAL;
  2899. }
  2900. format_size = sizeof(dai_data->dec_config.format);
  2901. memcpy(ucontrol->value.bytes.data,
  2902. &dai_data->dec_config.format,
  2903. format_size);
  2904. switch (dai_data->dec_config.format) {
  2905. case DEC_FMT_AAC_V2:
  2906. memcpy(ucontrol->value.bytes.data + format_size,
  2907. &dai_data->dec_config.data,
  2908. sizeof(struct asm_aac_dec_cfg_v2_t));
  2909. break;
  2910. case DEC_FMT_SBC:
  2911. case DEC_FMT_MP3:
  2912. /* No decoder specific data available */
  2913. break;
  2914. default:
  2915. pr_debug("%s: Default decoder config for %d format: Expect abr_dec_cfg\n",
  2916. __func__, dai_data->dec_config.format);
  2917. memcpy(ucontrol->value.bytes.data + format_size,
  2918. &dai_data->dec_config.abr_dec_cfg,
  2919. sizeof(struct afe_abr_dec_cfg_t));
  2920. break;
  2921. }
  2922. return 0;
  2923. }
  2924. static int msm_dai_q6_afe_dec_cfg_put(struct snd_kcontrol *kcontrol,
  2925. struct snd_ctl_elem_value *ucontrol)
  2926. {
  2927. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  2928. u32 format_size = 0;
  2929. if (!dai_data) {
  2930. pr_err("%s: Invalid dai data\n", __func__);
  2931. return -EINVAL;
  2932. }
  2933. memset(&dai_data->dec_config, 0x0,
  2934. sizeof(struct afe_dec_config));
  2935. format_size = sizeof(dai_data->dec_config.format);
  2936. memcpy(&dai_data->dec_config.format,
  2937. ucontrol->value.bytes.data,
  2938. format_size);
  2939. pr_debug("%s: Received decoder config for %d format\n",
  2940. __func__, dai_data->dec_config.format);
  2941. switch (dai_data->dec_config.format) {
  2942. case DEC_FMT_AAC_V2:
  2943. memcpy(&dai_data->dec_config.data,
  2944. ucontrol->value.bytes.data + format_size,
  2945. sizeof(struct asm_aac_dec_cfg_v2_t));
  2946. break;
  2947. case DEC_FMT_SBC:
  2948. memcpy(&dai_data->dec_config.data,
  2949. ucontrol->value.bytes.data + format_size,
  2950. sizeof(struct asm_sbc_dec_cfg_t));
  2951. break;
  2952. default:
  2953. pr_debug("%s: Default decoder config for %d format: Expect abr_dec_cfg\n",
  2954. __func__, dai_data->dec_config.format);
  2955. memcpy(&dai_data->dec_config.abr_dec_cfg,
  2956. ucontrol->value.bytes.data + format_size,
  2957. sizeof(struct afe_abr_dec_cfg_t));
  2958. break;
  2959. }
  2960. return 0;
  2961. }
  2962. static const struct snd_kcontrol_new afe_dec_config_controls[] = {
  2963. {
  2964. .access = (SNDRV_CTL_ELEM_ACCESS_READWRITE |
  2965. SNDRV_CTL_ELEM_ACCESS_INACTIVE),
  2966. .iface = SNDRV_CTL_ELEM_IFACE_PCM,
  2967. .name = "SLIM_7_TX Decoder Config",
  2968. .info = msm_dai_q6_afe_dec_cfg_info,
  2969. .get = msm_dai_q6_afe_dec_cfg_get,
  2970. .put = msm_dai_q6_afe_dec_cfg_put,
  2971. },
  2972. {
  2973. .access = (SNDRV_CTL_ELEM_ACCESS_READWRITE |
  2974. SNDRV_CTL_ELEM_ACCESS_INACTIVE),
  2975. .iface = SNDRV_CTL_ELEM_IFACE_PCM,
  2976. .name = "SLIM_9_TX Decoder Config",
  2977. .info = msm_dai_q6_afe_dec_cfg_info,
  2978. .get = msm_dai_q6_afe_dec_cfg_get,
  2979. .put = msm_dai_q6_afe_dec_cfg_put,
  2980. },
  2981. SOC_ENUM_EXT("AFE Output Channels", afe_chs_enum[0],
  2982. msm_dai_q6_afe_output_channel_get,
  2983. msm_dai_q6_afe_output_channel_put),
  2984. SOC_ENUM_EXT("AFE Output Bit Format", afe_bit_format_enum[0],
  2985. msm_dai_q6_afe_output_bit_format_get,
  2986. msm_dai_q6_afe_output_bit_format_put),
  2987. };
  2988. static int msm_dai_q6_slim_rx_drift_info(struct snd_kcontrol *kcontrol,
  2989. struct snd_ctl_elem_info *uinfo)
  2990. {
  2991. uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
  2992. uinfo->count = sizeof(struct afe_param_id_dev_timing_stats);
  2993. return 0;
  2994. }
  2995. static int msm_dai_q6_slim_rx_drift_get(struct snd_kcontrol *kcontrol,
  2996. struct snd_ctl_elem_value *ucontrol)
  2997. {
  2998. int ret = -EINVAL;
  2999. struct afe_param_id_dev_timing_stats timing_stats;
  3000. struct snd_soc_dai *dai = kcontrol->private_data;
  3001. struct msm_dai_q6_dai_data *dai_data = dev_get_drvdata(dai->dev);
  3002. if (!test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  3003. pr_debug("%s: afe port not started. dai_data->status_mask = %ld\n",
  3004. __func__, *dai_data->status_mask);
  3005. goto done;
  3006. }
  3007. memset(&timing_stats, 0, sizeof(struct afe_param_id_dev_timing_stats));
  3008. ret = afe_get_av_dev_drift(&timing_stats, dai->id);
  3009. if (ret) {
  3010. pr_err("%s: Error getting AFE Drift for port %d, err=%d\n",
  3011. __func__, dai->id, ret);
  3012. goto done;
  3013. }
  3014. memcpy(ucontrol->value.bytes.data, (void *)&timing_stats,
  3015. sizeof(struct afe_param_id_dev_timing_stats));
  3016. done:
  3017. return ret;
  3018. }
  3019. static const char * const afe_cal_mode_text[] = {
  3020. "CAL_MODE_DEFAULT", "CAL_MODE_NONE"
  3021. };
  3022. static const struct soc_enum slim_2_rx_enum =
  3023. SOC_ENUM_SINGLE(SLIMBUS_2_RX, 0, ARRAY_SIZE(afe_cal_mode_text),
  3024. afe_cal_mode_text);
  3025. static const struct soc_enum rt_proxy_1_rx_enum =
  3026. SOC_ENUM_SINGLE(RT_PROXY_PORT_001_RX, 0, ARRAY_SIZE(afe_cal_mode_text),
  3027. afe_cal_mode_text);
  3028. static const struct soc_enum rt_proxy_1_tx_enum =
  3029. SOC_ENUM_SINGLE(RT_PROXY_PORT_001_TX, 0, ARRAY_SIZE(afe_cal_mode_text),
  3030. afe_cal_mode_text);
  3031. static const struct snd_kcontrol_new sb_config_controls[] = {
  3032. SOC_ENUM_EXT("SLIM_4_TX Format", sb_config_enum[0],
  3033. msm_dai_q6_sb_format_get,
  3034. msm_dai_q6_sb_format_put),
  3035. SOC_ENUM_EXT("SLIM_2_RX SetCalMode", slim_2_rx_enum,
  3036. msm_dai_q6_cal_info_get,
  3037. msm_dai_q6_cal_info_put),
  3038. SOC_ENUM_EXT("SLIM_2_RX Format", sb_config_enum[0],
  3039. msm_dai_q6_sb_format_get,
  3040. msm_dai_q6_sb_format_put)
  3041. };
  3042. static const struct snd_kcontrol_new rt_proxy_config_controls[] = {
  3043. SOC_ENUM_EXT("RT_PROXY_1_RX SetCalMode", rt_proxy_1_rx_enum,
  3044. msm_dai_q6_cal_info_get,
  3045. msm_dai_q6_cal_info_put),
  3046. SOC_ENUM_EXT("RT_PROXY_1_TX SetCalMode", rt_proxy_1_tx_enum,
  3047. msm_dai_q6_cal_info_get,
  3048. msm_dai_q6_cal_info_put),
  3049. };
  3050. static const struct snd_kcontrol_new usb_audio_cfg_controls[] = {
  3051. SOC_SINGLE_EXT("USB_AUDIO_RX dev_token", 0, 0, UINT_MAX, 0,
  3052. msm_dai_q6_usb_audio_cfg_get,
  3053. msm_dai_q6_usb_audio_cfg_put),
  3054. SOC_SINGLE_EXT("USB_AUDIO_RX endian", 0, 0, 1, 0,
  3055. msm_dai_q6_usb_audio_endian_cfg_get,
  3056. msm_dai_q6_usb_audio_endian_cfg_put),
  3057. SOC_SINGLE_EXT("USB_AUDIO_TX dev_token", 0, 0, UINT_MAX, 0,
  3058. msm_dai_q6_usb_audio_cfg_get,
  3059. msm_dai_q6_usb_audio_cfg_put),
  3060. SOC_SINGLE_EXT("USB_AUDIO_TX endian", 0, 0, 1, 0,
  3061. msm_dai_q6_usb_audio_endian_cfg_get,
  3062. msm_dai_q6_usb_audio_endian_cfg_put),
  3063. SOC_SINGLE_EXT("USB_AUDIO_RX service_interval", SND_SOC_NOPM, 0,
  3064. UINT_MAX, 0,
  3065. msm_dai_q6_usb_audio_svc_interval_get,
  3066. msm_dai_q6_usb_audio_svc_interval_put),
  3067. };
  3068. static const struct snd_kcontrol_new avd_drift_config_controls[] = {
  3069. {
  3070. .access = SNDRV_CTL_ELEM_ACCESS_READ,
  3071. .iface = SNDRV_CTL_ELEM_IFACE_PCM,
  3072. .name = "SLIMBUS_0_RX DRIFT",
  3073. .info = msm_dai_q6_slim_rx_drift_info,
  3074. .get = msm_dai_q6_slim_rx_drift_get,
  3075. },
  3076. {
  3077. .access = SNDRV_CTL_ELEM_ACCESS_READ,
  3078. .iface = SNDRV_CTL_ELEM_IFACE_PCM,
  3079. .name = "SLIMBUS_6_RX DRIFT",
  3080. .info = msm_dai_q6_slim_rx_drift_info,
  3081. .get = msm_dai_q6_slim_rx_drift_get,
  3082. },
  3083. {
  3084. .access = SNDRV_CTL_ELEM_ACCESS_READ,
  3085. .iface = SNDRV_CTL_ELEM_IFACE_PCM,
  3086. .name = "SLIMBUS_7_RX DRIFT",
  3087. .info = msm_dai_q6_slim_rx_drift_info,
  3088. .get = msm_dai_q6_slim_rx_drift_get,
  3089. },
  3090. };
  3091. static int msm_dai_q6_dai_probe(struct snd_soc_dai *dai)
  3092. {
  3093. struct msm_dai_q6_dai_data *dai_data;
  3094. int rc = 0;
  3095. if (!dai) {
  3096. pr_err("%s: Invalid params dai\n", __func__);
  3097. return -EINVAL;
  3098. }
  3099. if (!dai->dev) {
  3100. pr_err("%s: Invalid params dai dev\n", __func__);
  3101. return -EINVAL;
  3102. }
  3103. dai_data = kzalloc(sizeof(struct msm_dai_q6_dai_data), GFP_KERNEL);
  3104. if (!dai_data)
  3105. return -ENOMEM;
  3106. else
  3107. dev_set_drvdata(dai->dev, dai_data);
  3108. msm_dai_q6_set_dai_id(dai);
  3109. switch (dai->id) {
  3110. case SLIMBUS_4_TX:
  3111. rc = snd_ctl_add(dai->component->card->snd_card,
  3112. snd_ctl_new1(&sb_config_controls[0],
  3113. dai_data));
  3114. break;
  3115. case SLIMBUS_2_RX:
  3116. rc = snd_ctl_add(dai->component->card->snd_card,
  3117. snd_ctl_new1(&sb_config_controls[1],
  3118. dai_data));
  3119. rc = snd_ctl_add(dai->component->card->snd_card,
  3120. snd_ctl_new1(&sb_config_controls[2],
  3121. dai_data));
  3122. break;
  3123. case SLIMBUS_7_RX:
  3124. rc = snd_ctl_add(dai->component->card->snd_card,
  3125. snd_ctl_new1(&afe_enc_config_controls[0],
  3126. dai_data));
  3127. rc = snd_ctl_add(dai->component->card->snd_card,
  3128. snd_ctl_new1(&afe_enc_config_controls[1],
  3129. dai_data));
  3130. rc = snd_ctl_add(dai->component->card->snd_card,
  3131. snd_ctl_new1(&afe_enc_config_controls[2],
  3132. dai_data));
  3133. rc = snd_ctl_add(dai->component->card->snd_card,
  3134. snd_ctl_new1(&afe_enc_config_controls[3],
  3135. dai_data));
  3136. rc = snd_ctl_add(dai->component->card->snd_card,
  3137. snd_ctl_new1(&afe_enc_config_controls[4],
  3138. dai));
  3139. rc = snd_ctl_add(dai->component->card->snd_card,
  3140. snd_ctl_new1(&avd_drift_config_controls[2],
  3141. dai));
  3142. break;
  3143. case SLIMBUS_7_TX:
  3144. rc = snd_ctl_add(dai->component->card->snd_card,
  3145. snd_ctl_new1(&afe_dec_config_controls[0],
  3146. dai_data));
  3147. break;
  3148. case SLIMBUS_9_TX:
  3149. rc = snd_ctl_add(dai->component->card->snd_card,
  3150. snd_ctl_new1(&afe_dec_config_controls[1],
  3151. dai_data));
  3152. rc = snd_ctl_add(dai->component->card->snd_card,
  3153. snd_ctl_new1(&afe_dec_config_controls[2],
  3154. dai_data));
  3155. rc = snd_ctl_add(dai->component->card->snd_card,
  3156. snd_ctl_new1(&afe_dec_config_controls[3],
  3157. dai_data));
  3158. break;
  3159. case RT_PROXY_DAI_001_RX:
  3160. rc = snd_ctl_add(dai->component->card->snd_card,
  3161. snd_ctl_new1(&rt_proxy_config_controls[0],
  3162. dai_data));
  3163. break;
  3164. case RT_PROXY_DAI_001_TX:
  3165. rc = snd_ctl_add(dai->component->card->snd_card,
  3166. snd_ctl_new1(&rt_proxy_config_controls[1],
  3167. dai_data));
  3168. break;
  3169. case AFE_PORT_ID_USB_RX:
  3170. rc = snd_ctl_add(dai->component->card->snd_card,
  3171. snd_ctl_new1(&usb_audio_cfg_controls[0],
  3172. dai_data));
  3173. rc = snd_ctl_add(dai->component->card->snd_card,
  3174. snd_ctl_new1(&usb_audio_cfg_controls[1],
  3175. dai_data));
  3176. rc = snd_ctl_add(dai->component->card->snd_card,
  3177. snd_ctl_new1(&usb_audio_cfg_controls[4],
  3178. dai_data));
  3179. break;
  3180. case AFE_PORT_ID_USB_TX:
  3181. rc = snd_ctl_add(dai->component->card->snd_card,
  3182. snd_ctl_new1(&usb_audio_cfg_controls[2],
  3183. dai_data));
  3184. rc = snd_ctl_add(dai->component->card->snd_card,
  3185. snd_ctl_new1(&usb_audio_cfg_controls[3],
  3186. dai_data));
  3187. break;
  3188. case SLIMBUS_0_RX:
  3189. rc = snd_ctl_add(dai->component->card->snd_card,
  3190. snd_ctl_new1(&avd_drift_config_controls[0],
  3191. dai));
  3192. break;
  3193. case SLIMBUS_6_RX:
  3194. rc = snd_ctl_add(dai->component->card->snd_card,
  3195. snd_ctl_new1(&avd_drift_config_controls[1],
  3196. dai));
  3197. break;
  3198. }
  3199. if (rc < 0)
  3200. dev_err(dai->dev, "%s: err add config ctl, DAI = %s\n",
  3201. __func__, dai->name);
  3202. rc = msm_dai_q6_dai_add_route(dai);
  3203. return rc;
  3204. }
  3205. static int msm_dai_q6_dai_remove(struct snd_soc_dai *dai)
  3206. {
  3207. struct msm_dai_q6_dai_data *dai_data;
  3208. int rc;
  3209. dai_data = dev_get_drvdata(dai->dev);
  3210. /* If AFE port is still up, close it */
  3211. if (test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  3212. pr_debug("%s: stop pseudo port:%d\n", __func__, dai->id);
  3213. rc = afe_close(dai->id); /* can block */
  3214. if (rc < 0)
  3215. dev_err(dai->dev, "fail to close AFE port\n");
  3216. clear_bit(STATUS_PORT_STARTED, dai_data->status_mask);
  3217. }
  3218. kfree(dai_data);
  3219. return 0;
  3220. }
  3221. static struct snd_soc_dai_driver msm_dai_q6_afe_rx_dai[] = {
  3222. {
  3223. .playback = {
  3224. .stream_name = "AFE Playback",
  3225. .aif_name = "PCM_RX",
  3226. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  3227. SNDRV_PCM_RATE_16000,
  3228. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  3229. SNDRV_PCM_FMTBIT_S24_LE,
  3230. .channels_min = 1,
  3231. .channels_max = 2,
  3232. .rate_min = 8000,
  3233. .rate_max = 48000,
  3234. },
  3235. .ops = &msm_dai_q6_ops,
  3236. .id = RT_PROXY_DAI_001_RX,
  3237. .probe = msm_dai_q6_dai_probe,
  3238. .remove = msm_dai_q6_dai_remove,
  3239. },
  3240. {
  3241. .playback = {
  3242. .stream_name = "AFE-PROXY RX",
  3243. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  3244. SNDRV_PCM_RATE_16000,
  3245. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  3246. SNDRV_PCM_FMTBIT_S24_LE,
  3247. .channels_min = 1,
  3248. .channels_max = 2,
  3249. .rate_min = 8000,
  3250. .rate_max = 48000,
  3251. },
  3252. .ops = &msm_dai_q6_ops,
  3253. .id = RT_PROXY_DAI_002_RX,
  3254. .probe = msm_dai_q6_dai_probe,
  3255. .remove = msm_dai_q6_dai_remove,
  3256. },
  3257. };
  3258. static struct snd_soc_dai_driver msm_dai_q6_afe_lb_tx_dai[] = {
  3259. {
  3260. .capture = {
  3261. .stream_name = "AFE Loopback Capture",
  3262. .aif_name = "AFE_LOOPBACK_TX",
  3263. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  3264. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  3265. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  3266. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  3267. SNDRV_PCM_RATE_192000,
  3268. .formats = (SNDRV_PCM_FMTBIT_S16_LE |
  3269. SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S24_3LE |
  3270. SNDRV_PCM_FMTBIT_S32_LE ),
  3271. .channels_min = 1,
  3272. .channels_max = 8,
  3273. .rate_min = 8000,
  3274. .rate_max = 192000,
  3275. },
  3276. .id = AFE_LOOPBACK_TX,
  3277. .probe = msm_dai_q6_dai_probe,
  3278. .remove = msm_dai_q6_dai_remove,
  3279. },
  3280. };
  3281. static struct snd_soc_dai_driver msm_dai_q6_afe_tx_dai[] = {
  3282. {
  3283. .capture = {
  3284. .stream_name = "AFE Capture",
  3285. .aif_name = "PCM_TX",
  3286. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  3287. SNDRV_PCM_RATE_16000,
  3288. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  3289. .channels_min = 1,
  3290. .channels_max = 8,
  3291. .rate_min = 8000,
  3292. .rate_max = 48000,
  3293. },
  3294. .ops = &msm_dai_q6_ops,
  3295. .id = RT_PROXY_DAI_002_TX,
  3296. .probe = msm_dai_q6_dai_probe,
  3297. .remove = msm_dai_q6_dai_remove,
  3298. },
  3299. {
  3300. .capture = {
  3301. .stream_name = "AFE-PROXY TX",
  3302. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  3303. SNDRV_PCM_RATE_16000,
  3304. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  3305. .channels_min = 1,
  3306. .channels_max = 8,
  3307. .rate_min = 8000,
  3308. .rate_max = 48000,
  3309. },
  3310. .ops = &msm_dai_q6_ops,
  3311. .id = RT_PROXY_DAI_001_TX,
  3312. .probe = msm_dai_q6_dai_probe,
  3313. .remove = msm_dai_q6_dai_remove,
  3314. },
  3315. };
  3316. static struct snd_soc_dai_driver msm_dai_q6_bt_sco_rx_dai = {
  3317. .playback = {
  3318. .stream_name = "Internal BT-SCO Playback",
  3319. .aif_name = "INT_BT_SCO_RX",
  3320. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000,
  3321. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  3322. .channels_min = 1,
  3323. .channels_max = 1,
  3324. .rate_max = 16000,
  3325. .rate_min = 8000,
  3326. },
  3327. .ops = &msm_dai_q6_ops,
  3328. .id = INT_BT_SCO_RX,
  3329. .probe = msm_dai_q6_dai_probe,
  3330. .remove = msm_dai_q6_dai_remove,
  3331. };
  3332. static struct snd_soc_dai_driver msm_dai_q6_bt_a2dp_rx_dai = {
  3333. .playback = {
  3334. .stream_name = "Internal BT-A2DP Playback",
  3335. .aif_name = "INT_BT_A2DP_RX",
  3336. .rates = SNDRV_PCM_RATE_48000,
  3337. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  3338. .channels_min = 1,
  3339. .channels_max = 2,
  3340. .rate_max = 48000,
  3341. .rate_min = 48000,
  3342. },
  3343. .ops = &msm_dai_q6_ops,
  3344. .id = INT_BT_A2DP_RX,
  3345. .probe = msm_dai_q6_dai_probe,
  3346. .remove = msm_dai_q6_dai_remove,
  3347. };
  3348. static struct snd_soc_dai_driver msm_dai_q6_bt_sco_tx_dai = {
  3349. .capture = {
  3350. .stream_name = "Internal BT-SCO Capture",
  3351. .aif_name = "INT_BT_SCO_TX",
  3352. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000,
  3353. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  3354. .channels_min = 1,
  3355. .channels_max = 1,
  3356. .rate_max = 16000,
  3357. .rate_min = 8000,
  3358. },
  3359. .ops = &msm_dai_q6_ops,
  3360. .id = INT_BT_SCO_TX,
  3361. .probe = msm_dai_q6_dai_probe,
  3362. .remove = msm_dai_q6_dai_remove,
  3363. };
  3364. static struct snd_soc_dai_driver msm_dai_q6_fm_rx_dai = {
  3365. .playback = {
  3366. .stream_name = "Internal FM Playback",
  3367. .aif_name = "INT_FM_RX",
  3368. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  3369. SNDRV_PCM_RATE_16000,
  3370. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  3371. .channels_min = 2,
  3372. .channels_max = 2,
  3373. .rate_max = 48000,
  3374. .rate_min = 8000,
  3375. },
  3376. .ops = &msm_dai_q6_ops,
  3377. .id = INT_FM_RX,
  3378. .probe = msm_dai_q6_dai_probe,
  3379. .remove = msm_dai_q6_dai_remove,
  3380. };
  3381. static struct snd_soc_dai_driver msm_dai_q6_fm_tx_dai = {
  3382. .capture = {
  3383. .stream_name = "Internal FM Capture",
  3384. .aif_name = "INT_FM_TX",
  3385. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  3386. SNDRV_PCM_RATE_16000,
  3387. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  3388. .channels_min = 2,
  3389. .channels_max = 2,
  3390. .rate_max = 48000,
  3391. .rate_min = 8000,
  3392. },
  3393. .ops = &msm_dai_q6_ops,
  3394. .id = INT_FM_TX,
  3395. .probe = msm_dai_q6_dai_probe,
  3396. .remove = msm_dai_q6_dai_remove,
  3397. };
  3398. static struct snd_soc_dai_driver msm_dai_q6_voc_playback_dai[] = {
  3399. {
  3400. .playback = {
  3401. .stream_name = "Voice Farend Playback",
  3402. .aif_name = "VOICE_PLAYBACK_TX",
  3403. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  3404. SNDRV_PCM_RATE_16000,
  3405. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  3406. .channels_min = 1,
  3407. .channels_max = 2,
  3408. .rate_min = 8000,
  3409. .rate_max = 48000,
  3410. },
  3411. .ops = &msm_dai_q6_ops,
  3412. .id = VOICE_PLAYBACK_TX,
  3413. .probe = msm_dai_q6_dai_probe,
  3414. .remove = msm_dai_q6_dai_remove,
  3415. },
  3416. {
  3417. .playback = {
  3418. .stream_name = "Voice2 Farend Playback",
  3419. .aif_name = "VOICE2_PLAYBACK_TX",
  3420. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  3421. SNDRV_PCM_RATE_16000,
  3422. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  3423. .channels_min = 1,
  3424. .channels_max = 2,
  3425. .rate_min = 8000,
  3426. .rate_max = 48000,
  3427. },
  3428. .ops = &msm_dai_q6_ops,
  3429. .id = VOICE2_PLAYBACK_TX,
  3430. .probe = msm_dai_q6_dai_probe,
  3431. .remove = msm_dai_q6_dai_remove,
  3432. },
  3433. };
  3434. static struct snd_soc_dai_driver msm_dai_q6_incall_record_dai[] = {
  3435. {
  3436. .capture = {
  3437. .stream_name = "Voice Uplink Capture",
  3438. .aif_name = "INCALL_RECORD_TX",
  3439. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  3440. SNDRV_PCM_RATE_16000,
  3441. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  3442. .channels_min = 1,
  3443. .channels_max = 2,
  3444. .rate_min = 8000,
  3445. .rate_max = 48000,
  3446. },
  3447. .ops = &msm_dai_q6_ops,
  3448. .id = VOICE_RECORD_TX,
  3449. .probe = msm_dai_q6_dai_probe,
  3450. .remove = msm_dai_q6_dai_remove,
  3451. },
  3452. {
  3453. .capture = {
  3454. .stream_name = "Voice Downlink Capture",
  3455. .aif_name = "INCALL_RECORD_RX",
  3456. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  3457. SNDRV_PCM_RATE_16000,
  3458. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  3459. .channels_min = 1,
  3460. .channels_max = 2,
  3461. .rate_min = 8000,
  3462. .rate_max = 48000,
  3463. },
  3464. .ops = &msm_dai_q6_ops,
  3465. .id = VOICE_RECORD_RX,
  3466. .probe = msm_dai_q6_dai_probe,
  3467. .remove = msm_dai_q6_dai_remove,
  3468. },
  3469. };
  3470. static struct snd_soc_dai_driver msm_dai_q6_usb_rx_dai = {
  3471. .playback = {
  3472. .stream_name = "USB Audio Playback",
  3473. .aif_name = "USB_AUDIO_RX",
  3474. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  3475. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  3476. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  3477. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  3478. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  3479. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  3480. SNDRV_PCM_RATE_384000,
  3481. .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE |
  3482. SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE,
  3483. .channels_min = 1,
  3484. .channels_max = 8,
  3485. .rate_max = 384000,
  3486. .rate_min = 8000,
  3487. },
  3488. .ops = &msm_dai_q6_ops,
  3489. .id = AFE_PORT_ID_USB_RX,
  3490. .probe = msm_dai_q6_dai_probe,
  3491. .remove = msm_dai_q6_dai_remove,
  3492. };
  3493. static struct snd_soc_dai_driver msm_dai_q6_usb_tx_dai = {
  3494. .capture = {
  3495. .stream_name = "USB Audio Capture",
  3496. .aif_name = "USB_AUDIO_TX",
  3497. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  3498. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  3499. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  3500. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  3501. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  3502. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  3503. SNDRV_PCM_RATE_384000,
  3504. .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE |
  3505. SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE,
  3506. .channels_min = 1,
  3507. .channels_max = 8,
  3508. .rate_max = 384000,
  3509. .rate_min = 8000,
  3510. },
  3511. .ops = &msm_dai_q6_ops,
  3512. .id = AFE_PORT_ID_USB_TX,
  3513. .probe = msm_dai_q6_dai_probe,
  3514. .remove = msm_dai_q6_dai_remove,
  3515. };
  3516. static int msm_auxpcm_dev_probe(struct platform_device *pdev)
  3517. {
  3518. struct msm_dai_q6_auxpcm_dai_data *dai_data;
  3519. struct msm_dai_auxpcm_pdata *auxpcm_pdata;
  3520. uint32_t val_array[RATE_MAX_NUM_OF_AUX_PCM_RATES];
  3521. uint32_t val = 0;
  3522. const char *intf_name;
  3523. int rc = 0, i = 0, len = 0;
  3524. const uint32_t *slot_mapping_array = NULL;
  3525. u32 array_length = 0;
  3526. dai_data = kzalloc(sizeof(struct msm_dai_q6_auxpcm_dai_data),
  3527. GFP_KERNEL);
  3528. if (!dai_data)
  3529. return -ENOMEM;
  3530. rc = of_property_read_u32(pdev->dev.of_node,
  3531. "qcom,msm-dai-is-island-supported",
  3532. &dai_data->is_island_dai);
  3533. if (rc)
  3534. dev_dbg(&pdev->dev, "island supported entry not found\n");
  3535. auxpcm_pdata = kzalloc(sizeof(struct msm_dai_auxpcm_pdata),
  3536. GFP_KERNEL);
  3537. if (!auxpcm_pdata) {
  3538. dev_err(&pdev->dev, "Failed to allocate memory for platform data\n");
  3539. goto fail_pdata_nomem;
  3540. }
  3541. dev_dbg(&pdev->dev, "%s: dev %pK, dai_data %pK, auxpcm_pdata %pK\n",
  3542. __func__, &pdev->dev, dai_data, auxpcm_pdata);
  3543. rc = of_property_read_u32_array(pdev->dev.of_node,
  3544. "qcom,msm-cpudai-auxpcm-mode",
  3545. val_array, RATE_MAX_NUM_OF_AUX_PCM_RATES);
  3546. if (rc) {
  3547. dev_err(&pdev->dev, "%s: qcom,msm-cpudai-auxpcm-mode missing in DT node\n",
  3548. __func__);
  3549. goto fail_invalid_dt;
  3550. }
  3551. auxpcm_pdata->mode_8k.mode = (u16)val_array[RATE_8KHZ];
  3552. auxpcm_pdata->mode_16k.mode = (u16)val_array[RATE_16KHZ];
  3553. rc = of_property_read_u32_array(pdev->dev.of_node,
  3554. "qcom,msm-cpudai-auxpcm-sync",
  3555. val_array, RATE_MAX_NUM_OF_AUX_PCM_RATES);
  3556. if (rc) {
  3557. dev_err(&pdev->dev, "%s: qcom,msm-cpudai-auxpcm-sync missing in DT node\n",
  3558. __func__);
  3559. goto fail_invalid_dt;
  3560. }
  3561. auxpcm_pdata->mode_8k.sync = (u16)val_array[RATE_8KHZ];
  3562. auxpcm_pdata->mode_16k.sync = (u16)val_array[RATE_16KHZ];
  3563. rc = of_property_read_u32_array(pdev->dev.of_node,
  3564. "qcom,msm-cpudai-auxpcm-frame",
  3565. val_array, RATE_MAX_NUM_OF_AUX_PCM_RATES);
  3566. if (rc) {
  3567. dev_err(&pdev->dev, "%s: qcom,msm-cpudai-auxpcm-frame missing in DT node\n",
  3568. __func__);
  3569. goto fail_invalid_dt;
  3570. }
  3571. auxpcm_pdata->mode_8k.frame = (u16)val_array[RATE_8KHZ];
  3572. auxpcm_pdata->mode_16k.frame = (u16)val_array[RATE_16KHZ];
  3573. rc = of_property_read_u32_array(pdev->dev.of_node,
  3574. "qcom,msm-cpudai-auxpcm-quant",
  3575. val_array, RATE_MAX_NUM_OF_AUX_PCM_RATES);
  3576. if (rc) {
  3577. dev_err(&pdev->dev, "%s: qcom,msm-cpudai-auxpcm-quant missing in DT node\n",
  3578. __func__);
  3579. goto fail_invalid_dt;
  3580. }
  3581. auxpcm_pdata->mode_8k.quant = (u16)val_array[RATE_8KHZ];
  3582. auxpcm_pdata->mode_16k.quant = (u16)val_array[RATE_16KHZ];
  3583. rc = of_property_read_u32_array(pdev->dev.of_node,
  3584. "qcom,msm-cpudai-auxpcm-num-slots",
  3585. val_array, RATE_MAX_NUM_OF_AUX_PCM_RATES);
  3586. if (rc) {
  3587. dev_err(&pdev->dev, "%s: qcom,msm-cpudai-auxpcm-num-slots missing in DT node\n",
  3588. __func__);
  3589. goto fail_invalid_dt;
  3590. }
  3591. auxpcm_pdata->mode_8k.num_slots = (u16)val_array[RATE_8KHZ];
  3592. if (auxpcm_pdata->mode_8k.num_slots >
  3593. msm_dai_q6_max_num_slot(auxpcm_pdata->mode_8k.frame)) {
  3594. dev_err(&pdev->dev, "%s Max slots %d greater than DT node %d\n",
  3595. __func__,
  3596. msm_dai_q6_max_num_slot(auxpcm_pdata->mode_8k.frame),
  3597. auxpcm_pdata->mode_8k.num_slots);
  3598. rc = -EINVAL;
  3599. goto fail_invalid_dt;
  3600. }
  3601. auxpcm_pdata->mode_16k.num_slots = (u16)val_array[RATE_16KHZ];
  3602. if (auxpcm_pdata->mode_16k.num_slots >
  3603. msm_dai_q6_max_num_slot(auxpcm_pdata->mode_16k.frame)) {
  3604. dev_err(&pdev->dev, "%s Max slots %d greater than DT node %d\n",
  3605. __func__,
  3606. msm_dai_q6_max_num_slot(auxpcm_pdata->mode_16k.frame),
  3607. auxpcm_pdata->mode_16k.num_slots);
  3608. rc = -EINVAL;
  3609. goto fail_invalid_dt;
  3610. }
  3611. slot_mapping_array = of_get_property(pdev->dev.of_node,
  3612. "qcom,msm-cpudai-auxpcm-slot-mapping", &len);
  3613. if (slot_mapping_array == NULL) {
  3614. dev_err(&pdev->dev, "%s slot_mapping_array is not valid\n",
  3615. __func__);
  3616. rc = -EINVAL;
  3617. goto fail_invalid_dt;
  3618. }
  3619. array_length = auxpcm_pdata->mode_8k.num_slots +
  3620. auxpcm_pdata->mode_16k.num_slots;
  3621. if (len != sizeof(uint32_t) * array_length) {
  3622. dev_err(&pdev->dev, "%s Length is %d and expected is %zd\n",
  3623. __func__, len, sizeof(uint32_t) * array_length);
  3624. rc = -EINVAL;
  3625. goto fail_invalid_dt;
  3626. }
  3627. auxpcm_pdata->mode_8k.slot_mapping =
  3628. kzalloc(sizeof(uint16_t) *
  3629. auxpcm_pdata->mode_8k.num_slots,
  3630. GFP_KERNEL);
  3631. if (!auxpcm_pdata->mode_8k.slot_mapping) {
  3632. dev_err(&pdev->dev, "%s No mem for mode_8k slot mapping\n",
  3633. __func__);
  3634. rc = -ENOMEM;
  3635. goto fail_invalid_dt;
  3636. }
  3637. for (i = 0; i < auxpcm_pdata->mode_8k.num_slots; i++)
  3638. auxpcm_pdata->mode_8k.slot_mapping[i] =
  3639. (u16)be32_to_cpu(slot_mapping_array[i]);
  3640. auxpcm_pdata->mode_16k.slot_mapping =
  3641. kzalloc(sizeof(uint16_t) *
  3642. auxpcm_pdata->mode_16k.num_slots,
  3643. GFP_KERNEL);
  3644. if (!auxpcm_pdata->mode_16k.slot_mapping) {
  3645. dev_err(&pdev->dev, "%s No mem for mode_16k slot mapping\n",
  3646. __func__);
  3647. rc = -ENOMEM;
  3648. goto fail_invalid_16k_slot_mapping;
  3649. }
  3650. for (i = 0; i < auxpcm_pdata->mode_16k.num_slots; i++)
  3651. auxpcm_pdata->mode_16k.slot_mapping[i] =
  3652. (u16)be32_to_cpu(slot_mapping_array[i +
  3653. auxpcm_pdata->mode_8k.num_slots]);
  3654. rc = of_property_read_u32_array(pdev->dev.of_node,
  3655. "qcom,msm-cpudai-auxpcm-data",
  3656. val_array, RATE_MAX_NUM_OF_AUX_PCM_RATES);
  3657. if (rc) {
  3658. dev_err(&pdev->dev, "%s: qcom,msm-cpudai-auxpcm-data missing in DT node\n",
  3659. __func__);
  3660. goto fail_invalid_dt1;
  3661. }
  3662. auxpcm_pdata->mode_8k.data = (u16)val_array[RATE_8KHZ];
  3663. auxpcm_pdata->mode_16k.data = (u16)val_array[RATE_16KHZ];
  3664. rc = of_property_read_u32_array(pdev->dev.of_node,
  3665. "qcom,msm-cpudai-auxpcm-pcm-clk-rate",
  3666. val_array, RATE_MAX_NUM_OF_AUX_PCM_RATES);
  3667. if (rc) {
  3668. dev_err(&pdev->dev,
  3669. "%s: qcom,msm-cpudai-auxpcm-pcm-clk-rate missing in DT\n",
  3670. __func__);
  3671. goto fail_invalid_dt1;
  3672. }
  3673. auxpcm_pdata->mode_8k.pcm_clk_rate = (int)val_array[RATE_8KHZ];
  3674. auxpcm_pdata->mode_16k.pcm_clk_rate = (int)val_array[RATE_16KHZ];
  3675. rc = of_property_read_string(pdev->dev.of_node,
  3676. "qcom,msm-auxpcm-interface", &intf_name);
  3677. if (rc) {
  3678. dev_err(&pdev->dev,
  3679. "%s: qcom,msm-auxpcm-interface missing in DT node\n",
  3680. __func__);
  3681. goto fail_nodev_intf;
  3682. }
  3683. if (!strcmp(intf_name, "primary")) {
  3684. dai_data->rx_pid = AFE_PORT_ID_PRIMARY_PCM_RX;
  3685. dai_data->tx_pid = AFE_PORT_ID_PRIMARY_PCM_TX;
  3686. pdev->id = MSM_DAI_PRI_AUXPCM_DT_DEV_ID;
  3687. i = 0;
  3688. } else if (!strcmp(intf_name, "secondary")) {
  3689. dai_data->rx_pid = AFE_PORT_ID_SECONDARY_PCM_RX;
  3690. dai_data->tx_pid = AFE_PORT_ID_SECONDARY_PCM_TX;
  3691. pdev->id = MSM_DAI_SEC_AUXPCM_DT_DEV_ID;
  3692. i = 1;
  3693. } else if (!strcmp(intf_name, "tertiary")) {
  3694. dai_data->rx_pid = AFE_PORT_ID_TERTIARY_PCM_RX;
  3695. dai_data->tx_pid = AFE_PORT_ID_TERTIARY_PCM_TX;
  3696. pdev->id = MSM_DAI_TERT_AUXPCM_DT_DEV_ID;
  3697. i = 2;
  3698. } else if (!strcmp(intf_name, "quaternary")) {
  3699. dai_data->rx_pid = AFE_PORT_ID_QUATERNARY_PCM_RX;
  3700. dai_data->tx_pid = AFE_PORT_ID_QUATERNARY_PCM_TX;
  3701. pdev->id = MSM_DAI_QUAT_AUXPCM_DT_DEV_ID;
  3702. i = 3;
  3703. } else if (!strcmp(intf_name, "quinary")) {
  3704. dai_data->rx_pid = AFE_PORT_ID_QUINARY_PCM_RX;
  3705. dai_data->tx_pid = AFE_PORT_ID_QUINARY_PCM_TX;
  3706. pdev->id = MSM_DAI_QUIN_AUXPCM_DT_DEV_ID;
  3707. i = 4;
  3708. } else {
  3709. dev_err(&pdev->dev, "%s: invalid DT intf name %s\n",
  3710. __func__, intf_name);
  3711. goto fail_invalid_intf;
  3712. }
  3713. rc = of_property_read_u32(pdev->dev.of_node,
  3714. "qcom,msm-cpudai-afe-clk-ver", &val);
  3715. if (rc)
  3716. dai_data->afe_clk_ver = AFE_CLK_VERSION_V1;
  3717. else
  3718. dai_data->afe_clk_ver = val;
  3719. mutex_init(&dai_data->rlock);
  3720. dev_dbg(&pdev->dev, "dev name %s\n", dev_name(&pdev->dev));
  3721. dev_set_drvdata(&pdev->dev, dai_data);
  3722. pdev->dev.platform_data = (void *) auxpcm_pdata;
  3723. rc = snd_soc_register_component(&pdev->dev,
  3724. &msm_dai_q6_aux_pcm_dai_component,
  3725. &msm_dai_q6_aux_pcm_dai[i], 1);
  3726. if (rc) {
  3727. dev_err(&pdev->dev, "%s: auxpcm dai reg failed, rc=%d\n",
  3728. __func__, rc);
  3729. goto fail_reg_dai;
  3730. }
  3731. return rc;
  3732. fail_reg_dai:
  3733. fail_invalid_intf:
  3734. fail_nodev_intf:
  3735. fail_invalid_dt1:
  3736. kfree(auxpcm_pdata->mode_16k.slot_mapping);
  3737. fail_invalid_16k_slot_mapping:
  3738. kfree(auxpcm_pdata->mode_8k.slot_mapping);
  3739. fail_invalid_dt:
  3740. kfree(auxpcm_pdata);
  3741. fail_pdata_nomem:
  3742. kfree(dai_data);
  3743. return rc;
  3744. }
  3745. static int msm_auxpcm_dev_remove(struct platform_device *pdev)
  3746. {
  3747. struct msm_dai_q6_auxpcm_dai_data *dai_data;
  3748. dai_data = dev_get_drvdata(&pdev->dev);
  3749. snd_soc_unregister_component(&pdev->dev);
  3750. mutex_destroy(&dai_data->rlock);
  3751. kfree(dai_data);
  3752. kfree(pdev->dev.platform_data);
  3753. return 0;
  3754. }
  3755. static const struct of_device_id msm_auxpcm_dev_dt_match[] = {
  3756. { .compatible = "qcom,msm-auxpcm-dev", },
  3757. {}
  3758. };
  3759. static struct platform_driver msm_auxpcm_dev_driver = {
  3760. .probe = msm_auxpcm_dev_probe,
  3761. .remove = msm_auxpcm_dev_remove,
  3762. .driver = {
  3763. .name = "msm-auxpcm-dev",
  3764. .owner = THIS_MODULE,
  3765. .of_match_table = msm_auxpcm_dev_dt_match,
  3766. },
  3767. };
  3768. static struct snd_soc_dai_driver msm_dai_q6_slimbus_rx_dai[] = {
  3769. {
  3770. .playback = {
  3771. .stream_name = "Slimbus Playback",
  3772. .aif_name = "SLIMBUS_0_RX",
  3773. .rates = SNDRV_PCM_RATE_8000_384000,
  3774. .formats = DAI_FORMATS_S16_S24_S32_LE,
  3775. .channels_min = 1,
  3776. .channels_max = 8,
  3777. .rate_min = 8000,
  3778. .rate_max = 384000,
  3779. },
  3780. .ops = &msm_dai_q6_ops,
  3781. .id = SLIMBUS_0_RX,
  3782. .probe = msm_dai_q6_dai_probe,
  3783. .remove = msm_dai_q6_dai_remove,
  3784. },
  3785. {
  3786. .playback = {
  3787. .stream_name = "Slimbus1 Playback",
  3788. .aif_name = "SLIMBUS_1_RX",
  3789. .rates = SNDRV_PCM_RATE_8000_384000,
  3790. .formats = DAI_FORMATS_S16_S24_S32_LE,
  3791. .channels_min = 1,
  3792. .channels_max = 2,
  3793. .rate_min = 8000,
  3794. .rate_max = 384000,
  3795. },
  3796. .ops = &msm_dai_q6_ops,
  3797. .id = SLIMBUS_1_RX,
  3798. .probe = msm_dai_q6_dai_probe,
  3799. .remove = msm_dai_q6_dai_remove,
  3800. },
  3801. {
  3802. .playback = {
  3803. .stream_name = "Slimbus2 Playback",
  3804. .aif_name = "SLIMBUS_2_RX",
  3805. .rates = SNDRV_PCM_RATE_8000_384000,
  3806. .formats = DAI_FORMATS_S16_S24_S32_LE,
  3807. .channels_min = 1,
  3808. .channels_max = 8,
  3809. .rate_min = 8000,
  3810. .rate_max = 384000,
  3811. },
  3812. .ops = &msm_dai_q6_ops,
  3813. .id = SLIMBUS_2_RX,
  3814. .probe = msm_dai_q6_dai_probe,
  3815. .remove = msm_dai_q6_dai_remove,
  3816. },
  3817. {
  3818. .playback = {
  3819. .stream_name = "Slimbus3 Playback",
  3820. .aif_name = "SLIMBUS_3_RX",
  3821. .rates = SNDRV_PCM_RATE_8000_384000,
  3822. .formats = DAI_FORMATS_S16_S24_S32_LE,
  3823. .channels_min = 1,
  3824. .channels_max = 2,
  3825. .rate_min = 8000,
  3826. .rate_max = 384000,
  3827. },
  3828. .ops = &msm_dai_q6_ops,
  3829. .id = SLIMBUS_3_RX,
  3830. .probe = msm_dai_q6_dai_probe,
  3831. .remove = msm_dai_q6_dai_remove,
  3832. },
  3833. {
  3834. .playback = {
  3835. .stream_name = "Slimbus4 Playback",
  3836. .aif_name = "SLIMBUS_4_RX",
  3837. .rates = SNDRV_PCM_RATE_8000_384000,
  3838. .formats = DAI_FORMATS_S16_S24_S32_LE,
  3839. .channels_min = 1,
  3840. .channels_max = 2,
  3841. .rate_min = 8000,
  3842. .rate_max = 384000,
  3843. },
  3844. .ops = &msm_dai_q6_ops,
  3845. .id = SLIMBUS_4_RX,
  3846. .probe = msm_dai_q6_dai_probe,
  3847. .remove = msm_dai_q6_dai_remove,
  3848. },
  3849. {
  3850. .playback = {
  3851. .stream_name = "Slimbus6 Playback",
  3852. .aif_name = "SLIMBUS_6_RX",
  3853. .rates = SNDRV_PCM_RATE_8000_384000,
  3854. .formats = DAI_FORMATS_S16_S24_S32_LE,
  3855. .channels_min = 1,
  3856. .channels_max = 2,
  3857. .rate_min = 8000,
  3858. .rate_max = 384000,
  3859. },
  3860. .ops = &msm_dai_q6_ops,
  3861. .id = SLIMBUS_6_RX,
  3862. .probe = msm_dai_q6_dai_probe,
  3863. .remove = msm_dai_q6_dai_remove,
  3864. },
  3865. {
  3866. .playback = {
  3867. .stream_name = "Slimbus5 Playback",
  3868. .aif_name = "SLIMBUS_5_RX",
  3869. .rates = SNDRV_PCM_RATE_8000_384000,
  3870. .formats = DAI_FORMATS_S16_S24_S32_LE,
  3871. .channels_min = 1,
  3872. .channels_max = 2,
  3873. .rate_min = 8000,
  3874. .rate_max = 384000,
  3875. },
  3876. .ops = &msm_dai_q6_ops,
  3877. .id = SLIMBUS_5_RX,
  3878. .probe = msm_dai_q6_dai_probe,
  3879. .remove = msm_dai_q6_dai_remove,
  3880. },
  3881. {
  3882. .playback = {
  3883. .stream_name = "Slimbus7 Playback",
  3884. .aif_name = "SLIMBUS_7_RX",
  3885. .rates = SNDRV_PCM_RATE_8000_384000,
  3886. .formats = DAI_FORMATS_S16_S24_S32_LE,
  3887. .channels_min = 1,
  3888. .channels_max = 8,
  3889. .rate_min = 8000,
  3890. .rate_max = 384000,
  3891. },
  3892. .ops = &msm_dai_q6_ops,
  3893. .id = SLIMBUS_7_RX,
  3894. .probe = msm_dai_q6_dai_probe,
  3895. .remove = msm_dai_q6_dai_remove,
  3896. },
  3897. {
  3898. .playback = {
  3899. .stream_name = "Slimbus8 Playback",
  3900. .aif_name = "SLIMBUS_8_RX",
  3901. .rates = SNDRV_PCM_RATE_8000_384000,
  3902. .formats = DAI_FORMATS_S16_S24_S32_LE,
  3903. .channels_min = 1,
  3904. .channels_max = 8,
  3905. .rate_min = 8000,
  3906. .rate_max = 384000,
  3907. },
  3908. .ops = &msm_dai_q6_ops,
  3909. .id = SLIMBUS_8_RX,
  3910. .probe = msm_dai_q6_dai_probe,
  3911. .remove = msm_dai_q6_dai_remove,
  3912. },
  3913. {
  3914. .playback = {
  3915. .stream_name = "Slimbus9 Playback",
  3916. .aif_name = "SLIMBUS_9_RX",
  3917. .rates = SNDRV_PCM_RATE_8000_384000,
  3918. .formats = DAI_FORMATS_S16_S24_S32_LE,
  3919. .channels_min = 1,
  3920. .channels_max = 8,
  3921. .rate_min = 8000,
  3922. .rate_max = 384000,
  3923. },
  3924. .ops = &msm_dai_q6_ops,
  3925. .id = SLIMBUS_9_RX,
  3926. .probe = msm_dai_q6_dai_probe,
  3927. .remove = msm_dai_q6_dai_remove,
  3928. },
  3929. };
  3930. static struct snd_soc_dai_driver msm_dai_q6_slimbus_tx_dai[] = {
  3931. {
  3932. .capture = {
  3933. .stream_name = "Slimbus Capture",
  3934. .aif_name = "SLIMBUS_0_TX",
  3935. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  3936. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_96000 |
  3937. SNDRV_PCM_RATE_192000,
  3938. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  3939. SNDRV_PCM_FMTBIT_S24_LE |
  3940. SNDRV_PCM_FMTBIT_S24_3LE,
  3941. .channels_min = 1,
  3942. .channels_max = 8,
  3943. .rate_min = 8000,
  3944. .rate_max = 192000,
  3945. },
  3946. .ops = &msm_dai_q6_ops,
  3947. .id = SLIMBUS_0_TX,
  3948. .probe = msm_dai_q6_dai_probe,
  3949. .remove = msm_dai_q6_dai_remove,
  3950. },
  3951. {
  3952. .capture = {
  3953. .stream_name = "Slimbus1 Capture",
  3954. .aif_name = "SLIMBUS_1_TX",
  3955. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  3956. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  3957. SNDRV_PCM_RATE_192000,
  3958. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  3959. SNDRV_PCM_FMTBIT_S24_LE |
  3960. SNDRV_PCM_FMTBIT_S24_3LE,
  3961. .channels_min = 1,
  3962. .channels_max = 2,
  3963. .rate_min = 8000,
  3964. .rate_max = 192000,
  3965. },
  3966. .ops = &msm_dai_q6_ops,
  3967. .id = SLIMBUS_1_TX,
  3968. .probe = msm_dai_q6_dai_probe,
  3969. .remove = msm_dai_q6_dai_remove,
  3970. },
  3971. {
  3972. .capture = {
  3973. .stream_name = "Slimbus2 Capture",
  3974. .aif_name = "SLIMBUS_2_TX",
  3975. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  3976. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_96000 |
  3977. SNDRV_PCM_RATE_192000,
  3978. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  3979. SNDRV_PCM_FMTBIT_S24_LE,
  3980. .channels_min = 1,
  3981. .channels_max = 8,
  3982. .rate_min = 8000,
  3983. .rate_max = 192000,
  3984. },
  3985. .ops = &msm_dai_q6_ops,
  3986. .id = SLIMBUS_2_TX,
  3987. .probe = msm_dai_q6_dai_probe,
  3988. .remove = msm_dai_q6_dai_remove,
  3989. },
  3990. {
  3991. .capture = {
  3992. .stream_name = "Slimbus3 Capture",
  3993. .aif_name = "SLIMBUS_3_TX",
  3994. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  3995. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  3996. SNDRV_PCM_RATE_192000,
  3997. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  3998. SNDRV_PCM_FMTBIT_S24_LE,
  3999. .channels_min = 2,
  4000. .channels_max = 4,
  4001. .rate_min = 8000,
  4002. .rate_max = 192000,
  4003. },
  4004. .ops = &msm_dai_q6_ops,
  4005. .id = SLIMBUS_3_TX,
  4006. .probe = msm_dai_q6_dai_probe,
  4007. .remove = msm_dai_q6_dai_remove,
  4008. },
  4009. {
  4010. .capture = {
  4011. .stream_name = "Slimbus4 Capture",
  4012. .aif_name = "SLIMBUS_4_TX",
  4013. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  4014. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  4015. SNDRV_PCM_RATE_192000,
  4016. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  4017. SNDRV_PCM_FMTBIT_S24_LE |
  4018. SNDRV_PCM_FMTBIT_S32_LE,
  4019. .channels_min = 2,
  4020. .channels_max = 4,
  4021. .rate_min = 8000,
  4022. .rate_max = 192000,
  4023. },
  4024. .ops = &msm_dai_q6_ops,
  4025. .id = SLIMBUS_4_TX,
  4026. .probe = msm_dai_q6_dai_probe,
  4027. .remove = msm_dai_q6_dai_remove,
  4028. },
  4029. {
  4030. .capture = {
  4031. .stream_name = "Slimbus5 Capture",
  4032. .aif_name = "SLIMBUS_5_TX",
  4033. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  4034. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_96000 |
  4035. SNDRV_PCM_RATE_192000,
  4036. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  4037. SNDRV_PCM_FMTBIT_S24_LE,
  4038. .channels_min = 1,
  4039. .channels_max = 8,
  4040. .rate_min = 8000,
  4041. .rate_max = 192000,
  4042. },
  4043. .ops = &msm_dai_q6_ops,
  4044. .id = SLIMBUS_5_TX,
  4045. .probe = msm_dai_q6_dai_probe,
  4046. .remove = msm_dai_q6_dai_remove,
  4047. },
  4048. {
  4049. .capture = {
  4050. .stream_name = "Slimbus6 Capture",
  4051. .aif_name = "SLIMBUS_6_TX",
  4052. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  4053. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  4054. SNDRV_PCM_RATE_192000,
  4055. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  4056. SNDRV_PCM_FMTBIT_S24_LE,
  4057. .channels_min = 1,
  4058. .channels_max = 2,
  4059. .rate_min = 8000,
  4060. .rate_max = 192000,
  4061. },
  4062. .ops = &msm_dai_q6_ops,
  4063. .id = SLIMBUS_6_TX,
  4064. .probe = msm_dai_q6_dai_probe,
  4065. .remove = msm_dai_q6_dai_remove,
  4066. },
  4067. {
  4068. .capture = {
  4069. .stream_name = "Slimbus7 Capture",
  4070. .aif_name = "SLIMBUS_7_TX",
  4071. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  4072. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  4073. SNDRV_PCM_RATE_192000,
  4074. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  4075. SNDRV_PCM_FMTBIT_S24_LE |
  4076. SNDRV_PCM_FMTBIT_S32_LE,
  4077. .channels_min = 1,
  4078. .channels_max = 8,
  4079. .rate_min = 8000,
  4080. .rate_max = 192000,
  4081. },
  4082. .ops = &msm_dai_q6_ops,
  4083. .id = SLIMBUS_7_TX,
  4084. .probe = msm_dai_q6_dai_probe,
  4085. .remove = msm_dai_q6_dai_remove,
  4086. },
  4087. {
  4088. .capture = {
  4089. .stream_name = "Slimbus8 Capture",
  4090. .aif_name = "SLIMBUS_8_TX",
  4091. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  4092. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  4093. SNDRV_PCM_RATE_192000,
  4094. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  4095. SNDRV_PCM_FMTBIT_S24_LE |
  4096. SNDRV_PCM_FMTBIT_S32_LE,
  4097. .channels_min = 1,
  4098. .channels_max = 8,
  4099. .rate_min = 8000,
  4100. .rate_max = 192000,
  4101. },
  4102. .ops = &msm_dai_q6_ops,
  4103. .id = SLIMBUS_8_TX,
  4104. .probe = msm_dai_q6_dai_probe,
  4105. .remove = msm_dai_q6_dai_remove,
  4106. },
  4107. {
  4108. .capture = {
  4109. .stream_name = "Slimbus9 Capture",
  4110. .aif_name = "SLIMBUS_9_TX",
  4111. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  4112. SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
  4113. SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000 |
  4114. SNDRV_PCM_RATE_192000,
  4115. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  4116. SNDRV_PCM_FMTBIT_S24_LE |
  4117. SNDRV_PCM_FMTBIT_S32_LE,
  4118. .channels_min = 1,
  4119. .channels_max = 8,
  4120. .rate_min = 8000,
  4121. .rate_max = 192000,
  4122. },
  4123. .ops = &msm_dai_q6_ops,
  4124. .id = SLIMBUS_9_TX,
  4125. .probe = msm_dai_q6_dai_probe,
  4126. .remove = msm_dai_q6_dai_remove,
  4127. },
  4128. };
  4129. static int msm_dai_q6_mi2s_format_put(struct snd_kcontrol *kcontrol,
  4130. struct snd_ctl_elem_value *ucontrol)
  4131. {
  4132. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  4133. int value = ucontrol->value.integer.value[0];
  4134. dai_data->port_config.i2s.data_format = value;
  4135. pr_debug("%s: value = %d, channel = %d, line = %d\n",
  4136. __func__, value, dai_data->port_config.i2s.mono_stereo,
  4137. dai_data->port_config.i2s.channel_mode);
  4138. return 0;
  4139. }
  4140. static int msm_dai_q6_mi2s_format_get(struct snd_kcontrol *kcontrol,
  4141. struct snd_ctl_elem_value *ucontrol)
  4142. {
  4143. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  4144. ucontrol->value.integer.value[0] =
  4145. dai_data->port_config.i2s.data_format;
  4146. return 0;
  4147. }
  4148. static int msm_dai_q6_mi2s_vi_feed_mono_put(struct snd_kcontrol *kcontrol,
  4149. struct snd_ctl_elem_value *ucontrol)
  4150. {
  4151. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  4152. int value = ucontrol->value.integer.value[0];
  4153. dai_data->vi_feed_mono = value;
  4154. pr_debug("%s: value = %d\n", __func__, value);
  4155. return 0;
  4156. }
  4157. static int msm_dai_q6_mi2s_vi_feed_mono_get(struct snd_kcontrol *kcontrol,
  4158. struct snd_ctl_elem_value *ucontrol)
  4159. {
  4160. struct msm_dai_q6_dai_data *dai_data = kcontrol->private_data;
  4161. ucontrol->value.integer.value[0] = dai_data->vi_feed_mono;
  4162. return 0;
  4163. }
  4164. static const struct snd_kcontrol_new mi2s_config_controls[] = {
  4165. SOC_ENUM_EXT("PRI MI2S RX Format", mi2s_config_enum[0],
  4166. msm_dai_q6_mi2s_format_get,
  4167. msm_dai_q6_mi2s_format_put),
  4168. SOC_ENUM_EXT("SEC MI2S RX Format", mi2s_config_enum[0],
  4169. msm_dai_q6_mi2s_format_get,
  4170. msm_dai_q6_mi2s_format_put),
  4171. SOC_ENUM_EXT("TERT MI2S RX Format", mi2s_config_enum[0],
  4172. msm_dai_q6_mi2s_format_get,
  4173. msm_dai_q6_mi2s_format_put),
  4174. SOC_ENUM_EXT("QUAT MI2S RX Format", mi2s_config_enum[0],
  4175. msm_dai_q6_mi2s_format_get,
  4176. msm_dai_q6_mi2s_format_put),
  4177. SOC_ENUM_EXT("QUIN MI2S RX Format", mi2s_config_enum[0],
  4178. msm_dai_q6_mi2s_format_get,
  4179. msm_dai_q6_mi2s_format_put),
  4180. SOC_ENUM_EXT("PRI MI2S TX Format", mi2s_config_enum[0],
  4181. msm_dai_q6_mi2s_format_get,
  4182. msm_dai_q6_mi2s_format_put),
  4183. SOC_ENUM_EXT("SEC MI2S TX Format", mi2s_config_enum[0],
  4184. msm_dai_q6_mi2s_format_get,
  4185. msm_dai_q6_mi2s_format_put),
  4186. SOC_ENUM_EXT("TERT MI2S TX Format", mi2s_config_enum[0],
  4187. msm_dai_q6_mi2s_format_get,
  4188. msm_dai_q6_mi2s_format_put),
  4189. SOC_ENUM_EXT("QUAT MI2S TX Format", mi2s_config_enum[0],
  4190. msm_dai_q6_mi2s_format_get,
  4191. msm_dai_q6_mi2s_format_put),
  4192. SOC_ENUM_EXT("QUIN MI2S TX Format", mi2s_config_enum[0],
  4193. msm_dai_q6_mi2s_format_get,
  4194. msm_dai_q6_mi2s_format_put),
  4195. SOC_ENUM_EXT("SENARY MI2S TX Format", mi2s_config_enum[0],
  4196. msm_dai_q6_mi2s_format_get,
  4197. msm_dai_q6_mi2s_format_put),
  4198. SOC_ENUM_EXT("INT5 MI2S TX Format", mi2s_config_enum[0],
  4199. msm_dai_q6_mi2s_format_get,
  4200. msm_dai_q6_mi2s_format_put),
  4201. };
  4202. static const struct snd_kcontrol_new mi2s_vi_feed_controls[] = {
  4203. SOC_ENUM_EXT("INT5 MI2S VI MONO", mi2s_config_enum[1],
  4204. msm_dai_q6_mi2s_vi_feed_mono_get,
  4205. msm_dai_q6_mi2s_vi_feed_mono_put),
  4206. };
  4207. static int msm_dai_q6_dai_mi2s_probe(struct snd_soc_dai *dai)
  4208. {
  4209. struct msm_dai_q6_mi2s_dai_data *mi2s_dai_data =
  4210. dev_get_drvdata(dai->dev);
  4211. struct msm_mi2s_pdata *mi2s_pdata =
  4212. (struct msm_mi2s_pdata *) dai->dev->platform_data;
  4213. struct snd_kcontrol *kcontrol = NULL;
  4214. int rc = 0;
  4215. const struct snd_kcontrol_new *ctrl = NULL;
  4216. const struct snd_kcontrol_new *vi_feed_ctrl = NULL;
  4217. u16 dai_id = 0;
  4218. dai->id = mi2s_pdata->intf_id;
  4219. if (mi2s_dai_data->rx_dai.mi2s_dai_data.port_config.i2s.channel_mode) {
  4220. if (dai->id == MSM_PRIM_MI2S)
  4221. ctrl = &mi2s_config_controls[0];
  4222. if (dai->id == MSM_SEC_MI2S)
  4223. ctrl = &mi2s_config_controls[1];
  4224. if (dai->id == MSM_TERT_MI2S)
  4225. ctrl = &mi2s_config_controls[2];
  4226. if (dai->id == MSM_QUAT_MI2S)
  4227. ctrl = &mi2s_config_controls[3];
  4228. if (dai->id == MSM_QUIN_MI2S)
  4229. ctrl = &mi2s_config_controls[4];
  4230. }
  4231. if (ctrl) {
  4232. kcontrol = snd_ctl_new1(ctrl,
  4233. &mi2s_dai_data->rx_dai.mi2s_dai_data);
  4234. rc = snd_ctl_add(dai->component->card->snd_card, kcontrol);
  4235. if (rc < 0) {
  4236. dev_err(dai->dev, "%s: err add RX fmt ctl DAI = %s\n",
  4237. __func__, dai->name);
  4238. goto rtn;
  4239. }
  4240. }
  4241. ctrl = NULL;
  4242. if (mi2s_dai_data->tx_dai.mi2s_dai_data.port_config.i2s.channel_mode) {
  4243. if (dai->id == MSM_PRIM_MI2S)
  4244. ctrl = &mi2s_config_controls[5];
  4245. if (dai->id == MSM_SEC_MI2S)
  4246. ctrl = &mi2s_config_controls[6];
  4247. if (dai->id == MSM_TERT_MI2S)
  4248. ctrl = &mi2s_config_controls[7];
  4249. if (dai->id == MSM_QUAT_MI2S)
  4250. ctrl = &mi2s_config_controls[8];
  4251. if (dai->id == MSM_QUIN_MI2S)
  4252. ctrl = &mi2s_config_controls[9];
  4253. if (dai->id == MSM_SENARY_MI2S)
  4254. ctrl = &mi2s_config_controls[10];
  4255. if (dai->id == MSM_INT5_MI2S)
  4256. ctrl = &mi2s_config_controls[11];
  4257. }
  4258. if (ctrl) {
  4259. rc = snd_ctl_add(dai->component->card->snd_card,
  4260. snd_ctl_new1(ctrl,
  4261. &mi2s_dai_data->tx_dai.mi2s_dai_data));
  4262. if (rc < 0) {
  4263. if (kcontrol)
  4264. snd_ctl_remove(dai->component->card->snd_card,
  4265. kcontrol);
  4266. dev_err(dai->dev, "%s: err add TX fmt ctl DAI = %s\n",
  4267. __func__, dai->name);
  4268. }
  4269. }
  4270. if (dai->id == MSM_INT5_MI2S)
  4271. vi_feed_ctrl = &mi2s_vi_feed_controls[0];
  4272. if (vi_feed_ctrl) {
  4273. rc = snd_ctl_add(dai->component->card->snd_card,
  4274. snd_ctl_new1(vi_feed_ctrl,
  4275. &mi2s_dai_data->tx_dai.mi2s_dai_data));
  4276. if (rc < 0) {
  4277. dev_err(dai->dev, "%s: err add TX vi feed channel ctl DAI = %s\n",
  4278. __func__, dai->name);
  4279. }
  4280. }
  4281. if (mi2s_dai_data->is_island_dai) {
  4282. msm_mi2s_get_port_id(dai->id, SNDRV_PCM_STREAM_CAPTURE,
  4283. &dai_id);
  4284. rc = msm_dai_q6_add_island_mx_ctls(
  4285. dai->component->card->snd_card,
  4286. dai->name, dai_id,
  4287. (void *)mi2s_dai_data);
  4288. }
  4289. rc = msm_dai_q6_dai_add_route(dai);
  4290. rtn:
  4291. return rc;
  4292. }
  4293. static int msm_dai_q6_dai_mi2s_remove(struct snd_soc_dai *dai)
  4294. {
  4295. struct msm_dai_q6_mi2s_dai_data *mi2s_dai_data =
  4296. dev_get_drvdata(dai->dev);
  4297. int rc;
  4298. /* If AFE port is still up, close it */
  4299. if (test_bit(STATUS_PORT_STARTED,
  4300. mi2s_dai_data->rx_dai.mi2s_dai_data.status_mask)) {
  4301. rc = afe_close(MI2S_RX); /* can block */
  4302. if (rc < 0)
  4303. dev_err(dai->dev, "fail to close MI2S_RX port\n");
  4304. clear_bit(STATUS_PORT_STARTED,
  4305. mi2s_dai_data->rx_dai.mi2s_dai_data.status_mask);
  4306. }
  4307. if (test_bit(STATUS_PORT_STARTED,
  4308. mi2s_dai_data->tx_dai.mi2s_dai_data.status_mask)) {
  4309. rc = afe_close(MI2S_TX); /* can block */
  4310. if (rc < 0)
  4311. dev_err(dai->dev, "fail to close MI2S_TX port\n");
  4312. clear_bit(STATUS_PORT_STARTED,
  4313. mi2s_dai_data->tx_dai.mi2s_dai_data.status_mask);
  4314. }
  4315. return 0;
  4316. }
  4317. static int msm_dai_q6_mi2s_startup(struct snd_pcm_substream *substream,
  4318. struct snd_soc_dai *dai)
  4319. {
  4320. return 0;
  4321. }
  4322. static int msm_mi2s_get_port_id(u32 mi2s_id, int stream, u16 *port_id)
  4323. {
  4324. int ret = 0;
  4325. switch (stream) {
  4326. case SNDRV_PCM_STREAM_PLAYBACK:
  4327. switch (mi2s_id) {
  4328. case MSM_PRIM_MI2S:
  4329. *port_id = AFE_PORT_ID_PRIMARY_MI2S_RX;
  4330. break;
  4331. case MSM_SEC_MI2S:
  4332. *port_id = AFE_PORT_ID_SECONDARY_MI2S_RX;
  4333. break;
  4334. case MSM_TERT_MI2S:
  4335. *port_id = AFE_PORT_ID_TERTIARY_MI2S_RX;
  4336. break;
  4337. case MSM_QUAT_MI2S:
  4338. *port_id = AFE_PORT_ID_QUATERNARY_MI2S_RX;
  4339. break;
  4340. case MSM_SEC_MI2S_SD1:
  4341. *port_id = AFE_PORT_ID_SECONDARY_MI2S_RX_SD1;
  4342. break;
  4343. case MSM_QUIN_MI2S:
  4344. *port_id = AFE_PORT_ID_QUINARY_MI2S_RX;
  4345. break;
  4346. case MSM_INT0_MI2S:
  4347. *port_id = AFE_PORT_ID_INT0_MI2S_RX;
  4348. break;
  4349. case MSM_INT1_MI2S:
  4350. *port_id = AFE_PORT_ID_INT1_MI2S_RX;
  4351. break;
  4352. case MSM_INT2_MI2S:
  4353. *port_id = AFE_PORT_ID_INT2_MI2S_RX;
  4354. break;
  4355. case MSM_INT3_MI2S:
  4356. *port_id = AFE_PORT_ID_INT3_MI2S_RX;
  4357. break;
  4358. case MSM_INT4_MI2S:
  4359. *port_id = AFE_PORT_ID_INT4_MI2S_RX;
  4360. break;
  4361. case MSM_INT5_MI2S:
  4362. *port_id = AFE_PORT_ID_INT5_MI2S_RX;
  4363. break;
  4364. case MSM_INT6_MI2S:
  4365. *port_id = AFE_PORT_ID_INT6_MI2S_RX;
  4366. break;
  4367. default:
  4368. pr_err("%s: playback err id 0x%x\n",
  4369. __func__, mi2s_id);
  4370. ret = -1;
  4371. break;
  4372. }
  4373. break;
  4374. case SNDRV_PCM_STREAM_CAPTURE:
  4375. switch (mi2s_id) {
  4376. case MSM_PRIM_MI2S:
  4377. *port_id = AFE_PORT_ID_PRIMARY_MI2S_TX;
  4378. break;
  4379. case MSM_SEC_MI2S:
  4380. *port_id = AFE_PORT_ID_SECONDARY_MI2S_TX;
  4381. break;
  4382. case MSM_TERT_MI2S:
  4383. *port_id = AFE_PORT_ID_TERTIARY_MI2S_TX;
  4384. break;
  4385. case MSM_QUAT_MI2S:
  4386. *port_id = AFE_PORT_ID_QUATERNARY_MI2S_TX;
  4387. break;
  4388. case MSM_QUIN_MI2S:
  4389. *port_id = AFE_PORT_ID_QUINARY_MI2S_TX;
  4390. break;
  4391. case MSM_SENARY_MI2S:
  4392. *port_id = AFE_PORT_ID_SENARY_MI2S_TX;
  4393. break;
  4394. case MSM_INT0_MI2S:
  4395. *port_id = AFE_PORT_ID_INT0_MI2S_TX;
  4396. break;
  4397. case MSM_INT1_MI2S:
  4398. *port_id = AFE_PORT_ID_INT1_MI2S_TX;
  4399. break;
  4400. case MSM_INT2_MI2S:
  4401. *port_id = AFE_PORT_ID_INT2_MI2S_TX;
  4402. break;
  4403. case MSM_INT3_MI2S:
  4404. *port_id = AFE_PORT_ID_INT3_MI2S_TX;
  4405. break;
  4406. case MSM_INT4_MI2S:
  4407. *port_id = AFE_PORT_ID_INT4_MI2S_TX;
  4408. break;
  4409. case MSM_INT5_MI2S:
  4410. *port_id = AFE_PORT_ID_INT5_MI2S_TX;
  4411. break;
  4412. case MSM_INT6_MI2S:
  4413. *port_id = AFE_PORT_ID_INT6_MI2S_TX;
  4414. break;
  4415. default:
  4416. pr_err("%s: capture err id 0x%x\n", __func__, mi2s_id);
  4417. ret = -1;
  4418. break;
  4419. }
  4420. break;
  4421. default:
  4422. pr_err("%s: default err %d\n", __func__, stream);
  4423. ret = -1;
  4424. break;
  4425. }
  4426. pr_debug("%s: port_id = 0x%x\n", __func__, *port_id);
  4427. return ret;
  4428. }
  4429. static int msm_dai_q6_mi2s_prepare(struct snd_pcm_substream *substream,
  4430. struct snd_soc_dai *dai)
  4431. {
  4432. struct msm_dai_q6_mi2s_dai_data *mi2s_dai_data =
  4433. dev_get_drvdata(dai->dev);
  4434. struct msm_dai_q6_dai_data *dai_data =
  4435. (substream->stream == SNDRV_PCM_STREAM_PLAYBACK ?
  4436. &mi2s_dai_data->rx_dai.mi2s_dai_data :
  4437. &mi2s_dai_data->tx_dai.mi2s_dai_data);
  4438. u16 port_id = 0;
  4439. int rc = 0;
  4440. if (msm_mi2s_get_port_id(dai->id, substream->stream,
  4441. &port_id) != 0) {
  4442. dev_err(dai->dev, "%s: Invalid Port ID 0x%x\n",
  4443. __func__, port_id);
  4444. return -EINVAL;
  4445. }
  4446. dev_dbg(dai->dev, "%s: dai id %d, afe port id = 0x%x\n"
  4447. "dai_data->channels = %u sample_rate = %u\n", __func__,
  4448. dai->id, port_id, dai_data->channels, dai_data->rate);
  4449. if (!test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  4450. if (q6core_get_avcs_api_version_per_service(
  4451. APRV2_IDS_SERVICE_ID_ADSP_AFE_V) >= AFE_API_VERSION_V4) {
  4452. /*
  4453. * send island mode config.
  4454. * This should be the first configuration
  4455. */
  4456. rc = afe_send_port_island_mode(port_id);
  4457. if (rc)
  4458. dev_err(dai->dev, "%s: afe send island mode failed %d\n",
  4459. __func__, rc);
  4460. }
  4461. /* PORT START should be set if prepare called
  4462. * in active state.
  4463. */
  4464. rc = afe_port_start(port_id, &dai_data->port_config,
  4465. dai_data->rate);
  4466. if (rc < 0)
  4467. dev_err(dai->dev, "fail to open AFE port 0x%x\n",
  4468. dai->id);
  4469. else
  4470. set_bit(STATUS_PORT_STARTED,
  4471. dai_data->status_mask);
  4472. }
  4473. if (!test_bit(STATUS_PORT_STARTED, dai_data->hwfree_status)) {
  4474. set_bit(STATUS_PORT_STARTED, dai_data->hwfree_status);
  4475. dev_dbg(dai->dev, "%s: set hwfree_status to started\n",
  4476. __func__);
  4477. }
  4478. return rc;
  4479. }
  4480. static int msm_dai_q6_mi2s_hw_params(struct snd_pcm_substream *substream,
  4481. struct snd_pcm_hw_params *params,
  4482. struct snd_soc_dai *dai)
  4483. {
  4484. struct msm_dai_q6_mi2s_dai_data *mi2s_dai_data =
  4485. dev_get_drvdata(dai->dev);
  4486. struct msm_dai_q6_mi2s_dai_config *mi2s_dai_config =
  4487. (substream->stream == SNDRV_PCM_STREAM_PLAYBACK ?
  4488. &mi2s_dai_data->rx_dai : &mi2s_dai_data->tx_dai);
  4489. struct msm_dai_q6_dai_data *dai_data = &mi2s_dai_config->mi2s_dai_data;
  4490. struct afe_param_id_i2s_cfg *i2s = &dai_data->port_config.i2s;
  4491. dai_data->channels = params_channels(params);
  4492. switch (dai_data->channels) {
  4493. case 15:
  4494. case 16:
  4495. switch (mi2s_dai_config->pdata_mi2s_lines) {
  4496. case AFE_PORT_I2S_16CHS:
  4497. dai_data->port_config.i2s.channel_mode
  4498. = AFE_PORT_I2S_16CHS;
  4499. break;
  4500. default:
  4501. goto error_invalid_data;
  4502. };
  4503. break;
  4504. case 13:
  4505. case 14:
  4506. switch (mi2s_dai_config->pdata_mi2s_lines) {
  4507. case AFE_PORT_I2S_14CHS:
  4508. case AFE_PORT_I2S_16CHS:
  4509. dai_data->port_config.i2s.channel_mode
  4510. = AFE_PORT_I2S_14CHS;
  4511. break;
  4512. default:
  4513. goto error_invalid_data;
  4514. };
  4515. break;
  4516. case 11:
  4517. case 12:
  4518. switch (mi2s_dai_config->pdata_mi2s_lines) {
  4519. case AFE_PORT_I2S_12CHS:
  4520. case AFE_PORT_I2S_14CHS:
  4521. case AFE_PORT_I2S_16CHS:
  4522. dai_data->port_config.i2s.channel_mode
  4523. = AFE_PORT_I2S_12CHS;
  4524. break;
  4525. default:
  4526. goto error_invalid_data;
  4527. };
  4528. break;
  4529. case 9:
  4530. case 10:
  4531. switch (mi2s_dai_config->pdata_mi2s_lines) {
  4532. case AFE_PORT_I2S_10CHS:
  4533. case AFE_PORT_I2S_12CHS:
  4534. case AFE_PORT_I2S_14CHS:
  4535. case AFE_PORT_I2S_16CHS:
  4536. dai_data->port_config.i2s.channel_mode
  4537. = AFE_PORT_I2S_10CHS;
  4538. break;
  4539. default:
  4540. goto error_invalid_data;
  4541. };
  4542. break;
  4543. case 8:
  4544. case 7:
  4545. if (mi2s_dai_config->pdata_mi2s_lines < AFE_PORT_I2S_8CHS)
  4546. goto error_invalid_data;
  4547. else
  4548. if (mi2s_dai_config->pdata_mi2s_lines
  4549. == AFE_PORT_I2S_8CHS_2)
  4550. dai_data->port_config.i2s.channel_mode =
  4551. AFE_PORT_I2S_8CHS_2;
  4552. else
  4553. dai_data->port_config.i2s.channel_mode =
  4554. AFE_PORT_I2S_8CHS;
  4555. break;
  4556. case 6:
  4557. case 5:
  4558. if (mi2s_dai_config->pdata_mi2s_lines < AFE_PORT_I2S_6CHS)
  4559. goto error_invalid_data;
  4560. dai_data->port_config.i2s.channel_mode = AFE_PORT_I2S_6CHS;
  4561. break;
  4562. case 4:
  4563. case 3:
  4564. switch (mi2s_dai_config->pdata_mi2s_lines) {
  4565. case AFE_PORT_I2S_SD0:
  4566. case AFE_PORT_I2S_SD1:
  4567. case AFE_PORT_I2S_SD2:
  4568. case AFE_PORT_I2S_SD3:
  4569. case AFE_PORT_I2S_SD4:
  4570. case AFE_PORT_I2S_SD5:
  4571. case AFE_PORT_I2S_SD6:
  4572. case AFE_PORT_I2S_SD7:
  4573. goto error_invalid_data;
  4574. break;
  4575. case AFE_PORT_I2S_QUAD01:
  4576. case AFE_PORT_I2S_QUAD23:
  4577. case AFE_PORT_I2S_QUAD45:
  4578. case AFE_PORT_I2S_QUAD67:
  4579. dai_data->port_config.i2s.channel_mode =
  4580. mi2s_dai_config->pdata_mi2s_lines;
  4581. break;
  4582. case AFE_PORT_I2S_8CHS_2:
  4583. dai_data->port_config.i2s.channel_mode =
  4584. AFE_PORT_I2S_QUAD45;
  4585. break;
  4586. default:
  4587. dai_data->port_config.i2s.channel_mode =
  4588. AFE_PORT_I2S_QUAD01;
  4589. break;
  4590. };
  4591. break;
  4592. case 2:
  4593. case 1:
  4594. if (mi2s_dai_config->pdata_mi2s_lines < AFE_PORT_I2S_SD0)
  4595. goto error_invalid_data;
  4596. switch (mi2s_dai_config->pdata_mi2s_lines) {
  4597. case AFE_PORT_I2S_SD0:
  4598. case AFE_PORT_I2S_SD1:
  4599. case AFE_PORT_I2S_SD2:
  4600. case AFE_PORT_I2S_SD3:
  4601. case AFE_PORT_I2S_SD4:
  4602. case AFE_PORT_I2S_SD5:
  4603. case AFE_PORT_I2S_SD6:
  4604. case AFE_PORT_I2S_SD7:
  4605. dai_data->port_config.i2s.channel_mode =
  4606. mi2s_dai_config->pdata_mi2s_lines;
  4607. break;
  4608. case AFE_PORT_I2S_QUAD01:
  4609. case AFE_PORT_I2S_6CHS:
  4610. case AFE_PORT_I2S_8CHS:
  4611. case AFE_PORT_I2S_10CHS:
  4612. case AFE_PORT_I2S_12CHS:
  4613. case AFE_PORT_I2S_14CHS:
  4614. case AFE_PORT_I2S_16CHS:
  4615. if (dai_data->vi_feed_mono == SPKR_1)
  4616. dai_data->port_config.i2s.channel_mode =
  4617. AFE_PORT_I2S_SD0;
  4618. else
  4619. dai_data->port_config.i2s.channel_mode =
  4620. AFE_PORT_I2S_SD1;
  4621. break;
  4622. case AFE_PORT_I2S_QUAD23:
  4623. dai_data->port_config.i2s.channel_mode =
  4624. AFE_PORT_I2S_SD2;
  4625. break;
  4626. case AFE_PORT_I2S_QUAD45:
  4627. dai_data->port_config.i2s.channel_mode =
  4628. AFE_PORT_I2S_SD4;
  4629. break;
  4630. case AFE_PORT_I2S_QUAD67:
  4631. dai_data->port_config.i2s.channel_mode =
  4632. AFE_PORT_I2S_SD6;
  4633. break;
  4634. }
  4635. if (dai_data->channels == 2)
  4636. dai_data->port_config.i2s.mono_stereo =
  4637. MSM_AFE_CH_STEREO;
  4638. else
  4639. dai_data->port_config.i2s.mono_stereo = MSM_AFE_MONO;
  4640. break;
  4641. default:
  4642. pr_err("%s: default err channels %d\n",
  4643. __func__, dai_data->channels);
  4644. goto error_invalid_data;
  4645. }
  4646. dai_data->rate = params_rate(params);
  4647. switch (params_format(params)) {
  4648. case SNDRV_PCM_FORMAT_S16_LE:
  4649. case SNDRV_PCM_FORMAT_SPECIAL:
  4650. dai_data->port_config.i2s.bit_width = 16;
  4651. dai_data->bitwidth = 16;
  4652. break;
  4653. case SNDRV_PCM_FORMAT_S24_LE:
  4654. case SNDRV_PCM_FORMAT_S24_3LE:
  4655. dai_data->port_config.i2s.bit_width = 24;
  4656. dai_data->bitwidth = 24;
  4657. break;
  4658. default:
  4659. pr_err("%s: format %d\n",
  4660. __func__, params_format(params));
  4661. return -EINVAL;
  4662. }
  4663. dai_data->port_config.i2s.i2s_cfg_minor_version =
  4664. AFE_API_VERSION_I2S_CONFIG;
  4665. dai_data->port_config.i2s.sample_rate = dai_data->rate;
  4666. if ((test_bit(STATUS_PORT_STARTED,
  4667. mi2s_dai_data->rx_dai.mi2s_dai_data.status_mask) &&
  4668. test_bit(STATUS_PORT_STARTED,
  4669. mi2s_dai_data->rx_dai.mi2s_dai_data.hwfree_status)) ||
  4670. (test_bit(STATUS_PORT_STARTED,
  4671. mi2s_dai_data->tx_dai.mi2s_dai_data.status_mask) &&
  4672. test_bit(STATUS_PORT_STARTED,
  4673. mi2s_dai_data->tx_dai.mi2s_dai_data.hwfree_status))) {
  4674. if ((mi2s_dai_data->tx_dai.mi2s_dai_data.rate !=
  4675. mi2s_dai_data->rx_dai.mi2s_dai_data.rate) ||
  4676. (mi2s_dai_data->rx_dai.mi2s_dai_data.bitwidth !=
  4677. mi2s_dai_data->tx_dai.mi2s_dai_data.bitwidth)) {
  4678. dev_err(dai->dev, "%s: Error mismatch in HW params\n"
  4679. "Tx sample_rate = %u bit_width = %hu\n"
  4680. "Rx sample_rate = %u bit_width = %hu\n"
  4681. , __func__,
  4682. mi2s_dai_data->tx_dai.mi2s_dai_data.rate,
  4683. mi2s_dai_data->tx_dai.mi2s_dai_data.bitwidth,
  4684. mi2s_dai_data->rx_dai.mi2s_dai_data.rate,
  4685. mi2s_dai_data->rx_dai.mi2s_dai_data.bitwidth);
  4686. return -EINVAL;
  4687. }
  4688. }
  4689. dev_dbg(dai->dev, "%s: dai id %d dai_data->channels = %d\n"
  4690. "sample_rate = %u i2s_cfg_minor_version = 0x%x\n"
  4691. "bit_width = %hu channel_mode = 0x%x mono_stereo = %#x\n"
  4692. "ws_src = 0x%x sample_rate = %u data_format = 0x%x\n"
  4693. "reserved = %u\n", __func__, dai->id, dai_data->channels,
  4694. dai_data->rate, i2s->i2s_cfg_minor_version, i2s->bit_width,
  4695. i2s->channel_mode, i2s->mono_stereo, i2s->ws_src,
  4696. i2s->sample_rate, i2s->data_format, i2s->reserved);
  4697. return 0;
  4698. error_invalid_data:
  4699. pr_err("%s: dai_data->channels = %d channel_mode = %d\n", __func__,
  4700. dai_data->channels, dai_data->port_config.i2s.channel_mode);
  4701. return -EINVAL;
  4702. }
  4703. static int msm_dai_q6_mi2s_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
  4704. {
  4705. struct msm_dai_q6_mi2s_dai_data *mi2s_dai_data =
  4706. dev_get_drvdata(dai->dev);
  4707. if (test_bit(STATUS_PORT_STARTED,
  4708. mi2s_dai_data->rx_dai.mi2s_dai_data.status_mask) ||
  4709. test_bit(STATUS_PORT_STARTED,
  4710. mi2s_dai_data->tx_dai.mi2s_dai_data.status_mask)) {
  4711. dev_err(dai->dev, "%s: err chg i2s mode while dai running",
  4712. __func__);
  4713. return -EPERM;
  4714. }
  4715. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  4716. case SND_SOC_DAIFMT_CBS_CFS:
  4717. mi2s_dai_data->rx_dai.mi2s_dai_data.port_config.i2s.ws_src = 1;
  4718. mi2s_dai_data->tx_dai.mi2s_dai_data.port_config.i2s.ws_src = 1;
  4719. break;
  4720. case SND_SOC_DAIFMT_CBM_CFM:
  4721. mi2s_dai_data->rx_dai.mi2s_dai_data.port_config.i2s.ws_src = 0;
  4722. mi2s_dai_data->tx_dai.mi2s_dai_data.port_config.i2s.ws_src = 0;
  4723. break;
  4724. default:
  4725. pr_err("%s: fmt %d\n",
  4726. __func__, fmt & SND_SOC_DAIFMT_MASTER_MASK);
  4727. return -EINVAL;
  4728. }
  4729. return 0;
  4730. }
  4731. static int msm_dai_q6_mi2s_hw_free(struct snd_pcm_substream *substream,
  4732. struct snd_soc_dai *dai)
  4733. {
  4734. struct msm_dai_q6_mi2s_dai_data *mi2s_dai_data =
  4735. dev_get_drvdata(dai->dev);
  4736. struct msm_dai_q6_dai_data *dai_data =
  4737. (substream->stream == SNDRV_PCM_STREAM_PLAYBACK ?
  4738. &mi2s_dai_data->rx_dai.mi2s_dai_data :
  4739. &mi2s_dai_data->tx_dai.mi2s_dai_data);
  4740. if (test_bit(STATUS_PORT_STARTED, dai_data->hwfree_status)) {
  4741. clear_bit(STATUS_PORT_STARTED, dai_data->hwfree_status);
  4742. dev_dbg(dai->dev, "%s: clear hwfree_status\n", __func__);
  4743. }
  4744. return 0;
  4745. }
  4746. static void msm_dai_q6_mi2s_shutdown(struct snd_pcm_substream *substream,
  4747. struct snd_soc_dai *dai)
  4748. {
  4749. struct msm_dai_q6_mi2s_dai_data *mi2s_dai_data =
  4750. dev_get_drvdata(dai->dev);
  4751. struct msm_dai_q6_dai_data *dai_data =
  4752. (substream->stream == SNDRV_PCM_STREAM_PLAYBACK ?
  4753. &mi2s_dai_data->rx_dai.mi2s_dai_data :
  4754. &mi2s_dai_data->tx_dai.mi2s_dai_data);
  4755. u16 port_id = 0;
  4756. int rc = 0;
  4757. if (msm_mi2s_get_port_id(dai->id, substream->stream,
  4758. &port_id) != 0) {
  4759. dev_err(dai->dev, "%s: Invalid Port ID 0x%x\n",
  4760. __func__, port_id);
  4761. }
  4762. dev_dbg(dai->dev, "%s: closing afe port id = 0x%x\n",
  4763. __func__, port_id);
  4764. if (test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  4765. rc = afe_close(port_id);
  4766. if (rc < 0)
  4767. dev_err(dai->dev, "fail to close AFE port\n");
  4768. clear_bit(STATUS_PORT_STARTED, dai_data->status_mask);
  4769. }
  4770. if (test_bit(STATUS_PORT_STARTED, dai_data->hwfree_status))
  4771. clear_bit(STATUS_PORT_STARTED, dai_data->hwfree_status);
  4772. }
  4773. static struct snd_soc_dai_ops msm_dai_q6_mi2s_ops = {
  4774. .startup = msm_dai_q6_mi2s_startup,
  4775. .prepare = msm_dai_q6_mi2s_prepare,
  4776. .hw_params = msm_dai_q6_mi2s_hw_params,
  4777. .hw_free = msm_dai_q6_mi2s_hw_free,
  4778. .set_fmt = msm_dai_q6_mi2s_set_fmt,
  4779. .shutdown = msm_dai_q6_mi2s_shutdown,
  4780. };
  4781. /* Channel min and max are initialized base on platform data */
  4782. static struct snd_soc_dai_driver msm_dai_q6_mi2s_dai[] = {
  4783. {
  4784. .playback = {
  4785. .stream_name = "Primary MI2S Playback",
  4786. .aif_name = "PRI_MI2S_RX",
  4787. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  4788. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  4789. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  4790. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  4791. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  4792. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  4793. SNDRV_PCM_RATE_384000,
  4794. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  4795. SNDRV_PCM_FMTBIT_S24_LE |
  4796. SNDRV_PCM_FMTBIT_S24_3LE,
  4797. .rate_min = 8000,
  4798. .rate_max = 384000,
  4799. },
  4800. .capture = {
  4801. .stream_name = "Primary MI2S Capture",
  4802. .aif_name = "PRI_MI2S_TX",
  4803. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  4804. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  4805. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  4806. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  4807. SNDRV_PCM_RATE_192000,
  4808. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  4809. .rate_min = 8000,
  4810. .rate_max = 192000,
  4811. },
  4812. .ops = &msm_dai_q6_mi2s_ops,
  4813. .name = "Primary MI2S",
  4814. .id = MSM_PRIM_MI2S,
  4815. .probe = msm_dai_q6_dai_mi2s_probe,
  4816. .remove = msm_dai_q6_dai_mi2s_remove,
  4817. },
  4818. {
  4819. .playback = {
  4820. .stream_name = "Secondary MI2S Playback",
  4821. .aif_name = "SEC_MI2S_RX",
  4822. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  4823. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  4824. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  4825. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  4826. SNDRV_PCM_RATE_192000,
  4827. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  4828. .rate_min = 8000,
  4829. .rate_max = 192000,
  4830. },
  4831. .capture = {
  4832. .stream_name = "Secondary MI2S Capture",
  4833. .aif_name = "SEC_MI2S_TX",
  4834. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  4835. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  4836. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  4837. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  4838. SNDRV_PCM_RATE_192000,
  4839. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  4840. .rate_min = 8000,
  4841. .rate_max = 192000,
  4842. },
  4843. .ops = &msm_dai_q6_mi2s_ops,
  4844. .name = "Secondary MI2S",
  4845. .id = MSM_SEC_MI2S,
  4846. .probe = msm_dai_q6_dai_mi2s_probe,
  4847. .remove = msm_dai_q6_dai_mi2s_remove,
  4848. },
  4849. {
  4850. .playback = {
  4851. .stream_name = "Tertiary MI2S Playback",
  4852. .aif_name = "TERT_MI2S_RX",
  4853. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  4854. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  4855. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  4856. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  4857. SNDRV_PCM_RATE_192000,
  4858. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  4859. .rate_min = 8000,
  4860. .rate_max = 192000,
  4861. },
  4862. .capture = {
  4863. .stream_name = "Tertiary MI2S Capture",
  4864. .aif_name = "TERT_MI2S_TX",
  4865. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  4866. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  4867. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  4868. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  4869. SNDRV_PCM_RATE_192000,
  4870. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  4871. .rate_min = 8000,
  4872. .rate_max = 192000,
  4873. },
  4874. .ops = &msm_dai_q6_mi2s_ops,
  4875. .name = "Tertiary MI2S",
  4876. .id = MSM_TERT_MI2S,
  4877. .probe = msm_dai_q6_dai_mi2s_probe,
  4878. .remove = msm_dai_q6_dai_mi2s_remove,
  4879. },
  4880. {
  4881. .playback = {
  4882. .stream_name = "Quaternary MI2S Playback",
  4883. .aif_name = "QUAT_MI2S_RX",
  4884. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  4885. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  4886. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  4887. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  4888. SNDRV_PCM_RATE_192000,
  4889. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  4890. .rate_min = 8000,
  4891. .rate_max = 192000,
  4892. },
  4893. .capture = {
  4894. .stream_name = "Quaternary MI2S Capture",
  4895. .aif_name = "QUAT_MI2S_TX",
  4896. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  4897. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  4898. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  4899. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  4900. SNDRV_PCM_RATE_192000,
  4901. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  4902. .rate_min = 8000,
  4903. .rate_max = 192000,
  4904. },
  4905. .ops = &msm_dai_q6_mi2s_ops,
  4906. .name = "Quaternary MI2S",
  4907. .id = MSM_QUAT_MI2S,
  4908. .probe = msm_dai_q6_dai_mi2s_probe,
  4909. .remove = msm_dai_q6_dai_mi2s_remove,
  4910. },
  4911. {
  4912. .playback = {
  4913. .stream_name = "Quinary MI2S Playback",
  4914. .aif_name = "QUIN_MI2S_RX",
  4915. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  4916. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_96000 |
  4917. SNDRV_PCM_RATE_192000,
  4918. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  4919. .rate_min = 8000,
  4920. .rate_max = 192000,
  4921. },
  4922. .capture = {
  4923. .stream_name = "Quinary MI2S Capture",
  4924. .aif_name = "QUIN_MI2S_TX",
  4925. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  4926. SNDRV_PCM_RATE_16000,
  4927. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  4928. .rate_min = 8000,
  4929. .rate_max = 48000,
  4930. },
  4931. .ops = &msm_dai_q6_mi2s_ops,
  4932. .name = "Quinary MI2S",
  4933. .id = MSM_QUIN_MI2S,
  4934. .probe = msm_dai_q6_dai_mi2s_probe,
  4935. .remove = msm_dai_q6_dai_mi2s_remove,
  4936. },
  4937. {
  4938. .playback = {
  4939. .stream_name = "Secondary MI2S Playback SD1",
  4940. .aif_name = "SEC_MI2S_RX_SD1",
  4941. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  4942. SNDRV_PCM_RATE_16000,
  4943. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  4944. .rate_min = 8000,
  4945. .rate_max = 48000,
  4946. },
  4947. .id = MSM_SEC_MI2S_SD1,
  4948. },
  4949. {
  4950. .capture = {
  4951. .stream_name = "Senary_mi2s Capture",
  4952. .aif_name = "SENARY_TX",
  4953. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  4954. SNDRV_PCM_RATE_16000,
  4955. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  4956. .rate_min = 8000,
  4957. .rate_max = 48000,
  4958. },
  4959. .ops = &msm_dai_q6_mi2s_ops,
  4960. .name = "Senary MI2S",
  4961. .id = MSM_SENARY_MI2S,
  4962. .probe = msm_dai_q6_dai_mi2s_probe,
  4963. .remove = msm_dai_q6_dai_mi2s_remove,
  4964. },
  4965. {
  4966. .playback = {
  4967. .stream_name = "INT0 MI2S Playback",
  4968. .aif_name = "INT0_MI2S_RX",
  4969. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  4970. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_44100 |
  4971. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_192000,
  4972. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  4973. SNDRV_PCM_FMTBIT_S24_LE |
  4974. SNDRV_PCM_FMTBIT_S24_3LE,
  4975. .rate_min = 8000,
  4976. .rate_max = 192000,
  4977. },
  4978. .capture = {
  4979. .stream_name = "INT0 MI2S Capture",
  4980. .aif_name = "INT0_MI2S_TX",
  4981. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  4982. SNDRV_PCM_RATE_16000,
  4983. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  4984. .rate_min = 8000,
  4985. .rate_max = 48000,
  4986. },
  4987. .ops = &msm_dai_q6_mi2s_ops,
  4988. .name = "INT0 MI2S",
  4989. .id = MSM_INT0_MI2S,
  4990. .probe = msm_dai_q6_dai_mi2s_probe,
  4991. .remove = msm_dai_q6_dai_mi2s_remove,
  4992. },
  4993. {
  4994. .playback = {
  4995. .stream_name = "INT1 MI2S Playback",
  4996. .aif_name = "INT1_MI2S_RX",
  4997. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  4998. SNDRV_PCM_RATE_16000,
  4999. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  5000. SNDRV_PCM_FMTBIT_S24_LE |
  5001. SNDRV_PCM_FMTBIT_S24_3LE,
  5002. .rate_min = 8000,
  5003. .rate_max = 48000,
  5004. },
  5005. .capture = {
  5006. .stream_name = "INT1 MI2S Capture",
  5007. .aif_name = "INT1_MI2S_TX",
  5008. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  5009. SNDRV_PCM_RATE_16000,
  5010. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  5011. .rate_min = 8000,
  5012. .rate_max = 48000,
  5013. },
  5014. .ops = &msm_dai_q6_mi2s_ops,
  5015. .name = "INT1 MI2S",
  5016. .id = MSM_INT1_MI2S,
  5017. .probe = msm_dai_q6_dai_mi2s_probe,
  5018. .remove = msm_dai_q6_dai_mi2s_remove,
  5019. },
  5020. {
  5021. .playback = {
  5022. .stream_name = "INT2 MI2S Playback",
  5023. .aif_name = "INT2_MI2S_RX",
  5024. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  5025. SNDRV_PCM_RATE_16000,
  5026. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  5027. SNDRV_PCM_FMTBIT_S24_LE |
  5028. SNDRV_PCM_FMTBIT_S24_3LE,
  5029. .rate_min = 8000,
  5030. .rate_max = 48000,
  5031. },
  5032. .capture = {
  5033. .stream_name = "INT2 MI2S Capture",
  5034. .aif_name = "INT2_MI2S_TX",
  5035. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  5036. SNDRV_PCM_RATE_16000,
  5037. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  5038. .rate_min = 8000,
  5039. .rate_max = 48000,
  5040. },
  5041. .ops = &msm_dai_q6_mi2s_ops,
  5042. .name = "INT2 MI2S",
  5043. .id = MSM_INT2_MI2S,
  5044. .probe = msm_dai_q6_dai_mi2s_probe,
  5045. .remove = msm_dai_q6_dai_mi2s_remove,
  5046. },
  5047. {
  5048. .playback = {
  5049. .stream_name = "INT3 MI2S Playback",
  5050. .aif_name = "INT3_MI2S_RX",
  5051. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  5052. SNDRV_PCM_RATE_16000,
  5053. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  5054. SNDRV_PCM_FMTBIT_S24_LE |
  5055. SNDRV_PCM_FMTBIT_S24_3LE,
  5056. .rate_min = 8000,
  5057. .rate_max = 48000,
  5058. },
  5059. .capture = {
  5060. .stream_name = "INT3 MI2S Capture",
  5061. .aif_name = "INT3_MI2S_TX",
  5062. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  5063. SNDRV_PCM_RATE_16000,
  5064. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  5065. .rate_min = 8000,
  5066. .rate_max = 48000,
  5067. },
  5068. .ops = &msm_dai_q6_mi2s_ops,
  5069. .name = "INT3 MI2S",
  5070. .id = MSM_INT3_MI2S,
  5071. .probe = msm_dai_q6_dai_mi2s_probe,
  5072. .remove = msm_dai_q6_dai_mi2s_remove,
  5073. },
  5074. {
  5075. .playback = {
  5076. .stream_name = "INT4 MI2S Playback",
  5077. .aif_name = "INT4_MI2S_RX",
  5078. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  5079. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_96000 |
  5080. SNDRV_PCM_RATE_192000,
  5081. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  5082. SNDRV_PCM_FMTBIT_S24_LE |
  5083. SNDRV_PCM_FMTBIT_S24_3LE,
  5084. .rate_min = 8000,
  5085. .rate_max = 192000,
  5086. },
  5087. .capture = {
  5088. .stream_name = "INT4 MI2S Capture",
  5089. .aif_name = "INT4_MI2S_TX",
  5090. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  5091. SNDRV_PCM_RATE_16000,
  5092. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  5093. .rate_min = 8000,
  5094. .rate_max = 48000,
  5095. },
  5096. .ops = &msm_dai_q6_mi2s_ops,
  5097. .name = "INT4 MI2S",
  5098. .id = MSM_INT4_MI2S,
  5099. .probe = msm_dai_q6_dai_mi2s_probe,
  5100. .remove = msm_dai_q6_dai_mi2s_remove,
  5101. },
  5102. {
  5103. .playback = {
  5104. .stream_name = "INT5 MI2S Playback",
  5105. .aif_name = "INT5_MI2S_RX",
  5106. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  5107. SNDRV_PCM_RATE_16000,
  5108. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  5109. SNDRV_PCM_FMTBIT_S24_LE |
  5110. SNDRV_PCM_FMTBIT_S24_3LE,
  5111. .rate_min = 8000,
  5112. .rate_max = 48000,
  5113. },
  5114. .capture = {
  5115. .stream_name = "INT5 MI2S Capture",
  5116. .aif_name = "INT5_MI2S_TX",
  5117. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  5118. SNDRV_PCM_RATE_16000,
  5119. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  5120. .rate_min = 8000,
  5121. .rate_max = 48000,
  5122. },
  5123. .ops = &msm_dai_q6_mi2s_ops,
  5124. .name = "INT5 MI2S",
  5125. .id = MSM_INT5_MI2S,
  5126. .probe = msm_dai_q6_dai_mi2s_probe,
  5127. .remove = msm_dai_q6_dai_mi2s_remove,
  5128. },
  5129. {
  5130. .playback = {
  5131. .stream_name = "INT6 MI2S Playback",
  5132. .aif_name = "INT6_MI2S_RX",
  5133. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  5134. SNDRV_PCM_RATE_16000,
  5135. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  5136. SNDRV_PCM_FMTBIT_S24_LE |
  5137. SNDRV_PCM_FMTBIT_S24_3LE,
  5138. .rate_min = 8000,
  5139. .rate_max = 48000,
  5140. },
  5141. .capture = {
  5142. .stream_name = "INT6 MI2S Capture",
  5143. .aif_name = "INT6_MI2S_TX",
  5144. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  5145. SNDRV_PCM_RATE_16000,
  5146. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  5147. .rate_min = 8000,
  5148. .rate_max = 48000,
  5149. },
  5150. .ops = &msm_dai_q6_mi2s_ops,
  5151. .name = "INT6 MI2S",
  5152. .id = MSM_INT6_MI2S,
  5153. .probe = msm_dai_q6_dai_mi2s_probe,
  5154. .remove = msm_dai_q6_dai_mi2s_remove,
  5155. },
  5156. };
  5157. static int msm_dai_q6_mi2s_get_lineconfig(u16 sd_lines, u16 *config_ptr,
  5158. unsigned int *ch_cnt)
  5159. {
  5160. u8 num_of_sd_lines;
  5161. num_of_sd_lines = num_of_bits_set(sd_lines);
  5162. switch (num_of_sd_lines) {
  5163. case 0:
  5164. pr_debug("%s: no line is assigned\n", __func__);
  5165. break;
  5166. case 1:
  5167. switch (sd_lines) {
  5168. case MSM_MI2S_SD0:
  5169. *config_ptr = AFE_PORT_I2S_SD0;
  5170. break;
  5171. case MSM_MI2S_SD1:
  5172. *config_ptr = AFE_PORT_I2S_SD1;
  5173. break;
  5174. case MSM_MI2S_SD2:
  5175. *config_ptr = AFE_PORT_I2S_SD2;
  5176. break;
  5177. case MSM_MI2S_SD3:
  5178. *config_ptr = AFE_PORT_I2S_SD3;
  5179. break;
  5180. case MSM_MI2S_SD4:
  5181. *config_ptr = AFE_PORT_I2S_SD4;
  5182. break;
  5183. case MSM_MI2S_SD5:
  5184. *config_ptr = AFE_PORT_I2S_SD5;
  5185. break;
  5186. case MSM_MI2S_SD6:
  5187. *config_ptr = AFE_PORT_I2S_SD6;
  5188. break;
  5189. case MSM_MI2S_SD7:
  5190. *config_ptr = AFE_PORT_I2S_SD7;
  5191. break;
  5192. default:
  5193. pr_err("%s: invalid SD lines %d\n",
  5194. __func__, sd_lines);
  5195. goto error_invalid_data;
  5196. }
  5197. break;
  5198. case 2:
  5199. switch (sd_lines) {
  5200. case MSM_MI2S_SD0 | MSM_MI2S_SD1:
  5201. *config_ptr = AFE_PORT_I2S_QUAD01;
  5202. break;
  5203. case MSM_MI2S_SD2 | MSM_MI2S_SD3:
  5204. *config_ptr = AFE_PORT_I2S_QUAD23;
  5205. break;
  5206. case MSM_MI2S_SD4 | MSM_MI2S_SD5:
  5207. *config_ptr = AFE_PORT_I2S_QUAD45;
  5208. break;
  5209. case MSM_MI2S_SD6 | MSM_MI2S_SD7:
  5210. *config_ptr = AFE_PORT_I2S_QUAD67;
  5211. break;
  5212. default:
  5213. pr_err("%s: invalid SD lines %d\n",
  5214. __func__, sd_lines);
  5215. goto error_invalid_data;
  5216. }
  5217. break;
  5218. case 3:
  5219. switch (sd_lines) {
  5220. case MSM_MI2S_SD0 | MSM_MI2S_SD1 | MSM_MI2S_SD2:
  5221. *config_ptr = AFE_PORT_I2S_6CHS;
  5222. break;
  5223. default:
  5224. pr_err("%s: invalid SD lines %d\n",
  5225. __func__, sd_lines);
  5226. goto error_invalid_data;
  5227. }
  5228. break;
  5229. case 4:
  5230. switch (sd_lines) {
  5231. case MSM_MI2S_SD0 | MSM_MI2S_SD1 | MSM_MI2S_SD2 | MSM_MI2S_SD3:
  5232. *config_ptr = AFE_PORT_I2S_8CHS;
  5233. break;
  5234. case MSM_MI2S_SD4 | MSM_MI2S_SD5 | MSM_MI2S_SD6 | MSM_MI2S_SD7:
  5235. *config_ptr = AFE_PORT_I2S_8CHS_2;
  5236. break;
  5237. default:
  5238. pr_err("%s: invalid SD lines %d\n",
  5239. __func__, sd_lines);
  5240. goto error_invalid_data;
  5241. }
  5242. break;
  5243. case 5:
  5244. switch (sd_lines) {
  5245. case MSM_MI2S_SD0 | MSM_MI2S_SD1 | MSM_MI2S_SD2
  5246. | MSM_MI2S_SD3 | MSM_MI2S_SD4:
  5247. *config_ptr = AFE_PORT_I2S_10CHS;
  5248. break;
  5249. default:
  5250. pr_err("%s: invalid SD lines %d\n",
  5251. __func__, sd_lines);
  5252. goto error_invalid_data;
  5253. }
  5254. break;
  5255. case 6:
  5256. switch (sd_lines) {
  5257. case MSM_MI2S_SD0 | MSM_MI2S_SD1 | MSM_MI2S_SD2
  5258. | MSM_MI2S_SD3 | MSM_MI2S_SD4 | MSM_MI2S_SD5:
  5259. *config_ptr = AFE_PORT_I2S_12CHS;
  5260. break;
  5261. default:
  5262. pr_err("%s: invalid SD lines %d\n",
  5263. __func__, sd_lines);
  5264. goto error_invalid_data;
  5265. }
  5266. break;
  5267. case 7:
  5268. switch (sd_lines) {
  5269. case MSM_MI2S_SD0 | MSM_MI2S_SD1 | MSM_MI2S_SD2 | MSM_MI2S_SD3
  5270. | MSM_MI2S_SD4 | MSM_MI2S_SD5 | MSM_MI2S_SD6:
  5271. *config_ptr = AFE_PORT_I2S_14CHS;
  5272. break;
  5273. default:
  5274. pr_err("%s: invalid SD lines %d\n",
  5275. __func__, sd_lines);
  5276. goto error_invalid_data;
  5277. }
  5278. break;
  5279. case 8:
  5280. switch (sd_lines) {
  5281. case MSM_MI2S_SD0 | MSM_MI2S_SD1 | MSM_MI2S_SD2 | MSM_MI2S_SD3
  5282. | MSM_MI2S_SD4 | MSM_MI2S_SD5 | MSM_MI2S_SD6 | MSM_MI2S_SD7:
  5283. *config_ptr = AFE_PORT_I2S_16CHS;
  5284. break;
  5285. default:
  5286. pr_err("%s: invalid SD lines %d\n",
  5287. __func__, sd_lines);
  5288. goto error_invalid_data;
  5289. }
  5290. break;
  5291. default:
  5292. pr_err("%s: invalid SD lines %d\n", __func__, num_of_sd_lines);
  5293. goto error_invalid_data;
  5294. }
  5295. *ch_cnt = num_of_sd_lines;
  5296. return 0;
  5297. error_invalid_data:
  5298. pr_err("%s: invalid data\n", __func__);
  5299. return -EINVAL;
  5300. }
  5301. static int msm_dai_q6_mi2s_platform_data_validation(
  5302. struct platform_device *pdev, struct snd_soc_dai_driver *dai_driver)
  5303. {
  5304. struct msm_dai_q6_mi2s_dai_data *dai_data = dev_get_drvdata(&pdev->dev);
  5305. struct msm_mi2s_pdata *mi2s_pdata =
  5306. (struct msm_mi2s_pdata *) pdev->dev.platform_data;
  5307. unsigned int ch_cnt;
  5308. int rc = 0;
  5309. u16 sd_line;
  5310. if (mi2s_pdata == NULL) {
  5311. pr_err("%s: mi2s_pdata NULL", __func__);
  5312. return -EINVAL;
  5313. }
  5314. rc = msm_dai_q6_mi2s_get_lineconfig(mi2s_pdata->rx_sd_lines,
  5315. &sd_line, &ch_cnt);
  5316. if (rc < 0) {
  5317. dev_err(&pdev->dev, "invalid MI2S RX sd line config\n");
  5318. goto rtn;
  5319. }
  5320. if (ch_cnt) {
  5321. dai_data->rx_dai.mi2s_dai_data.port_config.i2s.channel_mode =
  5322. sd_line;
  5323. dai_data->rx_dai.pdata_mi2s_lines = sd_line;
  5324. dai_driver->playback.channels_min = 1;
  5325. dai_driver->playback.channels_max = ch_cnt << 1;
  5326. } else {
  5327. dai_driver->playback.channels_min = 0;
  5328. dai_driver->playback.channels_max = 0;
  5329. }
  5330. rc = msm_dai_q6_mi2s_get_lineconfig(mi2s_pdata->tx_sd_lines,
  5331. &sd_line, &ch_cnt);
  5332. if (rc < 0) {
  5333. dev_err(&pdev->dev, "invalid MI2S TX sd line config\n");
  5334. goto rtn;
  5335. }
  5336. if (ch_cnt) {
  5337. dai_data->tx_dai.mi2s_dai_data.port_config.i2s.channel_mode =
  5338. sd_line;
  5339. dai_data->tx_dai.pdata_mi2s_lines = sd_line;
  5340. dai_driver->capture.channels_min = 1;
  5341. dai_driver->capture.channels_max = ch_cnt << 1;
  5342. } else {
  5343. dai_driver->capture.channels_min = 0;
  5344. dai_driver->capture.channels_max = 0;
  5345. }
  5346. dev_dbg(&pdev->dev, "%s: playback sdline 0x%x capture sdline 0x%x\n",
  5347. __func__, dai_data->rx_dai.pdata_mi2s_lines,
  5348. dai_data->tx_dai.pdata_mi2s_lines);
  5349. dev_dbg(&pdev->dev, "%s: playback ch_max %d capture ch_mx %d\n",
  5350. __func__, dai_driver->playback.channels_max,
  5351. dai_driver->capture.channels_max);
  5352. rtn:
  5353. return rc;
  5354. }
  5355. static const struct snd_soc_component_driver msm_q6_mi2s_dai_component = {
  5356. .name = "msm-dai-q6-mi2s",
  5357. };
  5358. static int msm_dai_q6_mi2s_dev_probe(struct platform_device *pdev)
  5359. {
  5360. struct msm_dai_q6_mi2s_dai_data *dai_data;
  5361. const char *q6_mi2s_dev_id = "qcom,msm-dai-q6-mi2s-dev-id";
  5362. u32 tx_line = 0;
  5363. u32 rx_line = 0;
  5364. u32 mi2s_intf = 0;
  5365. struct msm_mi2s_pdata *mi2s_pdata;
  5366. int rc;
  5367. rc = of_property_read_u32(pdev->dev.of_node, q6_mi2s_dev_id,
  5368. &mi2s_intf);
  5369. if (rc) {
  5370. dev_err(&pdev->dev,
  5371. "%s: missing 0x%x in dt node\n", __func__, mi2s_intf);
  5372. goto rtn;
  5373. }
  5374. dev_dbg(&pdev->dev, "dev name %s dev id 0x%x\n", dev_name(&pdev->dev),
  5375. mi2s_intf);
  5376. if ((mi2s_intf < MSM_MI2S_MIN || mi2s_intf > MSM_MI2S_MAX)
  5377. || (mi2s_intf >= ARRAY_SIZE(msm_dai_q6_mi2s_dai))) {
  5378. dev_err(&pdev->dev,
  5379. "%s: Invalid MI2S ID %u from Device Tree\n",
  5380. __func__, mi2s_intf);
  5381. rc = -ENXIO;
  5382. goto rtn;
  5383. }
  5384. pdev->id = mi2s_intf;
  5385. mi2s_pdata = kzalloc(sizeof(struct msm_mi2s_pdata), GFP_KERNEL);
  5386. if (!mi2s_pdata) {
  5387. rc = -ENOMEM;
  5388. goto rtn;
  5389. }
  5390. rc = of_property_read_u32(pdev->dev.of_node, "qcom,msm-mi2s-rx-lines",
  5391. &rx_line);
  5392. if (rc) {
  5393. dev_err(&pdev->dev, "%s: Rx line from DT file %s\n", __func__,
  5394. "qcom,msm-mi2s-rx-lines");
  5395. goto free_pdata;
  5396. }
  5397. rc = of_property_read_u32(pdev->dev.of_node, "qcom,msm-mi2s-tx-lines",
  5398. &tx_line);
  5399. if (rc) {
  5400. dev_err(&pdev->dev, "%s: Tx line from DT file %s\n", __func__,
  5401. "qcom,msm-mi2s-tx-lines");
  5402. goto free_pdata;
  5403. }
  5404. dev_dbg(&pdev->dev, "dev name %s Rx line 0x%x , Tx ine 0x%x\n",
  5405. dev_name(&pdev->dev), rx_line, tx_line);
  5406. mi2s_pdata->rx_sd_lines = rx_line;
  5407. mi2s_pdata->tx_sd_lines = tx_line;
  5408. mi2s_pdata->intf_id = mi2s_intf;
  5409. dai_data = kzalloc(sizeof(struct msm_dai_q6_mi2s_dai_data),
  5410. GFP_KERNEL);
  5411. if (!dai_data) {
  5412. rc = -ENOMEM;
  5413. goto free_pdata;
  5414. } else
  5415. dev_set_drvdata(&pdev->dev, dai_data);
  5416. rc = of_property_read_u32(pdev->dev.of_node,
  5417. "qcom,msm-dai-is-island-supported",
  5418. &dai_data->is_island_dai);
  5419. if (rc)
  5420. dev_dbg(&pdev->dev, "island supported entry not found\n");
  5421. pdev->dev.platform_data = mi2s_pdata;
  5422. rc = msm_dai_q6_mi2s_platform_data_validation(pdev,
  5423. &msm_dai_q6_mi2s_dai[mi2s_intf]);
  5424. if (rc < 0)
  5425. goto free_dai_data;
  5426. rc = snd_soc_register_component(&pdev->dev, &msm_q6_mi2s_dai_component,
  5427. &msm_dai_q6_mi2s_dai[mi2s_intf], 1);
  5428. if (rc < 0)
  5429. goto err_register;
  5430. return 0;
  5431. err_register:
  5432. dev_err(&pdev->dev, "fail to msm_dai_q6_mi2s_dev_probe\n");
  5433. free_dai_data:
  5434. kfree(dai_data);
  5435. free_pdata:
  5436. kfree(mi2s_pdata);
  5437. rtn:
  5438. return rc;
  5439. }
  5440. static int msm_dai_q6_mi2s_dev_remove(struct platform_device *pdev)
  5441. {
  5442. snd_soc_unregister_component(&pdev->dev);
  5443. return 0;
  5444. }
  5445. static const struct snd_soc_component_driver msm_dai_q6_component = {
  5446. .name = "msm-dai-q6-dev",
  5447. };
  5448. static int msm_dai_q6_dev_probe(struct platform_device *pdev)
  5449. {
  5450. int rc, id, i, len;
  5451. const char *q6_dev_id = "qcom,msm-dai-q6-dev-id";
  5452. char stream_name[80];
  5453. rc = of_property_read_u32(pdev->dev.of_node, q6_dev_id, &id);
  5454. if (rc) {
  5455. dev_err(&pdev->dev,
  5456. "%s: missing %s in dt node\n", __func__, q6_dev_id);
  5457. return rc;
  5458. }
  5459. pdev->id = id;
  5460. pr_debug("%s: dev name %s, id:%d\n", __func__,
  5461. dev_name(&pdev->dev), pdev->id);
  5462. switch (id) {
  5463. case SLIMBUS_0_RX:
  5464. strlcpy(stream_name, "Slimbus Playback", 80);
  5465. goto register_slim_playback;
  5466. case SLIMBUS_2_RX:
  5467. strlcpy(stream_name, "Slimbus2 Playback", 80);
  5468. goto register_slim_playback;
  5469. case SLIMBUS_1_RX:
  5470. strlcpy(stream_name, "Slimbus1 Playback", 80);
  5471. goto register_slim_playback;
  5472. case SLIMBUS_3_RX:
  5473. strlcpy(stream_name, "Slimbus3 Playback", 80);
  5474. goto register_slim_playback;
  5475. case SLIMBUS_4_RX:
  5476. strlcpy(stream_name, "Slimbus4 Playback", 80);
  5477. goto register_slim_playback;
  5478. case SLIMBUS_5_RX:
  5479. strlcpy(stream_name, "Slimbus5 Playback", 80);
  5480. goto register_slim_playback;
  5481. case SLIMBUS_6_RX:
  5482. strlcpy(stream_name, "Slimbus6 Playback", 80);
  5483. goto register_slim_playback;
  5484. case SLIMBUS_7_RX:
  5485. strlcpy(stream_name, "Slimbus7 Playback", sizeof(stream_name));
  5486. goto register_slim_playback;
  5487. case SLIMBUS_8_RX:
  5488. strlcpy(stream_name, "Slimbus8 Playback", sizeof(stream_name));
  5489. goto register_slim_playback;
  5490. case SLIMBUS_9_RX:
  5491. strlcpy(stream_name, "Slimbus9 Playback", sizeof(stream_name));
  5492. goto register_slim_playback;
  5493. register_slim_playback:
  5494. rc = -ENODEV;
  5495. len = strnlen(stream_name, 80);
  5496. for (i = 0; i < ARRAY_SIZE(msm_dai_q6_slimbus_rx_dai); i++) {
  5497. if (msm_dai_q6_slimbus_rx_dai[i].playback.stream_name &&
  5498. !strcmp(stream_name,
  5499. msm_dai_q6_slimbus_rx_dai[i]
  5500. .playback.stream_name)) {
  5501. rc = snd_soc_register_component(&pdev->dev,
  5502. &msm_dai_q6_component,
  5503. &msm_dai_q6_slimbus_rx_dai[i], 1);
  5504. break;
  5505. }
  5506. }
  5507. if (rc)
  5508. pr_err("%s: Device not found stream name %s\n",
  5509. __func__, stream_name);
  5510. break;
  5511. case SLIMBUS_0_TX:
  5512. strlcpy(stream_name, "Slimbus Capture", 80);
  5513. goto register_slim_capture;
  5514. case SLIMBUS_1_TX:
  5515. strlcpy(stream_name, "Slimbus1 Capture", 80);
  5516. goto register_slim_capture;
  5517. case SLIMBUS_2_TX:
  5518. strlcpy(stream_name, "Slimbus2 Capture", 80);
  5519. goto register_slim_capture;
  5520. case SLIMBUS_3_TX:
  5521. strlcpy(stream_name, "Slimbus3 Capture", 80);
  5522. goto register_slim_capture;
  5523. case SLIMBUS_4_TX:
  5524. strlcpy(stream_name, "Slimbus4 Capture", 80);
  5525. goto register_slim_capture;
  5526. case SLIMBUS_5_TX:
  5527. strlcpy(stream_name, "Slimbus5 Capture", 80);
  5528. goto register_slim_capture;
  5529. case SLIMBUS_6_TX:
  5530. strlcpy(stream_name, "Slimbus6 Capture", 80);
  5531. goto register_slim_capture;
  5532. case SLIMBUS_7_TX:
  5533. strlcpy(stream_name, "Slimbus7 Capture", sizeof(stream_name));
  5534. goto register_slim_capture;
  5535. case SLIMBUS_8_TX:
  5536. strlcpy(stream_name, "Slimbus8 Capture", sizeof(stream_name));
  5537. goto register_slim_capture;
  5538. case SLIMBUS_9_TX:
  5539. strlcpy(stream_name, "Slimbus9 Capture", sizeof(stream_name));
  5540. goto register_slim_capture;
  5541. register_slim_capture:
  5542. rc = -ENODEV;
  5543. len = strnlen(stream_name, 80);
  5544. for (i = 0; i < ARRAY_SIZE(msm_dai_q6_slimbus_tx_dai); i++) {
  5545. if (msm_dai_q6_slimbus_tx_dai[i].capture.stream_name &&
  5546. !strcmp(stream_name,
  5547. msm_dai_q6_slimbus_tx_dai[i]
  5548. .capture.stream_name)) {
  5549. rc = snd_soc_register_component(&pdev->dev,
  5550. &msm_dai_q6_component,
  5551. &msm_dai_q6_slimbus_tx_dai[i], 1);
  5552. break;
  5553. }
  5554. }
  5555. if (rc)
  5556. pr_err("%s: Device not found stream name %s\n",
  5557. __func__, stream_name);
  5558. break;
  5559. case AFE_LOOPBACK_TX:
  5560. rc = snd_soc_register_component(&pdev->dev,
  5561. &msm_dai_q6_component,
  5562. &msm_dai_q6_afe_lb_tx_dai[0],
  5563. 1);
  5564. break;
  5565. case INT_BT_SCO_RX:
  5566. rc = snd_soc_register_component(&pdev->dev,
  5567. &msm_dai_q6_component, &msm_dai_q6_bt_sco_rx_dai, 1);
  5568. break;
  5569. case INT_BT_SCO_TX:
  5570. rc = snd_soc_register_component(&pdev->dev,
  5571. &msm_dai_q6_component, &msm_dai_q6_bt_sco_tx_dai, 1);
  5572. break;
  5573. case INT_BT_A2DP_RX:
  5574. rc = snd_soc_register_component(&pdev->dev,
  5575. &msm_dai_q6_component, &msm_dai_q6_bt_a2dp_rx_dai, 1);
  5576. break;
  5577. case INT_FM_RX:
  5578. rc = snd_soc_register_component(&pdev->dev,
  5579. &msm_dai_q6_component, &msm_dai_q6_fm_rx_dai, 1);
  5580. break;
  5581. case INT_FM_TX:
  5582. rc = snd_soc_register_component(&pdev->dev,
  5583. &msm_dai_q6_component, &msm_dai_q6_fm_tx_dai, 1);
  5584. break;
  5585. case AFE_PORT_ID_USB_RX:
  5586. rc = snd_soc_register_component(&pdev->dev,
  5587. &msm_dai_q6_component, &msm_dai_q6_usb_rx_dai, 1);
  5588. break;
  5589. case AFE_PORT_ID_USB_TX:
  5590. rc = snd_soc_register_component(&pdev->dev,
  5591. &msm_dai_q6_component, &msm_dai_q6_usb_tx_dai, 1);
  5592. break;
  5593. case RT_PROXY_DAI_001_RX:
  5594. strlcpy(stream_name, "AFE Playback", 80);
  5595. goto register_afe_playback;
  5596. case RT_PROXY_DAI_002_RX:
  5597. strlcpy(stream_name, "AFE-PROXY RX", 80);
  5598. register_afe_playback:
  5599. rc = -ENODEV;
  5600. len = strnlen(stream_name, 80);
  5601. for (i = 0; i < ARRAY_SIZE(msm_dai_q6_afe_rx_dai); i++) {
  5602. if (msm_dai_q6_afe_rx_dai[i].playback.stream_name &&
  5603. !strcmp(stream_name,
  5604. msm_dai_q6_afe_rx_dai[i].playback.stream_name)) {
  5605. rc = snd_soc_register_component(&pdev->dev,
  5606. &msm_dai_q6_component,
  5607. &msm_dai_q6_afe_rx_dai[i], 1);
  5608. break;
  5609. }
  5610. }
  5611. if (rc)
  5612. pr_err("%s: Device not found stream name %s\n",
  5613. __func__, stream_name);
  5614. break;
  5615. case RT_PROXY_DAI_001_TX:
  5616. strlcpy(stream_name, "AFE-PROXY TX", 80);
  5617. goto register_afe_capture;
  5618. case RT_PROXY_DAI_002_TX:
  5619. strlcpy(stream_name, "AFE Capture", 80);
  5620. register_afe_capture:
  5621. rc = -ENODEV;
  5622. len = strnlen(stream_name, 80);
  5623. for (i = 0; i < ARRAY_SIZE(msm_dai_q6_afe_tx_dai); i++) {
  5624. if (msm_dai_q6_afe_tx_dai[i].capture.stream_name &&
  5625. !strcmp(stream_name,
  5626. msm_dai_q6_afe_tx_dai[i].capture.stream_name)) {
  5627. rc = snd_soc_register_component(&pdev->dev,
  5628. &msm_dai_q6_component,
  5629. &msm_dai_q6_afe_tx_dai[i], 1);
  5630. break;
  5631. }
  5632. }
  5633. if (rc)
  5634. pr_err("%s: Device not found stream name %s\n",
  5635. __func__, stream_name);
  5636. break;
  5637. case VOICE_PLAYBACK_TX:
  5638. strlcpy(stream_name, "Voice Farend Playback", 80);
  5639. goto register_voice_playback;
  5640. case VOICE2_PLAYBACK_TX:
  5641. strlcpy(stream_name, "Voice2 Farend Playback", 80);
  5642. register_voice_playback:
  5643. rc = -ENODEV;
  5644. len = strnlen(stream_name, 80);
  5645. for (i = 0; i < ARRAY_SIZE(msm_dai_q6_voc_playback_dai); i++) {
  5646. if (msm_dai_q6_voc_playback_dai[i].playback.stream_name
  5647. && !strcmp(stream_name,
  5648. msm_dai_q6_voc_playback_dai[i].playback.stream_name)) {
  5649. rc = snd_soc_register_component(&pdev->dev,
  5650. &msm_dai_q6_component,
  5651. &msm_dai_q6_voc_playback_dai[i], 1);
  5652. break;
  5653. }
  5654. }
  5655. if (rc)
  5656. pr_err("%s Device not found stream name %s\n",
  5657. __func__, stream_name);
  5658. break;
  5659. case VOICE_RECORD_RX:
  5660. strlcpy(stream_name, "Voice Downlink Capture", 80);
  5661. goto register_uplink_capture;
  5662. case VOICE_RECORD_TX:
  5663. strlcpy(stream_name, "Voice Uplink Capture", 80);
  5664. register_uplink_capture:
  5665. rc = -ENODEV;
  5666. len = strnlen(stream_name, 80);
  5667. for (i = 0; i < ARRAY_SIZE(msm_dai_q6_incall_record_dai); i++) {
  5668. if (msm_dai_q6_incall_record_dai[i].capture.stream_name
  5669. && !strcmp(stream_name,
  5670. msm_dai_q6_incall_record_dai[i].
  5671. capture.stream_name)) {
  5672. rc = snd_soc_register_component(&pdev->dev,
  5673. &msm_dai_q6_component,
  5674. &msm_dai_q6_incall_record_dai[i], 1);
  5675. break;
  5676. }
  5677. }
  5678. if (rc)
  5679. pr_err("%s: Device not found stream name %s\n",
  5680. __func__, stream_name);
  5681. break;
  5682. default:
  5683. rc = -ENODEV;
  5684. break;
  5685. }
  5686. return rc;
  5687. }
  5688. static int msm_dai_q6_dev_remove(struct platform_device *pdev)
  5689. {
  5690. snd_soc_unregister_component(&pdev->dev);
  5691. return 0;
  5692. }
  5693. static const struct of_device_id msm_dai_q6_dev_dt_match[] = {
  5694. { .compatible = "qcom,msm-dai-q6-dev", },
  5695. { }
  5696. };
  5697. MODULE_DEVICE_TABLE(of, msm_dai_q6_dev_dt_match);
  5698. static struct platform_driver msm_dai_q6_dev = {
  5699. .probe = msm_dai_q6_dev_probe,
  5700. .remove = msm_dai_q6_dev_remove,
  5701. .driver = {
  5702. .name = "msm-dai-q6-dev",
  5703. .owner = THIS_MODULE,
  5704. .of_match_table = msm_dai_q6_dev_dt_match,
  5705. },
  5706. };
  5707. static int msm_dai_q6_probe(struct platform_device *pdev)
  5708. {
  5709. int rc;
  5710. pr_debug("%s: dev name %s, id:%d\n", __func__,
  5711. dev_name(&pdev->dev), pdev->id);
  5712. rc = of_platform_populate(pdev->dev.of_node, NULL, NULL, &pdev->dev);
  5713. if (rc) {
  5714. dev_err(&pdev->dev, "%s: failed to add child nodes, rc=%d\n",
  5715. __func__, rc);
  5716. } else
  5717. dev_dbg(&pdev->dev, "%s: added child node\n", __func__);
  5718. return rc;
  5719. }
  5720. static int msm_dai_q6_remove(struct platform_device *pdev)
  5721. {
  5722. of_platform_depopulate(&pdev->dev);
  5723. return 0;
  5724. }
  5725. static const struct of_device_id msm_dai_q6_dt_match[] = {
  5726. { .compatible = "qcom,msm-dai-q6", },
  5727. { }
  5728. };
  5729. MODULE_DEVICE_TABLE(of, msm_dai_q6_dt_match);
  5730. static struct platform_driver msm_dai_q6 = {
  5731. .probe = msm_dai_q6_probe,
  5732. .remove = msm_dai_q6_remove,
  5733. .driver = {
  5734. .name = "msm-dai-q6",
  5735. .owner = THIS_MODULE,
  5736. .of_match_table = msm_dai_q6_dt_match,
  5737. },
  5738. };
  5739. static int msm_dai_mi2s_q6_probe(struct platform_device *pdev)
  5740. {
  5741. int rc;
  5742. rc = of_platform_populate(pdev->dev.of_node, NULL, NULL, &pdev->dev);
  5743. if (rc) {
  5744. dev_err(&pdev->dev, "%s: failed to add child nodes, rc=%d\n",
  5745. __func__, rc);
  5746. } else
  5747. dev_dbg(&pdev->dev, "%s: added child node\n", __func__);
  5748. return rc;
  5749. }
  5750. static int msm_dai_mi2s_q6_remove(struct platform_device *pdev)
  5751. {
  5752. return 0;
  5753. }
  5754. static const struct of_device_id msm_dai_mi2s_dt_match[] = {
  5755. { .compatible = "qcom,msm-dai-mi2s", },
  5756. { }
  5757. };
  5758. MODULE_DEVICE_TABLE(of, msm_dai_mi2s_dt_match);
  5759. static struct platform_driver msm_dai_mi2s_q6 = {
  5760. .probe = msm_dai_mi2s_q6_probe,
  5761. .remove = msm_dai_mi2s_q6_remove,
  5762. .driver = {
  5763. .name = "msm-dai-mi2s",
  5764. .owner = THIS_MODULE,
  5765. .of_match_table = msm_dai_mi2s_dt_match,
  5766. },
  5767. };
  5768. static const struct of_device_id msm_dai_q6_mi2s_dev_dt_match[] = {
  5769. { .compatible = "qcom,msm-dai-q6-mi2s", },
  5770. { }
  5771. };
  5772. MODULE_DEVICE_TABLE(of, msm_dai_q6_mi2s_dev_dt_match);
  5773. static struct platform_driver msm_dai_q6_mi2s_driver = {
  5774. .probe = msm_dai_q6_mi2s_dev_probe,
  5775. .remove = msm_dai_q6_mi2s_dev_remove,
  5776. .driver = {
  5777. .name = "msm-dai-q6-mi2s",
  5778. .owner = THIS_MODULE,
  5779. .of_match_table = msm_dai_q6_mi2s_dev_dt_match,
  5780. },
  5781. };
  5782. static int msm_dai_q6_spdif_dev_probe(struct platform_device *pdev)
  5783. {
  5784. int rc, id;
  5785. const char *q6_dev_id = "qcom,msm-dai-q6-dev-id";
  5786. rc = of_property_read_u32(pdev->dev.of_node, q6_dev_id, &id);
  5787. if (rc) {
  5788. dev_err(&pdev->dev,
  5789. "%s: missing %s in dt node\n", __func__, q6_dev_id);
  5790. return rc;
  5791. }
  5792. pdev->id = id;
  5793. pr_debug("%s: dev name %s, id:%d\n", __func__,
  5794. dev_name(&pdev->dev), pdev->id);
  5795. switch (pdev->id) {
  5796. case AFE_PORT_ID_PRIMARY_SPDIF_RX:
  5797. rc = snd_soc_register_component(&pdev->dev,
  5798. &msm_dai_spdif_q6_component,
  5799. &msm_dai_q6_spdif_spdif_rx_dai[0], 1);
  5800. break;
  5801. case AFE_PORT_ID_SECONDARY_SPDIF_RX:
  5802. rc = snd_soc_register_component(&pdev->dev,
  5803. &msm_dai_spdif_q6_component,
  5804. &msm_dai_q6_spdif_spdif_rx_dai[1], 1);
  5805. break;
  5806. case AFE_PORT_ID_PRIMARY_SPDIF_TX:
  5807. rc = snd_soc_register_component(&pdev->dev,
  5808. &msm_dai_spdif_q6_component,
  5809. &msm_dai_q6_spdif_spdif_tx_dai[0], 1);
  5810. break;
  5811. case AFE_PORT_ID_SECONDARY_SPDIF_TX:
  5812. rc = snd_soc_register_component(&pdev->dev,
  5813. &msm_dai_spdif_q6_component,
  5814. &msm_dai_q6_spdif_spdif_tx_dai[1], 1);
  5815. break;
  5816. default:
  5817. dev_err(&pdev->dev, "invalid device ID %d\n", pdev->id);
  5818. rc = -ENODEV;
  5819. break;
  5820. }
  5821. return rc;
  5822. }
  5823. static int msm_dai_q6_spdif_dev_remove(struct platform_device *pdev)
  5824. {
  5825. snd_soc_unregister_component(&pdev->dev);
  5826. return 0;
  5827. }
  5828. static const struct of_device_id msm_dai_q6_spdif_dt_match[] = {
  5829. {.compatible = "qcom,msm-dai-q6-spdif"},
  5830. {}
  5831. };
  5832. MODULE_DEVICE_TABLE(of, msm_dai_q6_spdif_dt_match);
  5833. static struct platform_driver msm_dai_q6_spdif_driver = {
  5834. .probe = msm_dai_q6_spdif_dev_probe,
  5835. .remove = msm_dai_q6_spdif_dev_remove,
  5836. .driver = {
  5837. .name = "msm-dai-q6-spdif",
  5838. .owner = THIS_MODULE,
  5839. .of_match_table = msm_dai_q6_spdif_dt_match,
  5840. },
  5841. };
  5842. static int msm_dai_q6_tdm_set_clk_param(u32 group_id,
  5843. struct afe_clk_set *clk_set, u32 mode)
  5844. {
  5845. switch (group_id) {
  5846. case AFE_GROUP_DEVICE_ID_PRIMARY_TDM_RX:
  5847. case AFE_GROUP_DEVICE_ID_PRIMARY_TDM_TX:
  5848. if (mode)
  5849. clk_set->clk_id = Q6AFE_LPASS_CLK_ID_PRI_TDM_IBIT;
  5850. else
  5851. clk_set->clk_id = Q6AFE_LPASS_CLK_ID_PRI_TDM_EBIT;
  5852. break;
  5853. case AFE_GROUP_DEVICE_ID_SECONDARY_TDM_RX:
  5854. case AFE_GROUP_DEVICE_ID_SECONDARY_TDM_TX:
  5855. if (mode)
  5856. clk_set->clk_id = Q6AFE_LPASS_CLK_ID_SEC_TDM_IBIT;
  5857. else
  5858. clk_set->clk_id = Q6AFE_LPASS_CLK_ID_SEC_TDM_EBIT;
  5859. break;
  5860. case AFE_GROUP_DEVICE_ID_TERTIARY_TDM_RX:
  5861. case AFE_GROUP_DEVICE_ID_TERTIARY_TDM_TX:
  5862. if (mode)
  5863. clk_set->clk_id = Q6AFE_LPASS_CLK_ID_TER_TDM_IBIT;
  5864. else
  5865. clk_set->clk_id = Q6AFE_LPASS_CLK_ID_TER_TDM_EBIT;
  5866. break;
  5867. case AFE_GROUP_DEVICE_ID_QUATERNARY_TDM_RX:
  5868. case AFE_GROUP_DEVICE_ID_QUATERNARY_TDM_TX:
  5869. if (mode)
  5870. clk_set->clk_id = Q6AFE_LPASS_CLK_ID_QUAD_TDM_IBIT;
  5871. else
  5872. clk_set->clk_id = Q6AFE_LPASS_CLK_ID_QUAD_TDM_EBIT;
  5873. break;
  5874. case AFE_GROUP_DEVICE_ID_QUINARY_TDM_RX:
  5875. case AFE_GROUP_DEVICE_ID_QUINARY_TDM_TX:
  5876. if (mode)
  5877. clk_set->clk_id = Q6AFE_LPASS_CLK_ID_QUIN_TDM_IBIT;
  5878. else
  5879. clk_set->clk_id = Q6AFE_LPASS_CLK_ID_QUIN_TDM_EBIT;
  5880. break;
  5881. default:
  5882. return -EINVAL;
  5883. }
  5884. return 0;
  5885. }
  5886. static int msm_dai_tdm_q6_probe(struct platform_device *pdev)
  5887. {
  5888. int rc = 0;
  5889. const uint32_t *port_id_array = NULL;
  5890. uint32_t array_length = 0;
  5891. int i = 0;
  5892. int group_idx = 0;
  5893. u32 clk_mode = 0;
  5894. /* extract tdm group info into static */
  5895. rc = of_property_read_u32(pdev->dev.of_node,
  5896. "qcom,msm-cpudai-tdm-group-id",
  5897. (u32 *)&tdm_group_cfg.group_id);
  5898. if (rc) {
  5899. dev_err(&pdev->dev, "%s: Group ID from DT file %s\n",
  5900. __func__, "qcom,msm-cpudai-tdm-group-id");
  5901. goto rtn;
  5902. }
  5903. dev_dbg(&pdev->dev, "%s: Group ID from DT file 0x%x\n",
  5904. __func__, tdm_group_cfg.group_id);
  5905. rc = of_property_read_u32(pdev->dev.of_node,
  5906. "qcom,msm-cpudai-tdm-group-num-ports",
  5907. &num_tdm_group_ports);
  5908. if (rc) {
  5909. dev_err(&pdev->dev, "%s: Group Num Ports from DT file %s\n",
  5910. __func__, "qcom,msm-cpudai-tdm-group-num-ports");
  5911. goto rtn;
  5912. }
  5913. dev_dbg(&pdev->dev, "%s: Group Num Ports from DT file 0x%x\n",
  5914. __func__, num_tdm_group_ports);
  5915. if (num_tdm_group_ports > AFE_GROUP_DEVICE_NUM_PORTS) {
  5916. dev_err(&pdev->dev, "%s Group Num Ports %d greater than Max %d\n",
  5917. __func__, num_tdm_group_ports,
  5918. AFE_GROUP_DEVICE_NUM_PORTS);
  5919. rc = -EINVAL;
  5920. goto rtn;
  5921. }
  5922. port_id_array = of_get_property(pdev->dev.of_node,
  5923. "qcom,msm-cpudai-tdm-group-port-id",
  5924. &array_length);
  5925. if (port_id_array == NULL) {
  5926. dev_err(&pdev->dev, "%s port_id_array is not valid\n",
  5927. __func__);
  5928. rc = -EINVAL;
  5929. goto rtn;
  5930. }
  5931. if (array_length != sizeof(uint32_t) * num_tdm_group_ports) {
  5932. dev_err(&pdev->dev, "%s array_length is %d, expected is %zd\n",
  5933. __func__, array_length,
  5934. sizeof(uint32_t) * num_tdm_group_ports);
  5935. rc = -EINVAL;
  5936. goto rtn;
  5937. }
  5938. for (i = 0; i < num_tdm_group_ports; i++)
  5939. tdm_group_cfg.port_id[i] =
  5940. (u16)be32_to_cpu(port_id_array[i]);
  5941. /* Unused index should be filled with 0 or AFE_PORT_INVALID */
  5942. for (i = num_tdm_group_ports; i < AFE_GROUP_DEVICE_NUM_PORTS; i++)
  5943. tdm_group_cfg.port_id[i] =
  5944. AFE_PORT_INVALID;
  5945. /* extract tdm clk info into static */
  5946. rc = of_property_read_u32(pdev->dev.of_node,
  5947. "qcom,msm-cpudai-tdm-clk-rate",
  5948. &tdm_clk_set.clk_freq_in_hz);
  5949. if (rc) {
  5950. dev_err(&pdev->dev, "%s: Clk Rate from DT file %s\n",
  5951. __func__, "qcom,msm-cpudai-tdm-clk-rate");
  5952. goto rtn;
  5953. }
  5954. dev_dbg(&pdev->dev, "%s: Clk Rate from DT file %d\n",
  5955. __func__, tdm_clk_set.clk_freq_in_hz);
  5956. /* initialize static tdm clk attribute to default value */
  5957. tdm_clk_set.clk_attri = Q6AFE_LPASS_CLK_ATTRIBUTE_INVERT_COUPLE_NO;
  5958. /* extract tdm clk attribute into static */
  5959. if (of_find_property(pdev->dev.of_node,
  5960. "qcom,msm-cpudai-tdm-clk-attribute", NULL)) {
  5961. rc = of_property_read_u16(pdev->dev.of_node,
  5962. "qcom,msm-cpudai-tdm-clk-attribute",
  5963. &tdm_clk_set.clk_attri);
  5964. if (rc) {
  5965. dev_err(&pdev->dev, "%s: value for clk attribute not found %s\n",
  5966. __func__, "qcom,msm-cpudai-tdm-clk-attribute");
  5967. goto rtn;
  5968. }
  5969. dev_dbg(&pdev->dev, "%s: clk attribute from DT file %d\n",
  5970. __func__, tdm_clk_set.clk_attri);
  5971. } else
  5972. dev_dbg(&pdev->dev, "%s: clk attribute not found\n", __func__);
  5973. /* extract tdm clk src master/slave info into static */
  5974. rc = of_property_read_u32(pdev->dev.of_node,
  5975. "qcom,msm-cpudai-tdm-clk-internal",
  5976. &clk_mode);
  5977. if (rc) {
  5978. dev_err(&pdev->dev, "%s: Clk id from DT file %s\n",
  5979. __func__, "qcom,msm-cpudai-tdm-clk-internal");
  5980. goto rtn;
  5981. }
  5982. dev_dbg(&pdev->dev, "%s: Clk id from DT file %d\n",
  5983. __func__, clk_mode);
  5984. rc = msm_dai_q6_tdm_set_clk_param(tdm_group_cfg.group_id,
  5985. &tdm_clk_set, clk_mode);
  5986. if (rc) {
  5987. dev_err(&pdev->dev, "%s: group id not supported 0x%x\n",
  5988. __func__, tdm_group_cfg.group_id);
  5989. goto rtn;
  5990. }
  5991. /* other initializations within device group */
  5992. group_idx = msm_dai_q6_get_group_idx(tdm_group_cfg.group_id);
  5993. if (group_idx < 0) {
  5994. dev_err(&pdev->dev, "%s: group id 0x%x not supported\n",
  5995. __func__, tdm_group_cfg.group_id);
  5996. rc = -EINVAL;
  5997. goto rtn;
  5998. }
  5999. atomic_set(&tdm_group_ref[group_idx], 0);
  6000. /* probe child node info */
  6001. rc = of_platform_populate(pdev->dev.of_node, NULL, NULL, &pdev->dev);
  6002. if (rc) {
  6003. dev_err(&pdev->dev, "%s: failed to add child nodes, rc=%d\n",
  6004. __func__, rc);
  6005. goto rtn;
  6006. } else
  6007. dev_dbg(&pdev->dev, "%s: added child node\n", __func__);
  6008. rtn:
  6009. return rc;
  6010. }
  6011. static int msm_dai_tdm_q6_remove(struct platform_device *pdev)
  6012. {
  6013. return 0;
  6014. }
  6015. static const struct of_device_id msm_dai_tdm_dt_match[] = {
  6016. { .compatible = "qcom,msm-dai-tdm", },
  6017. {}
  6018. };
  6019. MODULE_DEVICE_TABLE(of, msm_dai_tdm_dt_match);
  6020. static struct platform_driver msm_dai_tdm_q6 = {
  6021. .probe = msm_dai_tdm_q6_probe,
  6022. .remove = msm_dai_tdm_q6_remove,
  6023. .driver = {
  6024. .name = "msm-dai-tdm",
  6025. .owner = THIS_MODULE,
  6026. .of_match_table = msm_dai_tdm_dt_match,
  6027. },
  6028. };
  6029. static int msm_dai_q6_tdm_data_format_put(struct snd_kcontrol *kcontrol,
  6030. struct snd_ctl_elem_value *ucontrol)
  6031. {
  6032. struct msm_dai_q6_tdm_dai_data *dai_data = kcontrol->private_data;
  6033. int value = ucontrol->value.integer.value[0];
  6034. switch (value) {
  6035. case 0:
  6036. dai_data->port_cfg.tdm.data_format = AFE_LINEAR_PCM_DATA;
  6037. break;
  6038. case 1:
  6039. dai_data->port_cfg.tdm.data_format = AFE_NON_LINEAR_DATA;
  6040. break;
  6041. case 2:
  6042. dai_data->port_cfg.tdm.data_format = AFE_GENERIC_COMPRESSED;
  6043. break;
  6044. default:
  6045. pr_err("%s: data_format invalid\n", __func__);
  6046. break;
  6047. }
  6048. pr_debug("%s: data_format = %d\n",
  6049. __func__, dai_data->port_cfg.tdm.data_format);
  6050. return 0;
  6051. }
  6052. static int msm_dai_q6_tdm_data_format_get(struct snd_kcontrol *kcontrol,
  6053. struct snd_ctl_elem_value *ucontrol)
  6054. {
  6055. struct msm_dai_q6_tdm_dai_data *dai_data = kcontrol->private_data;
  6056. ucontrol->value.integer.value[0] =
  6057. dai_data->port_cfg.tdm.data_format;
  6058. pr_debug("%s: data_format = %d\n",
  6059. __func__, dai_data->port_cfg.tdm.data_format);
  6060. return 0;
  6061. }
  6062. static int msm_dai_q6_tdm_header_type_put(struct snd_kcontrol *kcontrol,
  6063. struct snd_ctl_elem_value *ucontrol)
  6064. {
  6065. struct msm_dai_q6_tdm_dai_data *dai_data = kcontrol->private_data;
  6066. int value = ucontrol->value.integer.value[0];
  6067. dai_data->port_cfg.custom_tdm_header.header_type = value;
  6068. pr_debug("%s: header_type = %d\n",
  6069. __func__,
  6070. dai_data->port_cfg.custom_tdm_header.header_type);
  6071. return 0;
  6072. }
  6073. static int msm_dai_q6_tdm_header_type_get(struct snd_kcontrol *kcontrol,
  6074. struct snd_ctl_elem_value *ucontrol)
  6075. {
  6076. struct msm_dai_q6_tdm_dai_data *dai_data = kcontrol->private_data;
  6077. ucontrol->value.integer.value[0] =
  6078. dai_data->port_cfg.custom_tdm_header.header_type;
  6079. pr_debug("%s: header_type = %d\n",
  6080. __func__,
  6081. dai_data->port_cfg.custom_tdm_header.header_type);
  6082. return 0;
  6083. }
  6084. static int msm_dai_q6_tdm_header_put(struct snd_kcontrol *kcontrol,
  6085. struct snd_ctl_elem_value *ucontrol)
  6086. {
  6087. struct msm_dai_q6_tdm_dai_data *dai_data = kcontrol->private_data;
  6088. int i = 0;
  6089. for (i = 0; i < AFE_CUSTOM_TDM_HEADER_MAX_CNT; i++) {
  6090. dai_data->port_cfg.custom_tdm_header.header[i] =
  6091. (u16)ucontrol->value.integer.value[i];
  6092. pr_debug("%s: header #%d = 0x%x\n",
  6093. __func__, i,
  6094. dai_data->port_cfg.custom_tdm_header.header[i]);
  6095. }
  6096. return 0;
  6097. }
  6098. static int msm_dai_q6_tdm_header_get(struct snd_kcontrol *kcontrol,
  6099. struct snd_ctl_elem_value *ucontrol)
  6100. {
  6101. struct msm_dai_q6_tdm_dai_data *dai_data = kcontrol->private_data;
  6102. int i = 0;
  6103. for (i = 0; i < AFE_CUSTOM_TDM_HEADER_MAX_CNT; i++) {
  6104. ucontrol->value.integer.value[i] =
  6105. dai_data->port_cfg.custom_tdm_header.header[i];
  6106. pr_debug("%s: header #%d = 0x%x\n",
  6107. __func__, i,
  6108. dai_data->port_cfg.custom_tdm_header.header[i]);
  6109. }
  6110. return 0;
  6111. }
  6112. static const struct snd_kcontrol_new tdm_config_controls_data_format[] = {
  6113. SOC_ENUM_EXT("PRI_TDM_RX_0 Data Format", tdm_config_enum[0],
  6114. msm_dai_q6_tdm_data_format_get,
  6115. msm_dai_q6_tdm_data_format_put),
  6116. SOC_ENUM_EXT("PRI_TDM_RX_1 Data Format", tdm_config_enum[0],
  6117. msm_dai_q6_tdm_data_format_get,
  6118. msm_dai_q6_tdm_data_format_put),
  6119. SOC_ENUM_EXT("PRI_TDM_RX_2 Data Format", tdm_config_enum[0],
  6120. msm_dai_q6_tdm_data_format_get,
  6121. msm_dai_q6_tdm_data_format_put),
  6122. SOC_ENUM_EXT("PRI_TDM_RX_3 Data Format", tdm_config_enum[0],
  6123. msm_dai_q6_tdm_data_format_get,
  6124. msm_dai_q6_tdm_data_format_put),
  6125. SOC_ENUM_EXT("PRI_TDM_RX_4 Data Format", tdm_config_enum[0],
  6126. msm_dai_q6_tdm_data_format_get,
  6127. msm_dai_q6_tdm_data_format_put),
  6128. SOC_ENUM_EXT("PRI_TDM_RX_5 Data Format", tdm_config_enum[0],
  6129. msm_dai_q6_tdm_data_format_get,
  6130. msm_dai_q6_tdm_data_format_put),
  6131. SOC_ENUM_EXT("PRI_TDM_RX_6 Data Format", tdm_config_enum[0],
  6132. msm_dai_q6_tdm_data_format_get,
  6133. msm_dai_q6_tdm_data_format_put),
  6134. SOC_ENUM_EXT("PRI_TDM_RX_7 Data Format", tdm_config_enum[0],
  6135. msm_dai_q6_tdm_data_format_get,
  6136. msm_dai_q6_tdm_data_format_put),
  6137. SOC_ENUM_EXT("PRI_TDM_TX_0 Data Format", tdm_config_enum[0],
  6138. msm_dai_q6_tdm_data_format_get,
  6139. msm_dai_q6_tdm_data_format_put),
  6140. SOC_ENUM_EXT("PRI_TDM_TX_1 Data Format", tdm_config_enum[0],
  6141. msm_dai_q6_tdm_data_format_get,
  6142. msm_dai_q6_tdm_data_format_put),
  6143. SOC_ENUM_EXT("PRI_TDM_TX_2 Data Format", tdm_config_enum[0],
  6144. msm_dai_q6_tdm_data_format_get,
  6145. msm_dai_q6_tdm_data_format_put),
  6146. SOC_ENUM_EXT("PRI_TDM_TX_3 Data Format", tdm_config_enum[0],
  6147. msm_dai_q6_tdm_data_format_get,
  6148. msm_dai_q6_tdm_data_format_put),
  6149. SOC_ENUM_EXT("PRI_TDM_TX_4 Data Format", tdm_config_enum[0],
  6150. msm_dai_q6_tdm_data_format_get,
  6151. msm_dai_q6_tdm_data_format_put),
  6152. SOC_ENUM_EXT("PRI_TDM_TX_5 Data Format", tdm_config_enum[0],
  6153. msm_dai_q6_tdm_data_format_get,
  6154. msm_dai_q6_tdm_data_format_put),
  6155. SOC_ENUM_EXT("PRI_TDM_TX_6 Data Format", tdm_config_enum[0],
  6156. msm_dai_q6_tdm_data_format_get,
  6157. msm_dai_q6_tdm_data_format_put),
  6158. SOC_ENUM_EXT("PRI_TDM_TX_7 Data Format", tdm_config_enum[0],
  6159. msm_dai_q6_tdm_data_format_get,
  6160. msm_dai_q6_tdm_data_format_put),
  6161. SOC_ENUM_EXT("SEC_TDM_RX_0 Data Format", tdm_config_enum[0],
  6162. msm_dai_q6_tdm_data_format_get,
  6163. msm_dai_q6_tdm_data_format_put),
  6164. SOC_ENUM_EXT("SEC_TDM_RX_1 Data Format", tdm_config_enum[0],
  6165. msm_dai_q6_tdm_data_format_get,
  6166. msm_dai_q6_tdm_data_format_put),
  6167. SOC_ENUM_EXT("SEC_TDM_RX_2 Data Format", tdm_config_enum[0],
  6168. msm_dai_q6_tdm_data_format_get,
  6169. msm_dai_q6_tdm_data_format_put),
  6170. SOC_ENUM_EXT("SEC_TDM_RX_3 Data Format", tdm_config_enum[0],
  6171. msm_dai_q6_tdm_data_format_get,
  6172. msm_dai_q6_tdm_data_format_put),
  6173. SOC_ENUM_EXT("SEC_TDM_RX_4 Data Format", tdm_config_enum[0],
  6174. msm_dai_q6_tdm_data_format_get,
  6175. msm_dai_q6_tdm_data_format_put),
  6176. SOC_ENUM_EXT("SEC_TDM_RX_5 Data Format", tdm_config_enum[0],
  6177. msm_dai_q6_tdm_data_format_get,
  6178. msm_dai_q6_tdm_data_format_put),
  6179. SOC_ENUM_EXT("SEC_TDM_RX_6 Data Format", tdm_config_enum[0],
  6180. msm_dai_q6_tdm_data_format_get,
  6181. msm_dai_q6_tdm_data_format_put),
  6182. SOC_ENUM_EXT("SEC_TDM_RX_7 Data Format", tdm_config_enum[0],
  6183. msm_dai_q6_tdm_data_format_get,
  6184. msm_dai_q6_tdm_data_format_put),
  6185. SOC_ENUM_EXT("SEC_TDM_TX_0 Data Format", tdm_config_enum[0],
  6186. msm_dai_q6_tdm_data_format_get,
  6187. msm_dai_q6_tdm_data_format_put),
  6188. SOC_ENUM_EXT("SEC_TDM_TX_1 Data Format", tdm_config_enum[0],
  6189. msm_dai_q6_tdm_data_format_get,
  6190. msm_dai_q6_tdm_data_format_put),
  6191. SOC_ENUM_EXT("SEC_TDM_TX_2 Data Format", tdm_config_enum[0],
  6192. msm_dai_q6_tdm_data_format_get,
  6193. msm_dai_q6_tdm_data_format_put),
  6194. SOC_ENUM_EXT("SEC_TDM_TX_3 Data Format", tdm_config_enum[0],
  6195. msm_dai_q6_tdm_data_format_get,
  6196. msm_dai_q6_tdm_data_format_put),
  6197. SOC_ENUM_EXT("SEC_TDM_TX_4 Data Format", tdm_config_enum[0],
  6198. msm_dai_q6_tdm_data_format_get,
  6199. msm_dai_q6_tdm_data_format_put),
  6200. SOC_ENUM_EXT("SEC_TDM_TX_5 Data Format", tdm_config_enum[0],
  6201. msm_dai_q6_tdm_data_format_get,
  6202. msm_dai_q6_tdm_data_format_put),
  6203. SOC_ENUM_EXT("SEC_TDM_TX_6 Data Format", tdm_config_enum[0],
  6204. msm_dai_q6_tdm_data_format_get,
  6205. msm_dai_q6_tdm_data_format_put),
  6206. SOC_ENUM_EXT("SEC_TDM_TX_7 Data Format", tdm_config_enum[0],
  6207. msm_dai_q6_tdm_data_format_get,
  6208. msm_dai_q6_tdm_data_format_put),
  6209. SOC_ENUM_EXT("TERT_TDM_RX_0 Data Format", tdm_config_enum[0],
  6210. msm_dai_q6_tdm_data_format_get,
  6211. msm_dai_q6_tdm_data_format_put),
  6212. SOC_ENUM_EXT("TERT_TDM_RX_1 Data Format", tdm_config_enum[0],
  6213. msm_dai_q6_tdm_data_format_get,
  6214. msm_dai_q6_tdm_data_format_put),
  6215. SOC_ENUM_EXT("TERT_TDM_RX_2 Data Format", tdm_config_enum[0],
  6216. msm_dai_q6_tdm_data_format_get,
  6217. msm_dai_q6_tdm_data_format_put),
  6218. SOC_ENUM_EXT("TERT_TDM_RX_3 Data Format", tdm_config_enum[0],
  6219. msm_dai_q6_tdm_data_format_get,
  6220. msm_dai_q6_tdm_data_format_put),
  6221. SOC_ENUM_EXT("TERT_TDM_RX_4 Data Format", tdm_config_enum[0],
  6222. msm_dai_q6_tdm_data_format_get,
  6223. msm_dai_q6_tdm_data_format_put),
  6224. SOC_ENUM_EXT("TERT_TDM_RX_5 Data Format", tdm_config_enum[0],
  6225. msm_dai_q6_tdm_data_format_get,
  6226. msm_dai_q6_tdm_data_format_put),
  6227. SOC_ENUM_EXT("TERT_TDM_RX_6 Data Format", tdm_config_enum[0],
  6228. msm_dai_q6_tdm_data_format_get,
  6229. msm_dai_q6_tdm_data_format_put),
  6230. SOC_ENUM_EXT("TERT_TDM_RX_7 Data Format", tdm_config_enum[0],
  6231. msm_dai_q6_tdm_data_format_get,
  6232. msm_dai_q6_tdm_data_format_put),
  6233. SOC_ENUM_EXT("TERT_TDM_TX_0 Data Format", tdm_config_enum[0],
  6234. msm_dai_q6_tdm_data_format_get,
  6235. msm_dai_q6_tdm_data_format_put),
  6236. SOC_ENUM_EXT("TERT_TDM_TX_1 Data Format", tdm_config_enum[0],
  6237. msm_dai_q6_tdm_data_format_get,
  6238. msm_dai_q6_tdm_data_format_put),
  6239. SOC_ENUM_EXT("TERT_TDM_TX_2 Data Format", tdm_config_enum[0],
  6240. msm_dai_q6_tdm_data_format_get,
  6241. msm_dai_q6_tdm_data_format_put),
  6242. SOC_ENUM_EXT("TERT_TDM_TX_3 Data Format", tdm_config_enum[0],
  6243. msm_dai_q6_tdm_data_format_get,
  6244. msm_dai_q6_tdm_data_format_put),
  6245. SOC_ENUM_EXT("TERT_TDM_TX_4 Data Format", tdm_config_enum[0],
  6246. msm_dai_q6_tdm_data_format_get,
  6247. msm_dai_q6_tdm_data_format_put),
  6248. SOC_ENUM_EXT("TERT_TDM_TX_5 Data Format", tdm_config_enum[0],
  6249. msm_dai_q6_tdm_data_format_get,
  6250. msm_dai_q6_tdm_data_format_put),
  6251. SOC_ENUM_EXT("TERT_TDM_TX_6 Data Format", tdm_config_enum[0],
  6252. msm_dai_q6_tdm_data_format_get,
  6253. msm_dai_q6_tdm_data_format_put),
  6254. SOC_ENUM_EXT("TERT_TDM_TX_7 Data Format", tdm_config_enum[0],
  6255. msm_dai_q6_tdm_data_format_get,
  6256. msm_dai_q6_tdm_data_format_put),
  6257. SOC_ENUM_EXT("QUAT_TDM_RX_0 Data Format", tdm_config_enum[0],
  6258. msm_dai_q6_tdm_data_format_get,
  6259. msm_dai_q6_tdm_data_format_put),
  6260. SOC_ENUM_EXT("QUAT_TDM_RX_1 Data Format", tdm_config_enum[0],
  6261. msm_dai_q6_tdm_data_format_get,
  6262. msm_dai_q6_tdm_data_format_put),
  6263. SOC_ENUM_EXT("QUAT_TDM_RX_2 Data Format", tdm_config_enum[0],
  6264. msm_dai_q6_tdm_data_format_get,
  6265. msm_dai_q6_tdm_data_format_put),
  6266. SOC_ENUM_EXT("QUAT_TDM_RX_3 Data Format", tdm_config_enum[0],
  6267. msm_dai_q6_tdm_data_format_get,
  6268. msm_dai_q6_tdm_data_format_put),
  6269. SOC_ENUM_EXT("QUAT_TDM_RX_4 Data Format", tdm_config_enum[0],
  6270. msm_dai_q6_tdm_data_format_get,
  6271. msm_dai_q6_tdm_data_format_put),
  6272. SOC_ENUM_EXT("QUAT_TDM_RX_5 Data Format", tdm_config_enum[0],
  6273. msm_dai_q6_tdm_data_format_get,
  6274. msm_dai_q6_tdm_data_format_put),
  6275. SOC_ENUM_EXT("QUAT_TDM_RX_6 Data Format", tdm_config_enum[0],
  6276. msm_dai_q6_tdm_data_format_get,
  6277. msm_dai_q6_tdm_data_format_put),
  6278. SOC_ENUM_EXT("QUAT_TDM_RX_7 Data Format", tdm_config_enum[0],
  6279. msm_dai_q6_tdm_data_format_get,
  6280. msm_dai_q6_tdm_data_format_put),
  6281. SOC_ENUM_EXT("QUAT_TDM_TX_0 Data Format", tdm_config_enum[0],
  6282. msm_dai_q6_tdm_data_format_get,
  6283. msm_dai_q6_tdm_data_format_put),
  6284. SOC_ENUM_EXT("QUAT_TDM_TX_1 Data Format", tdm_config_enum[0],
  6285. msm_dai_q6_tdm_data_format_get,
  6286. msm_dai_q6_tdm_data_format_put),
  6287. SOC_ENUM_EXT("QUAT_TDM_TX_2 Data Format", tdm_config_enum[0],
  6288. msm_dai_q6_tdm_data_format_get,
  6289. msm_dai_q6_tdm_data_format_put),
  6290. SOC_ENUM_EXT("QUAT_TDM_TX_3 Data Format", tdm_config_enum[0],
  6291. msm_dai_q6_tdm_data_format_get,
  6292. msm_dai_q6_tdm_data_format_put),
  6293. SOC_ENUM_EXT("QUAT_TDM_TX_4 Data Format", tdm_config_enum[0],
  6294. msm_dai_q6_tdm_data_format_get,
  6295. msm_dai_q6_tdm_data_format_put),
  6296. SOC_ENUM_EXT("QUAT_TDM_TX_5 Data Format", tdm_config_enum[0],
  6297. msm_dai_q6_tdm_data_format_get,
  6298. msm_dai_q6_tdm_data_format_put),
  6299. SOC_ENUM_EXT("QUAT_TDM_TX_6 Data Format", tdm_config_enum[0],
  6300. msm_dai_q6_tdm_data_format_get,
  6301. msm_dai_q6_tdm_data_format_put),
  6302. SOC_ENUM_EXT("QUAT_TDM_TX_7 Data Format", tdm_config_enum[0],
  6303. msm_dai_q6_tdm_data_format_get,
  6304. msm_dai_q6_tdm_data_format_put),
  6305. SOC_ENUM_EXT("QUIN_TDM_RX_0 Data Format", tdm_config_enum[0],
  6306. msm_dai_q6_tdm_data_format_get,
  6307. msm_dai_q6_tdm_data_format_put),
  6308. SOC_ENUM_EXT("QUIN_TDM_RX_1 Data Format", tdm_config_enum[0],
  6309. msm_dai_q6_tdm_data_format_get,
  6310. msm_dai_q6_tdm_data_format_put),
  6311. SOC_ENUM_EXT("QUIN_TDM_RX_2 Data Format", tdm_config_enum[0],
  6312. msm_dai_q6_tdm_data_format_get,
  6313. msm_dai_q6_tdm_data_format_put),
  6314. SOC_ENUM_EXT("QUIN_TDM_RX_3 Data Format", tdm_config_enum[0],
  6315. msm_dai_q6_tdm_data_format_get,
  6316. msm_dai_q6_tdm_data_format_put),
  6317. SOC_ENUM_EXT("QUIN_TDM_RX_4 Data Format", tdm_config_enum[0],
  6318. msm_dai_q6_tdm_data_format_get,
  6319. msm_dai_q6_tdm_data_format_put),
  6320. SOC_ENUM_EXT("QUIN_TDM_RX_5 Data Format", tdm_config_enum[0],
  6321. msm_dai_q6_tdm_data_format_get,
  6322. msm_dai_q6_tdm_data_format_put),
  6323. SOC_ENUM_EXT("QUIN_TDM_RX_6 Data Format", tdm_config_enum[0],
  6324. msm_dai_q6_tdm_data_format_get,
  6325. msm_dai_q6_tdm_data_format_put),
  6326. SOC_ENUM_EXT("QUIN_TDM_RX_7 Data Format", tdm_config_enum[0],
  6327. msm_dai_q6_tdm_data_format_get,
  6328. msm_dai_q6_tdm_data_format_put),
  6329. SOC_ENUM_EXT("QUIN_TDM_TX_0 Data Format", tdm_config_enum[0],
  6330. msm_dai_q6_tdm_data_format_get,
  6331. msm_dai_q6_tdm_data_format_put),
  6332. SOC_ENUM_EXT("QUIN_TDM_TX_1 Data Format", tdm_config_enum[0],
  6333. msm_dai_q6_tdm_data_format_get,
  6334. msm_dai_q6_tdm_data_format_put),
  6335. SOC_ENUM_EXT("QUIN_TDM_TX_2 Data Format", tdm_config_enum[0],
  6336. msm_dai_q6_tdm_data_format_get,
  6337. msm_dai_q6_tdm_data_format_put),
  6338. SOC_ENUM_EXT("QUIN_TDM_TX_3 Data Format", tdm_config_enum[0],
  6339. msm_dai_q6_tdm_data_format_get,
  6340. msm_dai_q6_tdm_data_format_put),
  6341. SOC_ENUM_EXT("QUIN_TDM_TX_4 Data Format", tdm_config_enum[0],
  6342. msm_dai_q6_tdm_data_format_get,
  6343. msm_dai_q6_tdm_data_format_put),
  6344. SOC_ENUM_EXT("QUIN_TDM_TX_5 Data Format", tdm_config_enum[0],
  6345. msm_dai_q6_tdm_data_format_get,
  6346. msm_dai_q6_tdm_data_format_put),
  6347. SOC_ENUM_EXT("QUIN_TDM_TX_6 Data Format", tdm_config_enum[0],
  6348. msm_dai_q6_tdm_data_format_get,
  6349. msm_dai_q6_tdm_data_format_put),
  6350. SOC_ENUM_EXT("QUIN_TDM_TX_7 Data Format", tdm_config_enum[0],
  6351. msm_dai_q6_tdm_data_format_get,
  6352. msm_dai_q6_tdm_data_format_put),
  6353. };
  6354. static const struct snd_kcontrol_new tdm_config_controls_header_type[] = {
  6355. SOC_ENUM_EXT("PRI_TDM_RX_0 Header Type", tdm_config_enum[1],
  6356. msm_dai_q6_tdm_header_type_get,
  6357. msm_dai_q6_tdm_header_type_put),
  6358. SOC_ENUM_EXT("PRI_TDM_RX_1 Header Type", tdm_config_enum[1],
  6359. msm_dai_q6_tdm_header_type_get,
  6360. msm_dai_q6_tdm_header_type_put),
  6361. SOC_ENUM_EXT("PRI_TDM_RX_2 Header Type", tdm_config_enum[1],
  6362. msm_dai_q6_tdm_header_type_get,
  6363. msm_dai_q6_tdm_header_type_put),
  6364. SOC_ENUM_EXT("PRI_TDM_RX_3 Header Type", tdm_config_enum[1],
  6365. msm_dai_q6_tdm_header_type_get,
  6366. msm_dai_q6_tdm_header_type_put),
  6367. SOC_ENUM_EXT("PRI_TDM_RX_4 Header Type", tdm_config_enum[1],
  6368. msm_dai_q6_tdm_header_type_get,
  6369. msm_dai_q6_tdm_header_type_put),
  6370. SOC_ENUM_EXT("PRI_TDM_RX_5 Header Type", tdm_config_enum[1],
  6371. msm_dai_q6_tdm_header_type_get,
  6372. msm_dai_q6_tdm_header_type_put),
  6373. SOC_ENUM_EXT("PRI_TDM_RX_6 Header Type", tdm_config_enum[1],
  6374. msm_dai_q6_tdm_header_type_get,
  6375. msm_dai_q6_tdm_header_type_put),
  6376. SOC_ENUM_EXT("PRI_TDM_RX_7 Header Type", tdm_config_enum[1],
  6377. msm_dai_q6_tdm_header_type_get,
  6378. msm_dai_q6_tdm_header_type_put),
  6379. SOC_ENUM_EXT("PRI_TDM_TX_0 Header Type", tdm_config_enum[1],
  6380. msm_dai_q6_tdm_header_type_get,
  6381. msm_dai_q6_tdm_header_type_put),
  6382. SOC_ENUM_EXT("PRI_TDM_TX_1 Header Type", tdm_config_enum[1],
  6383. msm_dai_q6_tdm_header_type_get,
  6384. msm_dai_q6_tdm_header_type_put),
  6385. SOC_ENUM_EXT("PRI_TDM_TX_2 Header Type", tdm_config_enum[1],
  6386. msm_dai_q6_tdm_header_type_get,
  6387. msm_dai_q6_tdm_header_type_put),
  6388. SOC_ENUM_EXT("PRI_TDM_TX_3 Header Type", tdm_config_enum[1],
  6389. msm_dai_q6_tdm_header_type_get,
  6390. msm_dai_q6_tdm_header_type_put),
  6391. SOC_ENUM_EXT("PRI_TDM_TX_4 Header Type", tdm_config_enum[1],
  6392. msm_dai_q6_tdm_header_type_get,
  6393. msm_dai_q6_tdm_header_type_put),
  6394. SOC_ENUM_EXT("PRI_TDM_TX_5 Header Type", tdm_config_enum[1],
  6395. msm_dai_q6_tdm_header_type_get,
  6396. msm_dai_q6_tdm_header_type_put),
  6397. SOC_ENUM_EXT("PRI_TDM_TX_6 Header Type", tdm_config_enum[1],
  6398. msm_dai_q6_tdm_header_type_get,
  6399. msm_dai_q6_tdm_header_type_put),
  6400. SOC_ENUM_EXT("PRI_TDM_TX_7 Header Type", tdm_config_enum[1],
  6401. msm_dai_q6_tdm_header_type_get,
  6402. msm_dai_q6_tdm_header_type_put),
  6403. SOC_ENUM_EXT("SEC_TDM_RX_0 Header Type", tdm_config_enum[1],
  6404. msm_dai_q6_tdm_header_type_get,
  6405. msm_dai_q6_tdm_header_type_put),
  6406. SOC_ENUM_EXT("SEC_TDM_RX_1 Header Type", tdm_config_enum[1],
  6407. msm_dai_q6_tdm_header_type_get,
  6408. msm_dai_q6_tdm_header_type_put),
  6409. SOC_ENUM_EXT("SEC_TDM_RX_2 Header Type", tdm_config_enum[1],
  6410. msm_dai_q6_tdm_header_type_get,
  6411. msm_dai_q6_tdm_header_type_put),
  6412. SOC_ENUM_EXT("SEC_TDM_RX_3 Header Type", tdm_config_enum[1],
  6413. msm_dai_q6_tdm_header_type_get,
  6414. msm_dai_q6_tdm_header_type_put),
  6415. SOC_ENUM_EXT("SEC_TDM_RX_4 Header Type", tdm_config_enum[1],
  6416. msm_dai_q6_tdm_header_type_get,
  6417. msm_dai_q6_tdm_header_type_put),
  6418. SOC_ENUM_EXT("SEC_TDM_RX_5 Header Type", tdm_config_enum[1],
  6419. msm_dai_q6_tdm_header_type_get,
  6420. msm_dai_q6_tdm_header_type_put),
  6421. SOC_ENUM_EXT("SEC_TDM_RX_6 Header Type", tdm_config_enum[1],
  6422. msm_dai_q6_tdm_header_type_get,
  6423. msm_dai_q6_tdm_header_type_put),
  6424. SOC_ENUM_EXT("SEC_TDM_RX_7 Header Type", tdm_config_enum[1],
  6425. msm_dai_q6_tdm_header_type_get,
  6426. msm_dai_q6_tdm_header_type_put),
  6427. SOC_ENUM_EXT("SEC_TDM_TX_0 Header Type", tdm_config_enum[1],
  6428. msm_dai_q6_tdm_header_type_get,
  6429. msm_dai_q6_tdm_header_type_put),
  6430. SOC_ENUM_EXT("SEC_TDM_TX_1 Header Type", tdm_config_enum[1],
  6431. msm_dai_q6_tdm_header_type_get,
  6432. msm_dai_q6_tdm_header_type_put),
  6433. SOC_ENUM_EXT("SEC_TDM_TX_2 Header Type", tdm_config_enum[1],
  6434. msm_dai_q6_tdm_header_type_get,
  6435. msm_dai_q6_tdm_header_type_put),
  6436. SOC_ENUM_EXT("SEC_TDM_TX_3 Header Type", tdm_config_enum[1],
  6437. msm_dai_q6_tdm_header_type_get,
  6438. msm_dai_q6_tdm_header_type_put),
  6439. SOC_ENUM_EXT("SEC_TDM_TX_4 Header Type", tdm_config_enum[1],
  6440. msm_dai_q6_tdm_header_type_get,
  6441. msm_dai_q6_tdm_header_type_put),
  6442. SOC_ENUM_EXT("SEC_TDM_TX_5 Header Type", tdm_config_enum[1],
  6443. msm_dai_q6_tdm_header_type_get,
  6444. msm_dai_q6_tdm_header_type_put),
  6445. SOC_ENUM_EXT("SEC_TDM_TX_6 Header Type", tdm_config_enum[1],
  6446. msm_dai_q6_tdm_header_type_get,
  6447. msm_dai_q6_tdm_header_type_put),
  6448. SOC_ENUM_EXT("SEC_TDM_TX_7 Header Type", tdm_config_enum[1],
  6449. msm_dai_q6_tdm_header_type_get,
  6450. msm_dai_q6_tdm_header_type_put),
  6451. SOC_ENUM_EXT("TERT_TDM_RX_0 Header Type", tdm_config_enum[1],
  6452. msm_dai_q6_tdm_header_type_get,
  6453. msm_dai_q6_tdm_header_type_put),
  6454. SOC_ENUM_EXT("TERT_TDM_RX_1 Header Type", tdm_config_enum[1],
  6455. msm_dai_q6_tdm_header_type_get,
  6456. msm_dai_q6_tdm_header_type_put),
  6457. SOC_ENUM_EXT("TERT_TDM_RX_2 Header Type", tdm_config_enum[1],
  6458. msm_dai_q6_tdm_header_type_get,
  6459. msm_dai_q6_tdm_header_type_put),
  6460. SOC_ENUM_EXT("TERT_TDM_RX_3 Header Type", tdm_config_enum[1],
  6461. msm_dai_q6_tdm_header_type_get,
  6462. msm_dai_q6_tdm_header_type_put),
  6463. SOC_ENUM_EXT("TERT_TDM_RX_4 Header Type", tdm_config_enum[1],
  6464. msm_dai_q6_tdm_header_type_get,
  6465. msm_dai_q6_tdm_header_type_put),
  6466. SOC_ENUM_EXT("TERT_TDM_RX_5 Header Type", tdm_config_enum[1],
  6467. msm_dai_q6_tdm_header_type_get,
  6468. msm_dai_q6_tdm_header_type_put),
  6469. SOC_ENUM_EXT("TERT_TDM_RX_6 Header Type", tdm_config_enum[1],
  6470. msm_dai_q6_tdm_header_type_get,
  6471. msm_dai_q6_tdm_header_type_put),
  6472. SOC_ENUM_EXT("TERT_TDM_RX_7 Header Type", tdm_config_enum[1],
  6473. msm_dai_q6_tdm_header_type_get,
  6474. msm_dai_q6_tdm_header_type_put),
  6475. SOC_ENUM_EXT("TERT_TDM_TX_0 Header Type", tdm_config_enum[1],
  6476. msm_dai_q6_tdm_header_type_get,
  6477. msm_dai_q6_tdm_header_type_put),
  6478. SOC_ENUM_EXT("TERT_TDM_TX_1 Header Type", tdm_config_enum[1],
  6479. msm_dai_q6_tdm_header_type_get,
  6480. msm_dai_q6_tdm_header_type_put),
  6481. SOC_ENUM_EXT("TERT_TDM_TX_2 Header Type", tdm_config_enum[1],
  6482. msm_dai_q6_tdm_header_type_get,
  6483. msm_dai_q6_tdm_header_type_put),
  6484. SOC_ENUM_EXT("TERT_TDM_TX_3 Header Type", tdm_config_enum[1],
  6485. msm_dai_q6_tdm_header_type_get,
  6486. msm_dai_q6_tdm_header_type_put),
  6487. SOC_ENUM_EXT("TERT_TDM_TX_4 Header Type", tdm_config_enum[1],
  6488. msm_dai_q6_tdm_header_type_get,
  6489. msm_dai_q6_tdm_header_type_put),
  6490. SOC_ENUM_EXT("TERT_TDM_TX_5 Header Type", tdm_config_enum[1],
  6491. msm_dai_q6_tdm_header_type_get,
  6492. msm_dai_q6_tdm_header_type_put),
  6493. SOC_ENUM_EXT("TERT_TDM_TX_6 Header Type", tdm_config_enum[1],
  6494. msm_dai_q6_tdm_header_type_get,
  6495. msm_dai_q6_tdm_header_type_put),
  6496. SOC_ENUM_EXT("TERT_TDM_TX_7 Header Type", tdm_config_enum[1],
  6497. msm_dai_q6_tdm_header_type_get,
  6498. msm_dai_q6_tdm_header_type_put),
  6499. SOC_ENUM_EXT("QUAT_TDM_RX_0 Header Type", tdm_config_enum[1],
  6500. msm_dai_q6_tdm_header_type_get,
  6501. msm_dai_q6_tdm_header_type_put),
  6502. SOC_ENUM_EXT("QUAT_TDM_RX_1 Header Type", tdm_config_enum[1],
  6503. msm_dai_q6_tdm_header_type_get,
  6504. msm_dai_q6_tdm_header_type_put),
  6505. SOC_ENUM_EXT("QUAT_TDM_RX_2 Header Type", tdm_config_enum[1],
  6506. msm_dai_q6_tdm_header_type_get,
  6507. msm_dai_q6_tdm_header_type_put),
  6508. SOC_ENUM_EXT("QUAT_TDM_RX_3 Header Type", tdm_config_enum[1],
  6509. msm_dai_q6_tdm_header_type_get,
  6510. msm_dai_q6_tdm_header_type_put),
  6511. SOC_ENUM_EXT("QUAT_TDM_RX_4 Header Type", tdm_config_enum[1],
  6512. msm_dai_q6_tdm_header_type_get,
  6513. msm_dai_q6_tdm_header_type_put),
  6514. SOC_ENUM_EXT("QUAT_TDM_RX_5 Header Type", tdm_config_enum[1],
  6515. msm_dai_q6_tdm_header_type_get,
  6516. msm_dai_q6_tdm_header_type_put),
  6517. SOC_ENUM_EXT("QUAT_TDM_RX_6 Header Type", tdm_config_enum[1],
  6518. msm_dai_q6_tdm_header_type_get,
  6519. msm_dai_q6_tdm_header_type_put),
  6520. SOC_ENUM_EXT("QUAT_TDM_RX_7 Header Type", tdm_config_enum[1],
  6521. msm_dai_q6_tdm_header_type_get,
  6522. msm_dai_q6_tdm_header_type_put),
  6523. SOC_ENUM_EXT("QUAT_TDM_TX_0 Header Type", tdm_config_enum[1],
  6524. msm_dai_q6_tdm_header_type_get,
  6525. msm_dai_q6_tdm_header_type_put),
  6526. SOC_ENUM_EXT("QUAT_TDM_TX_1 Header Type", tdm_config_enum[1],
  6527. msm_dai_q6_tdm_header_type_get,
  6528. msm_dai_q6_tdm_header_type_put),
  6529. SOC_ENUM_EXT("QUAT_TDM_TX_2 Header Type", tdm_config_enum[1],
  6530. msm_dai_q6_tdm_header_type_get,
  6531. msm_dai_q6_tdm_header_type_put),
  6532. SOC_ENUM_EXT("QUAT_TDM_TX_3 Header Type", tdm_config_enum[1],
  6533. msm_dai_q6_tdm_header_type_get,
  6534. msm_dai_q6_tdm_header_type_put),
  6535. SOC_ENUM_EXT("QUAT_TDM_TX_4 Header Type", tdm_config_enum[1],
  6536. msm_dai_q6_tdm_header_type_get,
  6537. msm_dai_q6_tdm_header_type_put),
  6538. SOC_ENUM_EXT("QUAT_TDM_TX_5 Header Type", tdm_config_enum[1],
  6539. msm_dai_q6_tdm_header_type_get,
  6540. msm_dai_q6_tdm_header_type_put),
  6541. SOC_ENUM_EXT("QUAT_TDM_TX_6 Header Type", tdm_config_enum[1],
  6542. msm_dai_q6_tdm_header_type_get,
  6543. msm_dai_q6_tdm_header_type_put),
  6544. SOC_ENUM_EXT("QUAT_TDM_TX_7 Header Type", tdm_config_enum[1],
  6545. msm_dai_q6_tdm_header_type_get,
  6546. msm_dai_q6_tdm_header_type_put),
  6547. SOC_ENUM_EXT("QUIN_TDM_RX_0 Header Type", tdm_config_enum[1],
  6548. msm_dai_q6_tdm_header_type_get,
  6549. msm_dai_q6_tdm_header_type_put),
  6550. SOC_ENUM_EXT("QUIN_TDM_RX_1 Header Type", tdm_config_enum[1],
  6551. msm_dai_q6_tdm_header_type_get,
  6552. msm_dai_q6_tdm_header_type_put),
  6553. SOC_ENUM_EXT("QUIN_TDM_RX_2 Header Type", tdm_config_enum[1],
  6554. msm_dai_q6_tdm_header_type_get,
  6555. msm_dai_q6_tdm_header_type_put),
  6556. SOC_ENUM_EXT("QUIN_TDM_RX_3 Header Type", tdm_config_enum[1],
  6557. msm_dai_q6_tdm_header_type_get,
  6558. msm_dai_q6_tdm_header_type_put),
  6559. SOC_ENUM_EXT("QUIN_TDM_RX_4 Header Type", tdm_config_enum[1],
  6560. msm_dai_q6_tdm_header_type_get,
  6561. msm_dai_q6_tdm_header_type_put),
  6562. SOC_ENUM_EXT("QUIN_TDM_RX_5 Header Type", tdm_config_enum[1],
  6563. msm_dai_q6_tdm_header_type_get,
  6564. msm_dai_q6_tdm_header_type_put),
  6565. SOC_ENUM_EXT("QUIN_TDM_RX_6 Header Type", tdm_config_enum[1],
  6566. msm_dai_q6_tdm_header_type_get,
  6567. msm_dai_q6_tdm_header_type_put),
  6568. SOC_ENUM_EXT("QUIN_TDM_RX_7 Header Type", tdm_config_enum[1],
  6569. msm_dai_q6_tdm_header_type_get,
  6570. msm_dai_q6_tdm_header_type_put),
  6571. SOC_ENUM_EXT("QUIN_TDM_TX_0 Header Type", tdm_config_enum[1],
  6572. msm_dai_q6_tdm_header_type_get,
  6573. msm_dai_q6_tdm_header_type_put),
  6574. SOC_ENUM_EXT("QUIN_TDM_TX_1 Header Type", tdm_config_enum[1],
  6575. msm_dai_q6_tdm_header_type_get,
  6576. msm_dai_q6_tdm_header_type_put),
  6577. SOC_ENUM_EXT("QUIN_TDM_TX_2 Header Type", tdm_config_enum[1],
  6578. msm_dai_q6_tdm_header_type_get,
  6579. msm_dai_q6_tdm_header_type_put),
  6580. SOC_ENUM_EXT("QUIN_TDM_TX_3 Header Type", tdm_config_enum[1],
  6581. msm_dai_q6_tdm_header_type_get,
  6582. msm_dai_q6_tdm_header_type_put),
  6583. SOC_ENUM_EXT("QUIN_TDM_TX_4 Header Type", tdm_config_enum[1],
  6584. msm_dai_q6_tdm_header_type_get,
  6585. msm_dai_q6_tdm_header_type_put),
  6586. SOC_ENUM_EXT("QUIN_TDM_TX_5 Header Type", tdm_config_enum[1],
  6587. msm_dai_q6_tdm_header_type_get,
  6588. msm_dai_q6_tdm_header_type_put),
  6589. SOC_ENUM_EXT("QUIN_TDM_TX_6 Header Type", tdm_config_enum[1],
  6590. msm_dai_q6_tdm_header_type_get,
  6591. msm_dai_q6_tdm_header_type_put),
  6592. SOC_ENUM_EXT("QUIN_TDM_TX_7 Header Type", tdm_config_enum[1],
  6593. msm_dai_q6_tdm_header_type_get,
  6594. msm_dai_q6_tdm_header_type_put),
  6595. };
  6596. static const struct snd_kcontrol_new tdm_config_controls_header[] = {
  6597. SOC_SINGLE_MULTI_EXT("PRI_TDM_RX_0 Header",
  6598. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6599. msm_dai_q6_tdm_header_get,
  6600. msm_dai_q6_tdm_header_put),
  6601. SOC_SINGLE_MULTI_EXT("PRI_TDM_RX_1 Header",
  6602. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6603. msm_dai_q6_tdm_header_get,
  6604. msm_dai_q6_tdm_header_put),
  6605. SOC_SINGLE_MULTI_EXT("PRI_TDM_RX_2 Header",
  6606. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6607. msm_dai_q6_tdm_header_get,
  6608. msm_dai_q6_tdm_header_put),
  6609. SOC_SINGLE_MULTI_EXT("PRI_TDM_RX_3 Header",
  6610. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6611. msm_dai_q6_tdm_header_get,
  6612. msm_dai_q6_tdm_header_put),
  6613. SOC_SINGLE_MULTI_EXT("PRI_TDM_RX_4 Header",
  6614. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6615. msm_dai_q6_tdm_header_get,
  6616. msm_dai_q6_tdm_header_put),
  6617. SOC_SINGLE_MULTI_EXT("PRI_TDM_RX_5 Header",
  6618. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6619. msm_dai_q6_tdm_header_get,
  6620. msm_dai_q6_tdm_header_put),
  6621. SOC_SINGLE_MULTI_EXT("PRI_TDM_RX_6 Header",
  6622. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6623. msm_dai_q6_tdm_header_get,
  6624. msm_dai_q6_tdm_header_put),
  6625. SOC_SINGLE_MULTI_EXT("PRI_TDM_RX_7 Header",
  6626. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6627. msm_dai_q6_tdm_header_get,
  6628. msm_dai_q6_tdm_header_put),
  6629. SOC_SINGLE_MULTI_EXT("PRI_TDM_TX_0 Header",
  6630. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6631. msm_dai_q6_tdm_header_get,
  6632. msm_dai_q6_tdm_header_put),
  6633. SOC_SINGLE_MULTI_EXT("PRI_TDM_TX_1 Header",
  6634. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6635. msm_dai_q6_tdm_header_get,
  6636. msm_dai_q6_tdm_header_put),
  6637. SOC_SINGLE_MULTI_EXT("PRI_TDM_TX_2 Header",
  6638. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6639. msm_dai_q6_tdm_header_get,
  6640. msm_dai_q6_tdm_header_put),
  6641. SOC_SINGLE_MULTI_EXT("PRI_TDM_TX_3 Header",
  6642. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6643. msm_dai_q6_tdm_header_get,
  6644. msm_dai_q6_tdm_header_put),
  6645. SOC_SINGLE_MULTI_EXT("PRI_TDM_TX_4 Header",
  6646. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6647. msm_dai_q6_tdm_header_get,
  6648. msm_dai_q6_tdm_header_put),
  6649. SOC_SINGLE_MULTI_EXT("PRI_TDM_TX_5 Header",
  6650. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6651. msm_dai_q6_tdm_header_get,
  6652. msm_dai_q6_tdm_header_put),
  6653. SOC_SINGLE_MULTI_EXT("PRI_TDM_TX_6 Header",
  6654. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6655. msm_dai_q6_tdm_header_get,
  6656. msm_dai_q6_tdm_header_put),
  6657. SOC_SINGLE_MULTI_EXT("PRI_TDM_TX_7 Header",
  6658. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6659. msm_dai_q6_tdm_header_get,
  6660. msm_dai_q6_tdm_header_put),
  6661. SOC_SINGLE_MULTI_EXT("SEC_TDM_RX_0 Header",
  6662. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6663. msm_dai_q6_tdm_header_get,
  6664. msm_dai_q6_tdm_header_put),
  6665. SOC_SINGLE_MULTI_EXT("SEC_TDM_RX_1 Header",
  6666. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6667. msm_dai_q6_tdm_header_get,
  6668. msm_dai_q6_tdm_header_put),
  6669. SOC_SINGLE_MULTI_EXT("SEC_TDM_RX_2 Header",
  6670. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6671. msm_dai_q6_tdm_header_get,
  6672. msm_dai_q6_tdm_header_put),
  6673. SOC_SINGLE_MULTI_EXT("SEC_TDM_RX_3 Header",
  6674. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6675. msm_dai_q6_tdm_header_get,
  6676. msm_dai_q6_tdm_header_put),
  6677. SOC_SINGLE_MULTI_EXT("SEC_TDM_RX_4 Header",
  6678. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6679. msm_dai_q6_tdm_header_get,
  6680. msm_dai_q6_tdm_header_put),
  6681. SOC_SINGLE_MULTI_EXT("SEC_TDM_RX_5 Header",
  6682. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6683. msm_dai_q6_tdm_header_get,
  6684. msm_dai_q6_tdm_header_put),
  6685. SOC_SINGLE_MULTI_EXT("SEC_TDM_RX_6 Header",
  6686. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6687. msm_dai_q6_tdm_header_get,
  6688. msm_dai_q6_tdm_header_put),
  6689. SOC_SINGLE_MULTI_EXT("SEC_TDM_RX_7 Header",
  6690. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6691. msm_dai_q6_tdm_header_get,
  6692. msm_dai_q6_tdm_header_put),
  6693. SOC_SINGLE_MULTI_EXT("SEC_TDM_TX_0 Header",
  6694. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6695. msm_dai_q6_tdm_header_get,
  6696. msm_dai_q6_tdm_header_put),
  6697. SOC_SINGLE_MULTI_EXT("SEC_TDM_TX_1 Header",
  6698. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6699. msm_dai_q6_tdm_header_get,
  6700. msm_dai_q6_tdm_header_put),
  6701. SOC_SINGLE_MULTI_EXT("SEC_TDM_TX_2 Header",
  6702. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6703. msm_dai_q6_tdm_header_get,
  6704. msm_dai_q6_tdm_header_put),
  6705. SOC_SINGLE_MULTI_EXT("SEC_TDM_TX_3 Header",
  6706. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6707. msm_dai_q6_tdm_header_get,
  6708. msm_dai_q6_tdm_header_put),
  6709. SOC_SINGLE_MULTI_EXT("SEC_TDM_TX_4 Header",
  6710. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6711. msm_dai_q6_tdm_header_get,
  6712. msm_dai_q6_tdm_header_put),
  6713. SOC_SINGLE_MULTI_EXT("SEC_TDM_TX_5 Header",
  6714. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6715. msm_dai_q6_tdm_header_get,
  6716. msm_dai_q6_tdm_header_put),
  6717. SOC_SINGLE_MULTI_EXT("SEC_TDM_TX_6 Header",
  6718. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6719. msm_dai_q6_tdm_header_get,
  6720. msm_dai_q6_tdm_header_put),
  6721. SOC_SINGLE_MULTI_EXT("SEC_TDM_TX_7 Header",
  6722. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6723. msm_dai_q6_tdm_header_get,
  6724. msm_dai_q6_tdm_header_put),
  6725. SOC_SINGLE_MULTI_EXT("TERT_TDM_RX_0 Header",
  6726. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6727. msm_dai_q6_tdm_header_get,
  6728. msm_dai_q6_tdm_header_put),
  6729. SOC_SINGLE_MULTI_EXT("TERT_TDM_RX_1 Header",
  6730. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6731. msm_dai_q6_tdm_header_get,
  6732. msm_dai_q6_tdm_header_put),
  6733. SOC_SINGLE_MULTI_EXT("TERT_TDM_RX_2 Header",
  6734. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6735. msm_dai_q6_tdm_header_get,
  6736. msm_dai_q6_tdm_header_put),
  6737. SOC_SINGLE_MULTI_EXT("TERT_TDM_RX_3 Header",
  6738. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6739. msm_dai_q6_tdm_header_get,
  6740. msm_dai_q6_tdm_header_put),
  6741. SOC_SINGLE_MULTI_EXT("TERT_TDM_RX_4 Header",
  6742. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6743. msm_dai_q6_tdm_header_get,
  6744. msm_dai_q6_tdm_header_put),
  6745. SOC_SINGLE_MULTI_EXT("TERT_TDM_RX_5 Header",
  6746. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6747. msm_dai_q6_tdm_header_get,
  6748. msm_dai_q6_tdm_header_put),
  6749. SOC_SINGLE_MULTI_EXT("TERT_TDM_RX_6 Header",
  6750. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6751. msm_dai_q6_tdm_header_get,
  6752. msm_dai_q6_tdm_header_put),
  6753. SOC_SINGLE_MULTI_EXT("TERT_TDM_RX_7 Header",
  6754. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6755. msm_dai_q6_tdm_header_get,
  6756. msm_dai_q6_tdm_header_put),
  6757. SOC_SINGLE_MULTI_EXT("TERT_TDM_TX_0 Header",
  6758. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6759. msm_dai_q6_tdm_header_get,
  6760. msm_dai_q6_tdm_header_put),
  6761. SOC_SINGLE_MULTI_EXT("TERT_TDM_TX_1 Header",
  6762. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6763. msm_dai_q6_tdm_header_get,
  6764. msm_dai_q6_tdm_header_put),
  6765. SOC_SINGLE_MULTI_EXT("TERT_TDM_TX_2 Header",
  6766. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6767. msm_dai_q6_tdm_header_get,
  6768. msm_dai_q6_tdm_header_put),
  6769. SOC_SINGLE_MULTI_EXT("TERT_TDM_TX_3 Header",
  6770. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6771. msm_dai_q6_tdm_header_get,
  6772. msm_dai_q6_tdm_header_put),
  6773. SOC_SINGLE_MULTI_EXT("TERT_TDM_TX_4 Header",
  6774. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6775. msm_dai_q6_tdm_header_get,
  6776. msm_dai_q6_tdm_header_put),
  6777. SOC_SINGLE_MULTI_EXT("TERT_TDM_TX_5 Header",
  6778. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6779. msm_dai_q6_tdm_header_get,
  6780. msm_dai_q6_tdm_header_put),
  6781. SOC_SINGLE_MULTI_EXT("TERT_TDM_TX_6 Header",
  6782. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6783. msm_dai_q6_tdm_header_get,
  6784. msm_dai_q6_tdm_header_put),
  6785. SOC_SINGLE_MULTI_EXT("TERT_TDM_TX_7 Header",
  6786. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6787. msm_dai_q6_tdm_header_get,
  6788. msm_dai_q6_tdm_header_put),
  6789. SOC_SINGLE_MULTI_EXT("QUAT_TDM_RX_0 Header",
  6790. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6791. msm_dai_q6_tdm_header_get,
  6792. msm_dai_q6_tdm_header_put),
  6793. SOC_SINGLE_MULTI_EXT("QUAT_TDM_RX_1 Header",
  6794. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6795. msm_dai_q6_tdm_header_get,
  6796. msm_dai_q6_tdm_header_put),
  6797. SOC_SINGLE_MULTI_EXT("QUAT_TDM_RX_2 Header",
  6798. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6799. msm_dai_q6_tdm_header_get,
  6800. msm_dai_q6_tdm_header_put),
  6801. SOC_SINGLE_MULTI_EXT("QUAT_TDM_RX_3 Header",
  6802. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6803. msm_dai_q6_tdm_header_get,
  6804. msm_dai_q6_tdm_header_put),
  6805. SOC_SINGLE_MULTI_EXT("QUAT_TDM_RX_4 Header",
  6806. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6807. msm_dai_q6_tdm_header_get,
  6808. msm_dai_q6_tdm_header_put),
  6809. SOC_SINGLE_MULTI_EXT("QUAT_TDM_RX_5 Header",
  6810. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6811. msm_dai_q6_tdm_header_get,
  6812. msm_dai_q6_tdm_header_put),
  6813. SOC_SINGLE_MULTI_EXT("QUAT_TDM_RX_6 Header",
  6814. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6815. msm_dai_q6_tdm_header_get,
  6816. msm_dai_q6_tdm_header_put),
  6817. SOC_SINGLE_MULTI_EXT("QUAT_TDM_RX_7 Header",
  6818. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6819. msm_dai_q6_tdm_header_get,
  6820. msm_dai_q6_tdm_header_put),
  6821. SOC_SINGLE_MULTI_EXT("QUAT_TDM_TX_0 Header",
  6822. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6823. msm_dai_q6_tdm_header_get,
  6824. msm_dai_q6_tdm_header_put),
  6825. SOC_SINGLE_MULTI_EXT("QUAT_TDM_TX_1 Header",
  6826. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6827. msm_dai_q6_tdm_header_get,
  6828. msm_dai_q6_tdm_header_put),
  6829. SOC_SINGLE_MULTI_EXT("QUAT_TDM_TX_2 Header",
  6830. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6831. msm_dai_q6_tdm_header_get,
  6832. msm_dai_q6_tdm_header_put),
  6833. SOC_SINGLE_MULTI_EXT("QUAT_TDM_TX_3 Header",
  6834. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6835. msm_dai_q6_tdm_header_get,
  6836. msm_dai_q6_tdm_header_put),
  6837. SOC_SINGLE_MULTI_EXT("QUAT_TDM_TX_4 Header",
  6838. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6839. msm_dai_q6_tdm_header_get,
  6840. msm_dai_q6_tdm_header_put),
  6841. SOC_SINGLE_MULTI_EXT("QUAT_TDM_TX_5 Header",
  6842. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6843. msm_dai_q6_tdm_header_get,
  6844. msm_dai_q6_tdm_header_put),
  6845. SOC_SINGLE_MULTI_EXT("QUAT_TDM_TX_6 Header",
  6846. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6847. msm_dai_q6_tdm_header_get,
  6848. msm_dai_q6_tdm_header_put),
  6849. SOC_SINGLE_MULTI_EXT("QUAT_TDM_TX_7 Header",
  6850. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6851. msm_dai_q6_tdm_header_get,
  6852. msm_dai_q6_tdm_header_put),
  6853. SOC_SINGLE_MULTI_EXT("QUIN_TDM_RX_0 Header",
  6854. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6855. msm_dai_q6_tdm_header_get,
  6856. msm_dai_q6_tdm_header_put),
  6857. SOC_SINGLE_MULTI_EXT("QUIN_TDM_RX_1 Header",
  6858. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6859. msm_dai_q6_tdm_header_get,
  6860. msm_dai_q6_tdm_header_put),
  6861. SOC_SINGLE_MULTI_EXT("QUIN_TDM_RX_2 Header",
  6862. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6863. msm_dai_q6_tdm_header_get,
  6864. msm_dai_q6_tdm_header_put),
  6865. SOC_SINGLE_MULTI_EXT("QUIN_TDM_RX_3 Header",
  6866. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6867. msm_dai_q6_tdm_header_get,
  6868. msm_dai_q6_tdm_header_put),
  6869. SOC_SINGLE_MULTI_EXT("QUIN_TDM_RX_4 Header",
  6870. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6871. msm_dai_q6_tdm_header_get,
  6872. msm_dai_q6_tdm_header_put),
  6873. SOC_SINGLE_MULTI_EXT("QUIN_TDM_RX_5 Header",
  6874. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6875. msm_dai_q6_tdm_header_get,
  6876. msm_dai_q6_tdm_header_put),
  6877. SOC_SINGLE_MULTI_EXT("QUIN_TDM_RX_6 Header",
  6878. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6879. msm_dai_q6_tdm_header_get,
  6880. msm_dai_q6_tdm_header_put),
  6881. SOC_SINGLE_MULTI_EXT("QUIN_TDM_RX_7 Header",
  6882. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6883. msm_dai_q6_tdm_header_get,
  6884. msm_dai_q6_tdm_header_put),
  6885. SOC_SINGLE_MULTI_EXT("QUIN_TDM_TX_0 Header",
  6886. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6887. msm_dai_q6_tdm_header_get,
  6888. msm_dai_q6_tdm_header_put),
  6889. SOC_SINGLE_MULTI_EXT("QUIN_TDM_TX_1 Header",
  6890. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6891. msm_dai_q6_tdm_header_get,
  6892. msm_dai_q6_tdm_header_put),
  6893. SOC_SINGLE_MULTI_EXT("QUIN_TDM_TX_2 Header",
  6894. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6895. msm_dai_q6_tdm_header_get,
  6896. msm_dai_q6_tdm_header_put),
  6897. SOC_SINGLE_MULTI_EXT("QUIN_TDM_TX_3 Header",
  6898. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6899. msm_dai_q6_tdm_header_get,
  6900. msm_dai_q6_tdm_header_put),
  6901. SOC_SINGLE_MULTI_EXT("QUIN_TDM_TX_4 Header",
  6902. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6903. msm_dai_q6_tdm_header_get,
  6904. msm_dai_q6_tdm_header_put),
  6905. SOC_SINGLE_MULTI_EXT("QUIN_TDM_TX_5 Header",
  6906. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6907. msm_dai_q6_tdm_header_get,
  6908. msm_dai_q6_tdm_header_put),
  6909. SOC_SINGLE_MULTI_EXT("QUIN_TDM_TX_6 Header",
  6910. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6911. msm_dai_q6_tdm_header_get,
  6912. msm_dai_q6_tdm_header_put),
  6913. SOC_SINGLE_MULTI_EXT("QUIN_TDM_TX_7 Header",
  6914. SND_SOC_NOPM, 0, 0xFFFFFFFF, 0, 8,
  6915. msm_dai_q6_tdm_header_get,
  6916. msm_dai_q6_tdm_header_put),
  6917. };
  6918. static int msm_dai_q6_tdm_set_clk(
  6919. struct msm_dai_q6_tdm_dai_data *dai_data,
  6920. u16 port_id, bool enable)
  6921. {
  6922. int rc = 0;
  6923. dai_data->clk_set.enable = enable;
  6924. rc = afe_set_lpass_clock_v2(port_id,
  6925. &dai_data->clk_set);
  6926. if (rc < 0)
  6927. pr_err("%s: afe lpass clock failed, err:%d\n",
  6928. __func__, rc);
  6929. return rc;
  6930. }
  6931. static int msm_dai_q6_dai_tdm_probe(struct snd_soc_dai *dai)
  6932. {
  6933. int rc = 0;
  6934. struct msm_dai_q6_tdm_dai_data *tdm_dai_data = NULL;
  6935. struct snd_kcontrol *data_format_kcontrol = NULL;
  6936. struct snd_kcontrol *header_type_kcontrol = NULL;
  6937. struct snd_kcontrol *header_kcontrol = NULL;
  6938. int port_idx = 0;
  6939. const struct snd_kcontrol_new *data_format_ctrl = NULL;
  6940. const struct snd_kcontrol_new *header_type_ctrl = NULL;
  6941. const struct snd_kcontrol_new *header_ctrl = NULL;
  6942. tdm_dai_data = dev_get_drvdata(dai->dev);
  6943. msm_dai_q6_set_dai_id(dai);
  6944. port_idx = msm_dai_q6_get_port_idx(dai->id);
  6945. if (port_idx < 0) {
  6946. dev_err(dai->dev, "%s port id 0x%x not supported\n",
  6947. __func__, dai->id);
  6948. rc = -EINVAL;
  6949. goto rtn;
  6950. }
  6951. data_format_ctrl =
  6952. &tdm_config_controls_data_format[port_idx];
  6953. header_type_ctrl =
  6954. &tdm_config_controls_header_type[port_idx];
  6955. header_ctrl =
  6956. &tdm_config_controls_header[port_idx];
  6957. if (data_format_ctrl) {
  6958. data_format_kcontrol = snd_ctl_new1(data_format_ctrl,
  6959. tdm_dai_data);
  6960. rc = snd_ctl_add(dai->component->card->snd_card,
  6961. data_format_kcontrol);
  6962. if (rc < 0) {
  6963. dev_err(dai->dev, "%s: err add data format ctrl DAI = %s\n",
  6964. __func__, dai->name);
  6965. goto rtn;
  6966. }
  6967. }
  6968. if (header_type_ctrl) {
  6969. header_type_kcontrol = snd_ctl_new1(header_type_ctrl,
  6970. tdm_dai_data);
  6971. rc = snd_ctl_add(dai->component->card->snd_card,
  6972. header_type_kcontrol);
  6973. if (rc < 0) {
  6974. if (data_format_kcontrol)
  6975. snd_ctl_remove(dai->component->card->snd_card,
  6976. data_format_kcontrol);
  6977. dev_err(dai->dev, "%s: err add header type ctrl DAI = %s\n",
  6978. __func__, dai->name);
  6979. goto rtn;
  6980. }
  6981. }
  6982. if (header_ctrl) {
  6983. header_kcontrol = snd_ctl_new1(header_ctrl,
  6984. tdm_dai_data);
  6985. rc = snd_ctl_add(dai->component->card->snd_card,
  6986. header_kcontrol);
  6987. if (rc < 0) {
  6988. if (header_type_kcontrol)
  6989. snd_ctl_remove(dai->component->card->snd_card,
  6990. header_type_kcontrol);
  6991. if (data_format_kcontrol)
  6992. snd_ctl_remove(dai->component->card->snd_card,
  6993. data_format_kcontrol);
  6994. dev_err(dai->dev, "%s: err add header ctrl DAI = %s\n",
  6995. __func__, dai->name);
  6996. goto rtn;
  6997. }
  6998. }
  6999. if (tdm_dai_data->is_island_dai)
  7000. rc = msm_dai_q6_add_island_mx_ctls(
  7001. dai->component->card->snd_card,
  7002. dai->name,
  7003. dai->id, (void *)tdm_dai_data);
  7004. rc = msm_dai_q6_dai_add_route(dai);
  7005. rtn:
  7006. return rc;
  7007. }
  7008. static int msm_dai_q6_dai_tdm_remove(struct snd_soc_dai *dai)
  7009. {
  7010. int rc = 0;
  7011. struct msm_dai_q6_tdm_dai_data *tdm_dai_data =
  7012. dev_get_drvdata(dai->dev);
  7013. u16 group_id = tdm_dai_data->group_cfg.tdm_cfg.group_id;
  7014. int group_idx = 0;
  7015. atomic_t *group_ref = NULL;
  7016. group_idx = msm_dai_q6_get_group_idx(dai->id);
  7017. if (group_idx < 0) {
  7018. dev_err(dai->dev, "%s port id 0x%x not supported\n",
  7019. __func__, dai->id);
  7020. return -EINVAL;
  7021. }
  7022. group_ref = &tdm_group_ref[group_idx];
  7023. /* If AFE port is still up, close it */
  7024. if (test_bit(STATUS_PORT_STARTED, tdm_dai_data->status_mask)) {
  7025. rc = afe_close(dai->id); /* can block */
  7026. if (rc < 0) {
  7027. dev_err(dai->dev, "%s: fail to close AFE port 0x%x\n",
  7028. __func__, dai->id);
  7029. }
  7030. atomic_dec(group_ref);
  7031. clear_bit(STATUS_PORT_STARTED,
  7032. tdm_dai_data->status_mask);
  7033. if (atomic_read(group_ref) == 0) {
  7034. rc = afe_port_group_enable(group_id,
  7035. NULL, false);
  7036. if (rc < 0) {
  7037. dev_err(dai->dev, "fail to disable AFE group 0x%x\n",
  7038. group_id);
  7039. }
  7040. }
  7041. if (msm_dai_q6_get_tdm_clk_ref(group_idx) == 0) {
  7042. rc = msm_dai_q6_tdm_set_clk(tdm_dai_data,
  7043. dai->id, false);
  7044. if (rc < 0) {
  7045. dev_err(dai->dev, "%s: fail to disable AFE clk 0x%x\n",
  7046. __func__, dai->id);
  7047. }
  7048. }
  7049. }
  7050. return 0;
  7051. }
  7052. static int msm_dai_q6_tdm_set_tdm_slot(struct snd_soc_dai *dai,
  7053. unsigned int tx_mask,
  7054. unsigned int rx_mask,
  7055. int slots, int slot_width)
  7056. {
  7057. int rc = 0;
  7058. struct msm_dai_q6_tdm_dai_data *dai_data =
  7059. dev_get_drvdata(dai->dev);
  7060. struct afe_param_id_group_device_tdm_cfg *tdm_group =
  7061. &dai_data->group_cfg.tdm_cfg;
  7062. unsigned int cap_mask;
  7063. dev_dbg(dai->dev, "%s: dai id = 0x%x\n", __func__, dai->id);
  7064. /* HW only supports 16 and 32 bit slot width configuration */
  7065. if ((slot_width != 16) && (slot_width != 32)) {
  7066. dev_err(dai->dev, "%s: invalid slot_width %d\n",
  7067. __func__, slot_width);
  7068. return -EINVAL;
  7069. }
  7070. /* HW supports 1-32 slots configuration. Typical: 1, 2, 4, 8, 16, 32 */
  7071. switch (slots) {
  7072. case 1:
  7073. cap_mask = 0x01;
  7074. break;
  7075. case 2:
  7076. cap_mask = 0x03;
  7077. break;
  7078. case 4:
  7079. cap_mask = 0x0F;
  7080. break;
  7081. case 8:
  7082. cap_mask = 0xFF;
  7083. break;
  7084. case 16:
  7085. cap_mask = 0xFFFF;
  7086. break;
  7087. default:
  7088. dev_err(dai->dev, "%s: invalid slots %d\n",
  7089. __func__, slots);
  7090. return -EINVAL;
  7091. }
  7092. switch (dai->id) {
  7093. case AFE_PORT_ID_PRIMARY_TDM_RX:
  7094. case AFE_PORT_ID_PRIMARY_TDM_RX_1:
  7095. case AFE_PORT_ID_PRIMARY_TDM_RX_2:
  7096. case AFE_PORT_ID_PRIMARY_TDM_RX_3:
  7097. case AFE_PORT_ID_PRIMARY_TDM_RX_4:
  7098. case AFE_PORT_ID_PRIMARY_TDM_RX_5:
  7099. case AFE_PORT_ID_PRIMARY_TDM_RX_6:
  7100. case AFE_PORT_ID_PRIMARY_TDM_RX_7:
  7101. case AFE_PORT_ID_SECONDARY_TDM_RX:
  7102. case AFE_PORT_ID_SECONDARY_TDM_RX_1:
  7103. case AFE_PORT_ID_SECONDARY_TDM_RX_2:
  7104. case AFE_PORT_ID_SECONDARY_TDM_RX_3:
  7105. case AFE_PORT_ID_SECONDARY_TDM_RX_4:
  7106. case AFE_PORT_ID_SECONDARY_TDM_RX_5:
  7107. case AFE_PORT_ID_SECONDARY_TDM_RX_6:
  7108. case AFE_PORT_ID_SECONDARY_TDM_RX_7:
  7109. case AFE_PORT_ID_TERTIARY_TDM_RX:
  7110. case AFE_PORT_ID_TERTIARY_TDM_RX_1:
  7111. case AFE_PORT_ID_TERTIARY_TDM_RX_2:
  7112. case AFE_PORT_ID_TERTIARY_TDM_RX_3:
  7113. case AFE_PORT_ID_TERTIARY_TDM_RX_4:
  7114. case AFE_PORT_ID_TERTIARY_TDM_RX_5:
  7115. case AFE_PORT_ID_TERTIARY_TDM_RX_6:
  7116. case AFE_PORT_ID_TERTIARY_TDM_RX_7:
  7117. case AFE_PORT_ID_QUATERNARY_TDM_RX:
  7118. case AFE_PORT_ID_QUATERNARY_TDM_RX_1:
  7119. case AFE_PORT_ID_QUATERNARY_TDM_RX_2:
  7120. case AFE_PORT_ID_QUATERNARY_TDM_RX_3:
  7121. case AFE_PORT_ID_QUATERNARY_TDM_RX_4:
  7122. case AFE_PORT_ID_QUATERNARY_TDM_RX_5:
  7123. case AFE_PORT_ID_QUATERNARY_TDM_RX_6:
  7124. case AFE_PORT_ID_QUATERNARY_TDM_RX_7:
  7125. case AFE_PORT_ID_QUINARY_TDM_RX:
  7126. case AFE_PORT_ID_QUINARY_TDM_RX_1:
  7127. case AFE_PORT_ID_QUINARY_TDM_RX_2:
  7128. case AFE_PORT_ID_QUINARY_TDM_RX_3:
  7129. case AFE_PORT_ID_QUINARY_TDM_RX_4:
  7130. case AFE_PORT_ID_QUINARY_TDM_RX_5:
  7131. case AFE_PORT_ID_QUINARY_TDM_RX_6:
  7132. case AFE_PORT_ID_QUINARY_TDM_RX_7:
  7133. tdm_group->nslots_per_frame = slots;
  7134. tdm_group->slot_width = slot_width;
  7135. tdm_group->slot_mask = rx_mask & cap_mask;
  7136. break;
  7137. case AFE_PORT_ID_PRIMARY_TDM_TX:
  7138. case AFE_PORT_ID_PRIMARY_TDM_TX_1:
  7139. case AFE_PORT_ID_PRIMARY_TDM_TX_2:
  7140. case AFE_PORT_ID_PRIMARY_TDM_TX_3:
  7141. case AFE_PORT_ID_PRIMARY_TDM_TX_4:
  7142. case AFE_PORT_ID_PRIMARY_TDM_TX_5:
  7143. case AFE_PORT_ID_PRIMARY_TDM_TX_6:
  7144. case AFE_PORT_ID_PRIMARY_TDM_TX_7:
  7145. case AFE_PORT_ID_SECONDARY_TDM_TX:
  7146. case AFE_PORT_ID_SECONDARY_TDM_TX_1:
  7147. case AFE_PORT_ID_SECONDARY_TDM_TX_2:
  7148. case AFE_PORT_ID_SECONDARY_TDM_TX_3:
  7149. case AFE_PORT_ID_SECONDARY_TDM_TX_4:
  7150. case AFE_PORT_ID_SECONDARY_TDM_TX_5:
  7151. case AFE_PORT_ID_SECONDARY_TDM_TX_6:
  7152. case AFE_PORT_ID_SECONDARY_TDM_TX_7:
  7153. case AFE_PORT_ID_TERTIARY_TDM_TX:
  7154. case AFE_PORT_ID_TERTIARY_TDM_TX_1:
  7155. case AFE_PORT_ID_TERTIARY_TDM_TX_2:
  7156. case AFE_PORT_ID_TERTIARY_TDM_TX_3:
  7157. case AFE_PORT_ID_TERTIARY_TDM_TX_4:
  7158. case AFE_PORT_ID_TERTIARY_TDM_TX_5:
  7159. case AFE_PORT_ID_TERTIARY_TDM_TX_6:
  7160. case AFE_PORT_ID_TERTIARY_TDM_TX_7:
  7161. case AFE_PORT_ID_QUATERNARY_TDM_TX:
  7162. case AFE_PORT_ID_QUATERNARY_TDM_TX_1:
  7163. case AFE_PORT_ID_QUATERNARY_TDM_TX_2:
  7164. case AFE_PORT_ID_QUATERNARY_TDM_TX_3:
  7165. case AFE_PORT_ID_QUATERNARY_TDM_TX_4:
  7166. case AFE_PORT_ID_QUATERNARY_TDM_TX_5:
  7167. case AFE_PORT_ID_QUATERNARY_TDM_TX_6:
  7168. case AFE_PORT_ID_QUATERNARY_TDM_TX_7:
  7169. case AFE_PORT_ID_QUINARY_TDM_TX:
  7170. case AFE_PORT_ID_QUINARY_TDM_TX_1:
  7171. case AFE_PORT_ID_QUINARY_TDM_TX_2:
  7172. case AFE_PORT_ID_QUINARY_TDM_TX_3:
  7173. case AFE_PORT_ID_QUINARY_TDM_TX_4:
  7174. case AFE_PORT_ID_QUINARY_TDM_TX_5:
  7175. case AFE_PORT_ID_QUINARY_TDM_TX_6:
  7176. case AFE_PORT_ID_QUINARY_TDM_TX_7:
  7177. tdm_group->nslots_per_frame = slots;
  7178. tdm_group->slot_width = slot_width;
  7179. tdm_group->slot_mask = tx_mask & cap_mask;
  7180. break;
  7181. default:
  7182. dev_err(dai->dev, "%s: invalid dai id 0x%x\n",
  7183. __func__, dai->id);
  7184. return -EINVAL;
  7185. }
  7186. return rc;
  7187. }
  7188. static int msm_dai_q6_tdm_set_sysclk(struct snd_soc_dai *dai,
  7189. int clk_id, unsigned int freq, int dir)
  7190. {
  7191. struct msm_dai_q6_tdm_dai_data *dai_data =
  7192. dev_get_drvdata(dai->dev);
  7193. if ((dai->id >= AFE_PORT_ID_PRIMARY_TDM_RX) &&
  7194. (dai->id <= AFE_PORT_ID_QUINARY_TDM_TX_7)) {
  7195. dai_data->clk_set.clk_freq_in_hz = freq;
  7196. } else {
  7197. dev_err(dai->dev, "%s: invalid dai id 0x%x\n",
  7198. __func__, dai->id);
  7199. return -EINVAL;
  7200. }
  7201. dev_dbg(dai->dev, "%s: dai id = 0x%x, group clk_freq = %d\n",
  7202. __func__, dai->id, freq);
  7203. return 0;
  7204. }
  7205. static int msm_dai_q6_tdm_set_channel_map(struct snd_soc_dai *dai,
  7206. unsigned int tx_num, unsigned int *tx_slot,
  7207. unsigned int rx_num, unsigned int *rx_slot)
  7208. {
  7209. int rc = 0;
  7210. struct msm_dai_q6_tdm_dai_data *dai_data =
  7211. dev_get_drvdata(dai->dev);
  7212. struct afe_param_id_slot_mapping_cfg *slot_mapping =
  7213. &dai_data->port_cfg.slot_mapping;
  7214. int i = 0;
  7215. dev_dbg(dai->dev, "%s: dai id = 0x%x\n", __func__, dai->id);
  7216. switch (dai->id) {
  7217. case AFE_PORT_ID_PRIMARY_TDM_RX:
  7218. case AFE_PORT_ID_PRIMARY_TDM_RX_1:
  7219. case AFE_PORT_ID_PRIMARY_TDM_RX_2:
  7220. case AFE_PORT_ID_PRIMARY_TDM_RX_3:
  7221. case AFE_PORT_ID_PRIMARY_TDM_RX_4:
  7222. case AFE_PORT_ID_PRIMARY_TDM_RX_5:
  7223. case AFE_PORT_ID_PRIMARY_TDM_RX_6:
  7224. case AFE_PORT_ID_PRIMARY_TDM_RX_7:
  7225. case AFE_PORT_ID_SECONDARY_TDM_RX:
  7226. case AFE_PORT_ID_SECONDARY_TDM_RX_1:
  7227. case AFE_PORT_ID_SECONDARY_TDM_RX_2:
  7228. case AFE_PORT_ID_SECONDARY_TDM_RX_3:
  7229. case AFE_PORT_ID_SECONDARY_TDM_RX_4:
  7230. case AFE_PORT_ID_SECONDARY_TDM_RX_5:
  7231. case AFE_PORT_ID_SECONDARY_TDM_RX_6:
  7232. case AFE_PORT_ID_SECONDARY_TDM_RX_7:
  7233. case AFE_PORT_ID_TERTIARY_TDM_RX:
  7234. case AFE_PORT_ID_TERTIARY_TDM_RX_1:
  7235. case AFE_PORT_ID_TERTIARY_TDM_RX_2:
  7236. case AFE_PORT_ID_TERTIARY_TDM_RX_3:
  7237. case AFE_PORT_ID_TERTIARY_TDM_RX_4:
  7238. case AFE_PORT_ID_TERTIARY_TDM_RX_5:
  7239. case AFE_PORT_ID_TERTIARY_TDM_RX_6:
  7240. case AFE_PORT_ID_TERTIARY_TDM_RX_7:
  7241. case AFE_PORT_ID_QUATERNARY_TDM_RX:
  7242. case AFE_PORT_ID_QUATERNARY_TDM_RX_1:
  7243. case AFE_PORT_ID_QUATERNARY_TDM_RX_2:
  7244. case AFE_PORT_ID_QUATERNARY_TDM_RX_3:
  7245. case AFE_PORT_ID_QUATERNARY_TDM_RX_4:
  7246. case AFE_PORT_ID_QUATERNARY_TDM_RX_5:
  7247. case AFE_PORT_ID_QUATERNARY_TDM_RX_6:
  7248. case AFE_PORT_ID_QUATERNARY_TDM_RX_7:
  7249. case AFE_PORT_ID_QUINARY_TDM_RX:
  7250. case AFE_PORT_ID_QUINARY_TDM_RX_1:
  7251. case AFE_PORT_ID_QUINARY_TDM_RX_2:
  7252. case AFE_PORT_ID_QUINARY_TDM_RX_3:
  7253. case AFE_PORT_ID_QUINARY_TDM_RX_4:
  7254. case AFE_PORT_ID_QUINARY_TDM_RX_5:
  7255. case AFE_PORT_ID_QUINARY_TDM_RX_6:
  7256. case AFE_PORT_ID_QUINARY_TDM_RX_7:
  7257. if (!rx_slot) {
  7258. dev_err(dai->dev, "%s: rx slot not found\n", __func__);
  7259. return -EINVAL;
  7260. }
  7261. if (rx_num > AFE_PORT_MAX_AUDIO_CHAN_CNT) {
  7262. dev_err(dai->dev, "%s: invalid rx num %d\n", __func__,
  7263. rx_num);
  7264. return -EINVAL;
  7265. }
  7266. for (i = 0; i < rx_num; i++)
  7267. slot_mapping->offset[i] = rx_slot[i];
  7268. for (i = rx_num; i < AFE_PORT_MAX_AUDIO_CHAN_CNT; i++)
  7269. slot_mapping->offset[i] =
  7270. AFE_SLOT_MAPPING_OFFSET_INVALID;
  7271. slot_mapping->num_channel = rx_num;
  7272. break;
  7273. case AFE_PORT_ID_PRIMARY_TDM_TX:
  7274. case AFE_PORT_ID_PRIMARY_TDM_TX_1:
  7275. case AFE_PORT_ID_PRIMARY_TDM_TX_2:
  7276. case AFE_PORT_ID_PRIMARY_TDM_TX_3:
  7277. case AFE_PORT_ID_PRIMARY_TDM_TX_4:
  7278. case AFE_PORT_ID_PRIMARY_TDM_TX_5:
  7279. case AFE_PORT_ID_PRIMARY_TDM_TX_6:
  7280. case AFE_PORT_ID_PRIMARY_TDM_TX_7:
  7281. case AFE_PORT_ID_SECONDARY_TDM_TX:
  7282. case AFE_PORT_ID_SECONDARY_TDM_TX_1:
  7283. case AFE_PORT_ID_SECONDARY_TDM_TX_2:
  7284. case AFE_PORT_ID_SECONDARY_TDM_TX_3:
  7285. case AFE_PORT_ID_SECONDARY_TDM_TX_4:
  7286. case AFE_PORT_ID_SECONDARY_TDM_TX_5:
  7287. case AFE_PORT_ID_SECONDARY_TDM_TX_6:
  7288. case AFE_PORT_ID_SECONDARY_TDM_TX_7:
  7289. case AFE_PORT_ID_TERTIARY_TDM_TX:
  7290. case AFE_PORT_ID_TERTIARY_TDM_TX_1:
  7291. case AFE_PORT_ID_TERTIARY_TDM_TX_2:
  7292. case AFE_PORT_ID_TERTIARY_TDM_TX_3:
  7293. case AFE_PORT_ID_TERTIARY_TDM_TX_4:
  7294. case AFE_PORT_ID_TERTIARY_TDM_TX_5:
  7295. case AFE_PORT_ID_TERTIARY_TDM_TX_6:
  7296. case AFE_PORT_ID_TERTIARY_TDM_TX_7:
  7297. case AFE_PORT_ID_QUATERNARY_TDM_TX:
  7298. case AFE_PORT_ID_QUATERNARY_TDM_TX_1:
  7299. case AFE_PORT_ID_QUATERNARY_TDM_TX_2:
  7300. case AFE_PORT_ID_QUATERNARY_TDM_TX_3:
  7301. case AFE_PORT_ID_QUATERNARY_TDM_TX_4:
  7302. case AFE_PORT_ID_QUATERNARY_TDM_TX_5:
  7303. case AFE_PORT_ID_QUATERNARY_TDM_TX_6:
  7304. case AFE_PORT_ID_QUATERNARY_TDM_TX_7:
  7305. case AFE_PORT_ID_QUINARY_TDM_TX:
  7306. case AFE_PORT_ID_QUINARY_TDM_TX_1:
  7307. case AFE_PORT_ID_QUINARY_TDM_TX_2:
  7308. case AFE_PORT_ID_QUINARY_TDM_TX_3:
  7309. case AFE_PORT_ID_QUINARY_TDM_TX_4:
  7310. case AFE_PORT_ID_QUINARY_TDM_TX_5:
  7311. case AFE_PORT_ID_QUINARY_TDM_TX_6:
  7312. case AFE_PORT_ID_QUINARY_TDM_TX_7:
  7313. if (!tx_slot) {
  7314. dev_err(dai->dev, "%s: tx slot not found\n", __func__);
  7315. return -EINVAL;
  7316. }
  7317. if (tx_num > AFE_PORT_MAX_AUDIO_CHAN_CNT) {
  7318. dev_err(dai->dev, "%s: invalid tx num %d\n", __func__,
  7319. tx_num);
  7320. return -EINVAL;
  7321. }
  7322. for (i = 0; i < tx_num; i++)
  7323. slot_mapping->offset[i] = tx_slot[i];
  7324. for (i = tx_num; i < AFE_PORT_MAX_AUDIO_CHAN_CNT; i++)
  7325. slot_mapping->offset[i] =
  7326. AFE_SLOT_MAPPING_OFFSET_INVALID;
  7327. slot_mapping->num_channel = tx_num;
  7328. break;
  7329. default:
  7330. dev_err(dai->dev, "%s: invalid dai id 0x%x\n",
  7331. __func__, dai->id);
  7332. return -EINVAL;
  7333. }
  7334. return rc;
  7335. }
  7336. static int msm_dai_q6_tdm_hw_params(struct snd_pcm_substream *substream,
  7337. struct snd_pcm_hw_params *params,
  7338. struct snd_soc_dai *dai)
  7339. {
  7340. struct msm_dai_q6_tdm_dai_data *dai_data =
  7341. dev_get_drvdata(dai->dev);
  7342. struct afe_param_id_group_device_tdm_cfg *tdm_group =
  7343. &dai_data->group_cfg.tdm_cfg;
  7344. struct afe_param_id_tdm_cfg *tdm =
  7345. &dai_data->port_cfg.tdm;
  7346. struct afe_param_id_slot_mapping_cfg *slot_mapping =
  7347. &dai_data->port_cfg.slot_mapping;
  7348. struct afe_param_id_custom_tdm_header_cfg *custom_tdm_header =
  7349. &dai_data->port_cfg.custom_tdm_header;
  7350. pr_debug("%s: dev_name: %s\n",
  7351. __func__, dev_name(dai->dev));
  7352. if ((params_channels(params) == 0) ||
  7353. (params_channels(params) > 8)) {
  7354. dev_err(dai->dev, "%s: invalid param channels %d\n",
  7355. __func__, params_channels(params));
  7356. return -EINVAL;
  7357. }
  7358. switch (params_format(params)) {
  7359. case SNDRV_PCM_FORMAT_S16_LE:
  7360. dai_data->bitwidth = 16;
  7361. break;
  7362. case SNDRV_PCM_FORMAT_S24_LE:
  7363. case SNDRV_PCM_FORMAT_S24_3LE:
  7364. dai_data->bitwidth = 24;
  7365. break;
  7366. case SNDRV_PCM_FORMAT_S32_LE:
  7367. dai_data->bitwidth = 32;
  7368. break;
  7369. default:
  7370. dev_err(dai->dev, "%s: invalid param format 0x%x\n",
  7371. __func__, params_format(params));
  7372. return -EINVAL;
  7373. }
  7374. dai_data->channels = params_channels(params);
  7375. dai_data->rate = params_rate(params);
  7376. /*
  7377. * update tdm group config param
  7378. * NOTE: group config is set to the same as slot config.
  7379. */
  7380. tdm_group->bit_width = tdm_group->slot_width;
  7381. tdm_group->num_channels = tdm_group->nslots_per_frame;
  7382. tdm_group->sample_rate = dai_data->rate;
  7383. pr_debug("%s: TDM GROUP:\n"
  7384. "num_channels=%d sample_rate=%d bit_width=%d\n"
  7385. "nslots_per_frame=%d slot_width=%d slot_mask=0x%x\n",
  7386. __func__,
  7387. tdm_group->num_channels,
  7388. tdm_group->sample_rate,
  7389. tdm_group->bit_width,
  7390. tdm_group->nslots_per_frame,
  7391. tdm_group->slot_width,
  7392. tdm_group->slot_mask);
  7393. pr_debug("%s: TDM GROUP:\n"
  7394. "port_id[0]=0x%x port_id[1]=0x%x port_id[2]=0x%x port_id[3]=0x%x\n"
  7395. "port_id[4]=0x%x port_id[5]=0x%x port_id[6]=0x%x port_id[7]=0x%x\n",
  7396. __func__,
  7397. tdm_group->port_id[0],
  7398. tdm_group->port_id[1],
  7399. tdm_group->port_id[2],
  7400. tdm_group->port_id[3],
  7401. tdm_group->port_id[4],
  7402. tdm_group->port_id[5],
  7403. tdm_group->port_id[6],
  7404. tdm_group->port_id[7]);
  7405. /*
  7406. * update tdm config param
  7407. * NOTE: channels/rate/bitwidth are per stream property
  7408. */
  7409. tdm->num_channels = dai_data->channels;
  7410. tdm->sample_rate = dai_data->rate;
  7411. tdm->bit_width = dai_data->bitwidth;
  7412. /*
  7413. * port slot config is the same as group slot config
  7414. * port slot mask should be set according to offset
  7415. */
  7416. tdm->nslots_per_frame = tdm_group->nslots_per_frame;
  7417. tdm->slot_width = tdm_group->slot_width;
  7418. tdm->slot_mask = tdm_group->slot_mask;
  7419. pr_debug("%s: TDM:\n"
  7420. "num_channels=%d sample_rate=%d bit_width=%d\n"
  7421. "nslots_per_frame=%d slot_width=%d slot_mask=0x%x\n"
  7422. "data_format=0x%x sync_mode=0x%x sync_src=0x%x\n"
  7423. "data_out=0x%x invert_sync=0x%x data_delay=0x%x\n",
  7424. __func__,
  7425. tdm->num_channels,
  7426. tdm->sample_rate,
  7427. tdm->bit_width,
  7428. tdm->nslots_per_frame,
  7429. tdm->slot_width,
  7430. tdm->slot_mask,
  7431. tdm->data_format,
  7432. tdm->sync_mode,
  7433. tdm->sync_src,
  7434. tdm->ctrl_data_out_enable,
  7435. tdm->ctrl_invert_sync_pulse,
  7436. tdm->ctrl_sync_data_delay);
  7437. /*
  7438. * update slot mapping config param
  7439. * NOTE: channels/rate/bitwidth are per stream property
  7440. */
  7441. slot_mapping->bitwidth = dai_data->bitwidth;
  7442. pr_debug("%s: SLOT MAPPING:\n"
  7443. "num_channel=%d bitwidth=%d data_align=0x%x\n",
  7444. __func__,
  7445. slot_mapping->num_channel,
  7446. slot_mapping->bitwidth,
  7447. slot_mapping->data_align_type);
  7448. pr_debug("%s: SLOT MAPPING:\n"
  7449. "offset[0]=0x%x offset[1]=0x%x offset[2]=0x%x offset[3]=0x%x\n"
  7450. "offset[4]=0x%x offset[5]=0x%x offset[6]=0x%x offset[7]=0x%x\n",
  7451. __func__,
  7452. slot_mapping->offset[0],
  7453. slot_mapping->offset[1],
  7454. slot_mapping->offset[2],
  7455. slot_mapping->offset[3],
  7456. slot_mapping->offset[4],
  7457. slot_mapping->offset[5],
  7458. slot_mapping->offset[6],
  7459. slot_mapping->offset[7]);
  7460. /*
  7461. * update custom header config param
  7462. * NOTE: channels/rate/bitwidth are per playback stream property.
  7463. * custom tdm header only applicable to playback stream.
  7464. */
  7465. if (custom_tdm_header->header_type !=
  7466. AFE_CUSTOM_TDM_HEADER_TYPE_INVALID) {
  7467. pr_debug("%s: CUSTOM TDM HEADER:\n"
  7468. "start_offset=0x%x header_width=%d\n"
  7469. "num_frame_repeat=%d header_type=0x%x\n",
  7470. __func__,
  7471. custom_tdm_header->start_offset,
  7472. custom_tdm_header->header_width,
  7473. custom_tdm_header->num_frame_repeat,
  7474. custom_tdm_header->header_type);
  7475. pr_debug("%s: CUSTOM TDM HEADER:\n"
  7476. "header[0]=0x%x header[1]=0x%x header[2]=0x%x header[3]=0x%x\n"
  7477. "header[4]=0x%x header[5]=0x%x header[6]=0x%x header[7]=0x%x\n",
  7478. __func__,
  7479. custom_tdm_header->header[0],
  7480. custom_tdm_header->header[1],
  7481. custom_tdm_header->header[2],
  7482. custom_tdm_header->header[3],
  7483. custom_tdm_header->header[4],
  7484. custom_tdm_header->header[5],
  7485. custom_tdm_header->header[6],
  7486. custom_tdm_header->header[7]);
  7487. }
  7488. return 0;
  7489. }
  7490. static int msm_dai_q6_tdm_prepare(struct snd_pcm_substream *substream,
  7491. struct snd_soc_dai *dai)
  7492. {
  7493. int rc = 0;
  7494. struct msm_dai_q6_tdm_dai_data *dai_data =
  7495. dev_get_drvdata(dai->dev);
  7496. u16 group_id = dai_data->group_cfg.tdm_cfg.group_id;
  7497. int group_idx = 0;
  7498. atomic_t *group_ref = NULL;
  7499. dev_dbg(dai->dev, "%s: dev_name: %s dev_id: 0x%x group_id: 0x%x\n",
  7500. __func__, dev_name(dai->dev), dai->dev->id, group_id);
  7501. if (dai_data->port_cfg.custom_tdm_header.minor_version == 0)
  7502. dev_dbg(dai->dev,
  7503. "%s: Custom tdm header not supported\n", __func__);
  7504. group_idx = msm_dai_q6_get_group_idx(dai->id);
  7505. if (group_idx < 0) {
  7506. dev_err(dai->dev, "%s port id 0x%x not supported\n",
  7507. __func__, dai->id);
  7508. return -EINVAL;
  7509. }
  7510. mutex_lock(&tdm_mutex);
  7511. group_ref = &tdm_group_ref[group_idx];
  7512. if (!test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  7513. if (q6core_get_avcs_api_version_per_service(
  7514. APRV2_IDS_SERVICE_ID_ADSP_AFE_V) >= AFE_API_VERSION_V4) {
  7515. /*
  7516. * send island mode config.
  7517. * This should be the first configuration
  7518. */
  7519. rc = afe_send_port_island_mode(dai->id);
  7520. if (rc)
  7521. dev_err(dai->dev, "%s: afe send island mode failed %d\n",
  7522. __func__, rc);
  7523. }
  7524. if (msm_dai_q6_get_tdm_clk_ref(group_idx) == 0) {
  7525. /* TX and RX share the same clk. So enable the clk
  7526. * per TDM interface. */
  7527. rc = msm_dai_q6_tdm_set_clk(dai_data,
  7528. dai->id, true);
  7529. if (rc < 0) {
  7530. dev_err(dai->dev, "%s: fail to enable AFE clk 0x%x\n",
  7531. __func__, dai->id);
  7532. goto rtn;
  7533. }
  7534. }
  7535. /* PORT START should be set if prepare called
  7536. * in active state.
  7537. */
  7538. if (atomic_read(group_ref) == 0) {
  7539. /*
  7540. * if only one port, don't do group enable as there
  7541. * is no group need for only one port
  7542. */
  7543. if (dai_data->num_group_ports > 1) {
  7544. rc = afe_port_group_enable(group_id,
  7545. &dai_data->group_cfg, true);
  7546. if (rc < 0) {
  7547. dev_err(dai->dev,
  7548. "%s: fail to enable AFE group 0x%x\n",
  7549. __func__, group_id);
  7550. goto rtn;
  7551. }
  7552. }
  7553. }
  7554. rc = afe_tdm_port_start(dai->id, &dai_data->port_cfg,
  7555. dai_data->rate, dai_data->num_group_ports);
  7556. if (rc < 0) {
  7557. if (atomic_read(group_ref) == 0) {
  7558. afe_port_group_enable(group_id,
  7559. NULL, false);
  7560. }
  7561. if (msm_dai_q6_get_tdm_clk_ref(group_idx) == 0) {
  7562. msm_dai_q6_tdm_set_clk(dai_data,
  7563. dai->id, false);
  7564. }
  7565. dev_err(dai->dev, "%s: fail to open AFE port 0x%x\n",
  7566. __func__, dai->id);
  7567. } else {
  7568. set_bit(STATUS_PORT_STARTED,
  7569. dai_data->status_mask);
  7570. atomic_inc(group_ref);
  7571. }
  7572. /* TODO: need to monitor PCM/MI2S/TDM HW status */
  7573. /* NOTE: AFE should error out if HW resource contention */
  7574. }
  7575. rtn:
  7576. mutex_unlock(&tdm_mutex);
  7577. return rc;
  7578. }
  7579. static void msm_dai_q6_tdm_shutdown(struct snd_pcm_substream *substream,
  7580. struct snd_soc_dai *dai)
  7581. {
  7582. int rc = 0;
  7583. struct msm_dai_q6_tdm_dai_data *dai_data =
  7584. dev_get_drvdata(dai->dev);
  7585. u16 group_id = dai_data->group_cfg.tdm_cfg.group_id;
  7586. int group_idx = 0;
  7587. atomic_t *group_ref = NULL;
  7588. group_idx = msm_dai_q6_get_group_idx(dai->id);
  7589. if (group_idx < 0) {
  7590. dev_err(dai->dev, "%s port id 0x%x not supported\n",
  7591. __func__, dai->id);
  7592. return;
  7593. }
  7594. mutex_lock(&tdm_mutex);
  7595. group_ref = &tdm_group_ref[group_idx];
  7596. if (test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  7597. rc = afe_close(dai->id);
  7598. if (rc < 0) {
  7599. dev_err(dai->dev, "%s: fail to close AFE port 0x%x\n",
  7600. __func__, dai->id);
  7601. }
  7602. atomic_dec(group_ref);
  7603. clear_bit(STATUS_PORT_STARTED,
  7604. dai_data->status_mask);
  7605. if (atomic_read(group_ref) == 0) {
  7606. rc = afe_port_group_enable(group_id,
  7607. NULL, false);
  7608. if (rc < 0) {
  7609. dev_err(dai->dev, "%s: fail to disable AFE group 0x%x\n",
  7610. __func__, group_id);
  7611. }
  7612. }
  7613. if (msm_dai_q6_get_tdm_clk_ref(group_idx) == 0) {
  7614. rc = msm_dai_q6_tdm_set_clk(dai_data,
  7615. dai->id, false);
  7616. if (rc < 0) {
  7617. dev_err(dai->dev, "%s: fail to disable AFE clk 0x%x\n",
  7618. __func__, dai->id);
  7619. }
  7620. }
  7621. /* TODO: need to monitor PCM/MI2S/TDM HW status */
  7622. /* NOTE: AFE should error out if HW resource contention */
  7623. }
  7624. mutex_unlock(&tdm_mutex);
  7625. }
  7626. static struct snd_soc_dai_ops msm_dai_q6_tdm_ops = {
  7627. .prepare = msm_dai_q6_tdm_prepare,
  7628. .hw_params = msm_dai_q6_tdm_hw_params,
  7629. .set_tdm_slot = msm_dai_q6_tdm_set_tdm_slot,
  7630. .set_channel_map = msm_dai_q6_tdm_set_channel_map,
  7631. .set_sysclk = msm_dai_q6_tdm_set_sysclk,
  7632. .shutdown = msm_dai_q6_tdm_shutdown,
  7633. };
  7634. static struct snd_soc_dai_driver msm_dai_q6_tdm_dai[] = {
  7635. {
  7636. .playback = {
  7637. .stream_name = "Primary TDM0 Playback",
  7638. .aif_name = "PRI_TDM_RX_0",
  7639. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7640. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7641. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7642. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7643. SNDRV_PCM_FMTBIT_S24_LE |
  7644. SNDRV_PCM_FMTBIT_S32_LE,
  7645. .channels_min = 1,
  7646. .channels_max = 8,
  7647. .rate_min = 8000,
  7648. .rate_max = 352800,
  7649. },
  7650. .name = "PRI_TDM_RX_0",
  7651. .ops = &msm_dai_q6_tdm_ops,
  7652. .id = AFE_PORT_ID_PRIMARY_TDM_RX,
  7653. .probe = msm_dai_q6_dai_tdm_probe,
  7654. .remove = msm_dai_q6_dai_tdm_remove,
  7655. },
  7656. {
  7657. .playback = {
  7658. .stream_name = "Primary TDM1 Playback",
  7659. .aif_name = "PRI_TDM_RX_1",
  7660. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7661. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7662. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7663. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7664. SNDRV_PCM_FMTBIT_S24_LE |
  7665. SNDRV_PCM_FMTBIT_S32_LE,
  7666. .channels_min = 1,
  7667. .channels_max = 8,
  7668. .rate_min = 8000,
  7669. .rate_max = 352800,
  7670. },
  7671. .name = "PRI_TDM_RX_1",
  7672. .ops = &msm_dai_q6_tdm_ops,
  7673. .id = AFE_PORT_ID_PRIMARY_TDM_RX_1,
  7674. .probe = msm_dai_q6_dai_tdm_probe,
  7675. .remove = msm_dai_q6_dai_tdm_remove,
  7676. },
  7677. {
  7678. .playback = {
  7679. .stream_name = "Primary TDM2 Playback",
  7680. .aif_name = "PRI_TDM_RX_2",
  7681. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7682. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7683. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7684. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7685. SNDRV_PCM_FMTBIT_S24_LE |
  7686. SNDRV_PCM_FMTBIT_S32_LE,
  7687. .channels_min = 1,
  7688. .channels_max = 8,
  7689. .rate_min = 8000,
  7690. .rate_max = 352800,
  7691. },
  7692. .name = "PRI_TDM_RX_2",
  7693. .ops = &msm_dai_q6_tdm_ops,
  7694. .id = AFE_PORT_ID_PRIMARY_TDM_RX_2,
  7695. .probe = msm_dai_q6_dai_tdm_probe,
  7696. .remove = msm_dai_q6_dai_tdm_remove,
  7697. },
  7698. {
  7699. .playback = {
  7700. .stream_name = "Primary TDM3 Playback",
  7701. .aif_name = "PRI_TDM_RX_3",
  7702. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7703. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7704. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7705. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7706. SNDRV_PCM_FMTBIT_S24_LE |
  7707. SNDRV_PCM_FMTBIT_S32_LE,
  7708. .channels_min = 1,
  7709. .channels_max = 8,
  7710. .rate_min = 8000,
  7711. .rate_max = 352800,
  7712. },
  7713. .name = "PRI_TDM_RX_3",
  7714. .ops = &msm_dai_q6_tdm_ops,
  7715. .id = AFE_PORT_ID_PRIMARY_TDM_RX_3,
  7716. .probe = msm_dai_q6_dai_tdm_probe,
  7717. .remove = msm_dai_q6_dai_tdm_remove,
  7718. },
  7719. {
  7720. .playback = {
  7721. .stream_name = "Primary TDM4 Playback",
  7722. .aif_name = "PRI_TDM_RX_4",
  7723. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7724. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7725. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7726. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7727. SNDRV_PCM_FMTBIT_S24_LE |
  7728. SNDRV_PCM_FMTBIT_S32_LE,
  7729. .channels_min = 1,
  7730. .channels_max = 8,
  7731. .rate_min = 8000,
  7732. .rate_max = 352800,
  7733. },
  7734. .name = "PRI_TDM_RX_4",
  7735. .ops = &msm_dai_q6_tdm_ops,
  7736. .id = AFE_PORT_ID_PRIMARY_TDM_RX_4,
  7737. .probe = msm_dai_q6_dai_tdm_probe,
  7738. .remove = msm_dai_q6_dai_tdm_remove,
  7739. },
  7740. {
  7741. .playback = {
  7742. .stream_name = "Primary TDM5 Playback",
  7743. .aif_name = "PRI_TDM_RX_5",
  7744. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7745. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7746. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7747. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7748. SNDRV_PCM_FMTBIT_S24_LE |
  7749. SNDRV_PCM_FMTBIT_S32_LE,
  7750. .channels_min = 1,
  7751. .channels_max = 8,
  7752. .rate_min = 8000,
  7753. .rate_max = 352800,
  7754. },
  7755. .name = "PRI_TDM_RX_5",
  7756. .ops = &msm_dai_q6_tdm_ops,
  7757. .id = AFE_PORT_ID_PRIMARY_TDM_RX_5,
  7758. .probe = msm_dai_q6_dai_tdm_probe,
  7759. .remove = msm_dai_q6_dai_tdm_remove,
  7760. },
  7761. {
  7762. .playback = {
  7763. .stream_name = "Primary TDM6 Playback",
  7764. .aif_name = "PRI_TDM_RX_6",
  7765. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7766. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7767. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7768. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7769. SNDRV_PCM_FMTBIT_S24_LE |
  7770. SNDRV_PCM_FMTBIT_S32_LE,
  7771. .channels_min = 1,
  7772. .channels_max = 8,
  7773. .rate_min = 8000,
  7774. .rate_max = 352800,
  7775. },
  7776. .name = "PRI_TDM_RX_6",
  7777. .ops = &msm_dai_q6_tdm_ops,
  7778. .id = AFE_PORT_ID_PRIMARY_TDM_RX_6,
  7779. .probe = msm_dai_q6_dai_tdm_probe,
  7780. .remove = msm_dai_q6_dai_tdm_remove,
  7781. },
  7782. {
  7783. .playback = {
  7784. .stream_name = "Primary TDM7 Playback",
  7785. .aif_name = "PRI_TDM_RX_7",
  7786. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7787. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7788. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7789. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7790. SNDRV_PCM_FMTBIT_S24_LE |
  7791. SNDRV_PCM_FMTBIT_S32_LE,
  7792. .channels_min = 1,
  7793. .channels_max = 8,
  7794. .rate_min = 8000,
  7795. .rate_max = 352800,
  7796. },
  7797. .name = "PRI_TDM_RX_7",
  7798. .ops = &msm_dai_q6_tdm_ops,
  7799. .id = AFE_PORT_ID_PRIMARY_TDM_RX_7,
  7800. .probe = msm_dai_q6_dai_tdm_probe,
  7801. .remove = msm_dai_q6_dai_tdm_remove,
  7802. },
  7803. {
  7804. .capture = {
  7805. .stream_name = "Primary TDM0 Capture",
  7806. .aif_name = "PRI_TDM_TX_0",
  7807. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7808. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7809. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7810. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7811. SNDRV_PCM_FMTBIT_S24_LE |
  7812. SNDRV_PCM_FMTBIT_S32_LE,
  7813. .channels_min = 1,
  7814. .channels_max = 8,
  7815. .rate_min = 8000,
  7816. .rate_max = 352800,
  7817. },
  7818. .name = "PRI_TDM_TX_0",
  7819. .ops = &msm_dai_q6_tdm_ops,
  7820. .id = AFE_PORT_ID_PRIMARY_TDM_TX,
  7821. .probe = msm_dai_q6_dai_tdm_probe,
  7822. .remove = msm_dai_q6_dai_tdm_remove,
  7823. },
  7824. {
  7825. .capture = {
  7826. .stream_name = "Primary TDM1 Capture",
  7827. .aif_name = "PRI_TDM_TX_1",
  7828. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7829. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7830. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7831. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7832. SNDRV_PCM_FMTBIT_S24_LE |
  7833. SNDRV_PCM_FMTBIT_S32_LE,
  7834. .channels_min = 1,
  7835. .channels_max = 8,
  7836. .rate_min = 8000,
  7837. .rate_max = 352800,
  7838. },
  7839. .name = "PRI_TDM_TX_1",
  7840. .ops = &msm_dai_q6_tdm_ops,
  7841. .id = AFE_PORT_ID_PRIMARY_TDM_TX_1,
  7842. .probe = msm_dai_q6_dai_tdm_probe,
  7843. .remove = msm_dai_q6_dai_tdm_remove,
  7844. },
  7845. {
  7846. .capture = {
  7847. .stream_name = "Primary TDM2 Capture",
  7848. .aif_name = "PRI_TDM_TX_2",
  7849. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7850. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7851. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7852. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7853. SNDRV_PCM_FMTBIT_S24_LE |
  7854. SNDRV_PCM_FMTBIT_S32_LE,
  7855. .channels_min = 1,
  7856. .channels_max = 8,
  7857. .rate_min = 8000,
  7858. .rate_max = 352800,
  7859. },
  7860. .name = "PRI_TDM_TX_2",
  7861. .ops = &msm_dai_q6_tdm_ops,
  7862. .id = AFE_PORT_ID_PRIMARY_TDM_TX_2,
  7863. .probe = msm_dai_q6_dai_tdm_probe,
  7864. .remove = msm_dai_q6_dai_tdm_remove,
  7865. },
  7866. {
  7867. .capture = {
  7868. .stream_name = "Primary TDM3 Capture",
  7869. .aif_name = "PRI_TDM_TX_3",
  7870. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7871. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7872. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7873. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7874. SNDRV_PCM_FMTBIT_S24_LE |
  7875. SNDRV_PCM_FMTBIT_S32_LE,
  7876. .channels_min = 1,
  7877. .channels_max = 8,
  7878. .rate_min = 8000,
  7879. .rate_max = 352800,
  7880. },
  7881. .name = "PRI_TDM_TX_3",
  7882. .ops = &msm_dai_q6_tdm_ops,
  7883. .id = AFE_PORT_ID_PRIMARY_TDM_TX_3,
  7884. .probe = msm_dai_q6_dai_tdm_probe,
  7885. .remove = msm_dai_q6_dai_tdm_remove,
  7886. },
  7887. {
  7888. .capture = {
  7889. .stream_name = "Primary TDM4 Capture",
  7890. .aif_name = "PRI_TDM_TX_4",
  7891. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7892. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7893. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7894. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7895. SNDRV_PCM_FMTBIT_S24_LE |
  7896. SNDRV_PCM_FMTBIT_S32_LE,
  7897. .channels_min = 1,
  7898. .channels_max = 8,
  7899. .rate_min = 8000,
  7900. .rate_max = 352800,
  7901. },
  7902. .name = "PRI_TDM_TX_4",
  7903. .ops = &msm_dai_q6_tdm_ops,
  7904. .id = AFE_PORT_ID_PRIMARY_TDM_TX_4,
  7905. .probe = msm_dai_q6_dai_tdm_probe,
  7906. .remove = msm_dai_q6_dai_tdm_remove,
  7907. },
  7908. {
  7909. .capture = {
  7910. .stream_name = "Primary TDM5 Capture",
  7911. .aif_name = "PRI_TDM_TX_5",
  7912. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7913. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7914. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7915. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7916. SNDRV_PCM_FMTBIT_S24_LE |
  7917. SNDRV_PCM_FMTBIT_S32_LE,
  7918. .channels_min = 1,
  7919. .channels_max = 8,
  7920. .rate_min = 8000,
  7921. .rate_max = 352800,
  7922. },
  7923. .name = "PRI_TDM_TX_5",
  7924. .ops = &msm_dai_q6_tdm_ops,
  7925. .id = AFE_PORT_ID_PRIMARY_TDM_TX_5,
  7926. .probe = msm_dai_q6_dai_tdm_probe,
  7927. .remove = msm_dai_q6_dai_tdm_remove,
  7928. },
  7929. {
  7930. .capture = {
  7931. .stream_name = "Primary TDM6 Capture",
  7932. .aif_name = "PRI_TDM_TX_6",
  7933. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7934. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7935. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7936. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7937. SNDRV_PCM_FMTBIT_S24_LE |
  7938. SNDRV_PCM_FMTBIT_S32_LE,
  7939. .channels_min = 1,
  7940. .channels_max = 8,
  7941. .rate_min = 8000,
  7942. .rate_max = 352800,
  7943. },
  7944. .name = "PRI_TDM_TX_6",
  7945. .ops = &msm_dai_q6_tdm_ops,
  7946. .id = AFE_PORT_ID_PRIMARY_TDM_TX_6,
  7947. .probe = msm_dai_q6_dai_tdm_probe,
  7948. .remove = msm_dai_q6_dai_tdm_remove,
  7949. },
  7950. {
  7951. .capture = {
  7952. .stream_name = "Primary TDM7 Capture",
  7953. .aif_name = "PRI_TDM_TX_7",
  7954. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7955. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7956. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7957. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7958. SNDRV_PCM_FMTBIT_S24_LE |
  7959. SNDRV_PCM_FMTBIT_S32_LE,
  7960. .channels_min = 1,
  7961. .channels_max = 8,
  7962. .rate_min = 8000,
  7963. .rate_max = 352800,
  7964. },
  7965. .name = "PRI_TDM_TX_7",
  7966. .ops = &msm_dai_q6_tdm_ops,
  7967. .id = AFE_PORT_ID_PRIMARY_TDM_TX_7,
  7968. .probe = msm_dai_q6_dai_tdm_probe,
  7969. .remove = msm_dai_q6_dai_tdm_remove,
  7970. },
  7971. {
  7972. .playback = {
  7973. .stream_name = "Secondary TDM0 Playback",
  7974. .aif_name = "SEC_TDM_RX_0",
  7975. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7976. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7977. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7978. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  7979. SNDRV_PCM_FMTBIT_S24_LE |
  7980. SNDRV_PCM_FMTBIT_S32_LE,
  7981. .channels_min = 1,
  7982. .channels_max = 8,
  7983. .rate_min = 8000,
  7984. .rate_max = 352800,
  7985. },
  7986. .name = "SEC_TDM_RX_0",
  7987. .ops = &msm_dai_q6_tdm_ops,
  7988. .id = AFE_PORT_ID_SECONDARY_TDM_RX,
  7989. .probe = msm_dai_q6_dai_tdm_probe,
  7990. .remove = msm_dai_q6_dai_tdm_remove,
  7991. },
  7992. {
  7993. .playback = {
  7994. .stream_name = "Secondary TDM1 Playback",
  7995. .aif_name = "SEC_TDM_RX_1",
  7996. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  7997. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  7998. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  7999. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8000. SNDRV_PCM_FMTBIT_S24_LE |
  8001. SNDRV_PCM_FMTBIT_S32_LE,
  8002. .channels_min = 1,
  8003. .channels_max = 8,
  8004. .rate_min = 8000,
  8005. .rate_max = 352800,
  8006. },
  8007. .name = "SEC_TDM_RX_1",
  8008. .ops = &msm_dai_q6_tdm_ops,
  8009. .id = AFE_PORT_ID_SECONDARY_TDM_RX_1,
  8010. .probe = msm_dai_q6_dai_tdm_probe,
  8011. .remove = msm_dai_q6_dai_tdm_remove,
  8012. },
  8013. {
  8014. .playback = {
  8015. .stream_name = "Secondary TDM2 Playback",
  8016. .aif_name = "SEC_TDM_RX_2",
  8017. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8018. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8019. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8020. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8021. SNDRV_PCM_FMTBIT_S24_LE |
  8022. SNDRV_PCM_FMTBIT_S32_LE,
  8023. .channels_min = 1,
  8024. .channels_max = 8,
  8025. .rate_min = 8000,
  8026. .rate_max = 352800,
  8027. },
  8028. .name = "SEC_TDM_RX_2",
  8029. .ops = &msm_dai_q6_tdm_ops,
  8030. .id = AFE_PORT_ID_SECONDARY_TDM_RX_2,
  8031. .probe = msm_dai_q6_dai_tdm_probe,
  8032. .remove = msm_dai_q6_dai_tdm_remove,
  8033. },
  8034. {
  8035. .playback = {
  8036. .stream_name = "Secondary TDM3 Playback",
  8037. .aif_name = "SEC_TDM_RX_3",
  8038. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8039. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8040. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8041. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8042. SNDRV_PCM_FMTBIT_S24_LE |
  8043. SNDRV_PCM_FMTBIT_S32_LE,
  8044. .channels_min = 1,
  8045. .channels_max = 8,
  8046. .rate_min = 8000,
  8047. .rate_max = 352800,
  8048. },
  8049. .name = "SEC_TDM_RX_3",
  8050. .ops = &msm_dai_q6_tdm_ops,
  8051. .id = AFE_PORT_ID_SECONDARY_TDM_RX_3,
  8052. .probe = msm_dai_q6_dai_tdm_probe,
  8053. .remove = msm_dai_q6_dai_tdm_remove,
  8054. },
  8055. {
  8056. .playback = {
  8057. .stream_name = "Secondary TDM4 Playback",
  8058. .aif_name = "SEC_TDM_RX_4",
  8059. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8060. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8061. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8062. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8063. SNDRV_PCM_FMTBIT_S24_LE |
  8064. SNDRV_PCM_FMTBIT_S32_LE,
  8065. .channels_min = 1,
  8066. .channels_max = 8,
  8067. .rate_min = 8000,
  8068. .rate_max = 352800,
  8069. },
  8070. .name = "SEC_TDM_RX_4",
  8071. .ops = &msm_dai_q6_tdm_ops,
  8072. .id = AFE_PORT_ID_SECONDARY_TDM_RX_4,
  8073. .probe = msm_dai_q6_dai_tdm_probe,
  8074. .remove = msm_dai_q6_dai_tdm_remove,
  8075. },
  8076. {
  8077. .playback = {
  8078. .stream_name = "Secondary TDM5 Playback",
  8079. .aif_name = "SEC_TDM_RX_5",
  8080. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8081. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8082. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8083. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8084. SNDRV_PCM_FMTBIT_S24_LE |
  8085. SNDRV_PCM_FMTBIT_S32_LE,
  8086. .channels_min = 1,
  8087. .channels_max = 8,
  8088. .rate_min = 8000,
  8089. .rate_max = 352800,
  8090. },
  8091. .name = "SEC_TDM_RX_5",
  8092. .ops = &msm_dai_q6_tdm_ops,
  8093. .id = AFE_PORT_ID_SECONDARY_TDM_RX_5,
  8094. .probe = msm_dai_q6_dai_tdm_probe,
  8095. .remove = msm_dai_q6_dai_tdm_remove,
  8096. },
  8097. {
  8098. .playback = {
  8099. .stream_name = "Secondary TDM6 Playback",
  8100. .aif_name = "SEC_TDM_RX_6",
  8101. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8102. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8103. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8104. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8105. SNDRV_PCM_FMTBIT_S24_LE |
  8106. SNDRV_PCM_FMTBIT_S32_LE,
  8107. .channels_min = 1,
  8108. .channels_max = 8,
  8109. .rate_min = 8000,
  8110. .rate_max = 352800,
  8111. },
  8112. .name = "SEC_TDM_RX_6",
  8113. .ops = &msm_dai_q6_tdm_ops,
  8114. .id = AFE_PORT_ID_SECONDARY_TDM_RX_6,
  8115. .probe = msm_dai_q6_dai_tdm_probe,
  8116. .remove = msm_dai_q6_dai_tdm_remove,
  8117. },
  8118. {
  8119. .playback = {
  8120. .stream_name = "Secondary TDM7 Playback",
  8121. .aif_name = "SEC_TDM_RX_7",
  8122. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8123. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8124. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8125. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8126. SNDRV_PCM_FMTBIT_S24_LE |
  8127. SNDRV_PCM_FMTBIT_S32_LE,
  8128. .channels_min = 1,
  8129. .channels_max = 8,
  8130. .rate_min = 8000,
  8131. .rate_max = 352800,
  8132. },
  8133. .name = "SEC_TDM_RX_7",
  8134. .ops = &msm_dai_q6_tdm_ops,
  8135. .id = AFE_PORT_ID_SECONDARY_TDM_RX_7,
  8136. .probe = msm_dai_q6_dai_tdm_probe,
  8137. .remove = msm_dai_q6_dai_tdm_remove,
  8138. },
  8139. {
  8140. .capture = {
  8141. .stream_name = "Secondary TDM0 Capture",
  8142. .aif_name = "SEC_TDM_TX_0",
  8143. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8144. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8145. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8146. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8147. SNDRV_PCM_FMTBIT_S24_LE |
  8148. SNDRV_PCM_FMTBIT_S32_LE,
  8149. .channels_min = 1,
  8150. .channels_max = 8,
  8151. .rate_min = 8000,
  8152. .rate_max = 352800,
  8153. },
  8154. .name = "SEC_TDM_TX_0",
  8155. .ops = &msm_dai_q6_tdm_ops,
  8156. .id = AFE_PORT_ID_SECONDARY_TDM_TX,
  8157. .probe = msm_dai_q6_dai_tdm_probe,
  8158. .remove = msm_dai_q6_dai_tdm_remove,
  8159. },
  8160. {
  8161. .capture = {
  8162. .stream_name = "Secondary TDM1 Capture",
  8163. .aif_name = "SEC_TDM_TX_1",
  8164. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8165. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8166. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8167. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8168. SNDRV_PCM_FMTBIT_S24_LE |
  8169. SNDRV_PCM_FMTBIT_S32_LE,
  8170. .channels_min = 1,
  8171. .channels_max = 8,
  8172. .rate_min = 8000,
  8173. .rate_max = 352800,
  8174. },
  8175. .name = "SEC_TDM_TX_1",
  8176. .ops = &msm_dai_q6_tdm_ops,
  8177. .id = AFE_PORT_ID_SECONDARY_TDM_TX_1,
  8178. .probe = msm_dai_q6_dai_tdm_probe,
  8179. .remove = msm_dai_q6_dai_tdm_remove,
  8180. },
  8181. {
  8182. .capture = {
  8183. .stream_name = "Secondary TDM2 Capture",
  8184. .aif_name = "SEC_TDM_TX_2",
  8185. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8186. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8187. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8188. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8189. SNDRV_PCM_FMTBIT_S24_LE |
  8190. SNDRV_PCM_FMTBIT_S32_LE,
  8191. .channels_min = 1,
  8192. .channels_max = 8,
  8193. .rate_min = 8000,
  8194. .rate_max = 352800,
  8195. },
  8196. .name = "SEC_TDM_TX_2",
  8197. .ops = &msm_dai_q6_tdm_ops,
  8198. .id = AFE_PORT_ID_SECONDARY_TDM_TX_2,
  8199. .probe = msm_dai_q6_dai_tdm_probe,
  8200. .remove = msm_dai_q6_dai_tdm_remove,
  8201. },
  8202. {
  8203. .capture = {
  8204. .stream_name = "Secondary TDM3 Capture",
  8205. .aif_name = "SEC_TDM_TX_3",
  8206. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8207. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8208. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8209. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8210. SNDRV_PCM_FMTBIT_S24_LE |
  8211. SNDRV_PCM_FMTBIT_S32_LE,
  8212. .channels_min = 1,
  8213. .channels_max = 8,
  8214. .rate_min = 8000,
  8215. .rate_max = 352800,
  8216. },
  8217. .name = "SEC_TDM_TX_3",
  8218. .ops = &msm_dai_q6_tdm_ops,
  8219. .id = AFE_PORT_ID_SECONDARY_TDM_TX_3,
  8220. .probe = msm_dai_q6_dai_tdm_probe,
  8221. .remove = msm_dai_q6_dai_tdm_remove,
  8222. },
  8223. {
  8224. .capture = {
  8225. .stream_name = "Secondary TDM4 Capture",
  8226. .aif_name = "SEC_TDM_TX_4",
  8227. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8228. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8229. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8230. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8231. SNDRV_PCM_FMTBIT_S24_LE |
  8232. SNDRV_PCM_FMTBIT_S32_LE,
  8233. .channels_min = 1,
  8234. .channels_max = 8,
  8235. .rate_min = 8000,
  8236. .rate_max = 352800,
  8237. },
  8238. .name = "SEC_TDM_TX_4",
  8239. .ops = &msm_dai_q6_tdm_ops,
  8240. .id = AFE_PORT_ID_SECONDARY_TDM_TX_4,
  8241. .probe = msm_dai_q6_dai_tdm_probe,
  8242. .remove = msm_dai_q6_dai_tdm_remove,
  8243. },
  8244. {
  8245. .capture = {
  8246. .stream_name = "Secondary TDM5 Capture",
  8247. .aif_name = "SEC_TDM_TX_5",
  8248. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8249. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8250. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8251. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8252. SNDRV_PCM_FMTBIT_S24_LE |
  8253. SNDRV_PCM_FMTBIT_S32_LE,
  8254. .channels_min = 1,
  8255. .channels_max = 8,
  8256. .rate_min = 8000,
  8257. .rate_max = 352800,
  8258. },
  8259. .name = "SEC_TDM_TX_5",
  8260. .ops = &msm_dai_q6_tdm_ops,
  8261. .id = AFE_PORT_ID_SECONDARY_TDM_TX_5,
  8262. .probe = msm_dai_q6_dai_tdm_probe,
  8263. .remove = msm_dai_q6_dai_tdm_remove,
  8264. },
  8265. {
  8266. .capture = {
  8267. .stream_name = "Secondary TDM6 Capture",
  8268. .aif_name = "SEC_TDM_TX_6",
  8269. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8270. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8271. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8272. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8273. SNDRV_PCM_FMTBIT_S24_LE |
  8274. SNDRV_PCM_FMTBIT_S32_LE,
  8275. .channels_min = 1,
  8276. .channels_max = 8,
  8277. .rate_min = 8000,
  8278. .rate_max = 352800,
  8279. },
  8280. .name = "SEC_TDM_TX_6",
  8281. .ops = &msm_dai_q6_tdm_ops,
  8282. .id = AFE_PORT_ID_SECONDARY_TDM_TX_6,
  8283. .probe = msm_dai_q6_dai_tdm_probe,
  8284. .remove = msm_dai_q6_dai_tdm_remove,
  8285. },
  8286. {
  8287. .capture = {
  8288. .stream_name = "Secondary TDM7 Capture",
  8289. .aif_name = "SEC_TDM_TX_7",
  8290. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8291. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8292. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8293. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8294. SNDRV_PCM_FMTBIT_S24_LE |
  8295. SNDRV_PCM_FMTBIT_S32_LE,
  8296. .channels_min = 1,
  8297. .channels_max = 8,
  8298. .rate_min = 8000,
  8299. .rate_max = 352800,
  8300. },
  8301. .name = "SEC_TDM_TX_7",
  8302. .ops = &msm_dai_q6_tdm_ops,
  8303. .id = AFE_PORT_ID_SECONDARY_TDM_TX_7,
  8304. .probe = msm_dai_q6_dai_tdm_probe,
  8305. .remove = msm_dai_q6_dai_tdm_remove,
  8306. },
  8307. {
  8308. .playback = {
  8309. .stream_name = "Tertiary TDM0 Playback",
  8310. .aif_name = "TERT_TDM_RX_0",
  8311. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8312. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8313. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8314. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8315. SNDRV_PCM_FMTBIT_S24_LE |
  8316. SNDRV_PCM_FMTBIT_S32_LE,
  8317. .channels_min = 1,
  8318. .channels_max = 8,
  8319. .rate_min = 8000,
  8320. .rate_max = 352800,
  8321. },
  8322. .name = "TERT_TDM_RX_0",
  8323. .ops = &msm_dai_q6_tdm_ops,
  8324. .id = AFE_PORT_ID_TERTIARY_TDM_RX,
  8325. .probe = msm_dai_q6_dai_tdm_probe,
  8326. .remove = msm_dai_q6_dai_tdm_remove,
  8327. },
  8328. {
  8329. .playback = {
  8330. .stream_name = "Tertiary TDM1 Playback",
  8331. .aif_name = "TERT_TDM_RX_1",
  8332. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8333. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8334. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8335. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8336. SNDRV_PCM_FMTBIT_S24_LE |
  8337. SNDRV_PCM_FMTBIT_S32_LE,
  8338. .channels_min = 1,
  8339. .channels_max = 8,
  8340. .rate_min = 8000,
  8341. .rate_max = 352800,
  8342. },
  8343. .name = "TERT_TDM_RX_1",
  8344. .ops = &msm_dai_q6_tdm_ops,
  8345. .id = AFE_PORT_ID_TERTIARY_TDM_RX_1,
  8346. .probe = msm_dai_q6_dai_tdm_probe,
  8347. .remove = msm_dai_q6_dai_tdm_remove,
  8348. },
  8349. {
  8350. .playback = {
  8351. .stream_name = "Tertiary TDM2 Playback",
  8352. .aif_name = "TERT_TDM_RX_2",
  8353. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8354. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8355. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8356. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8357. SNDRV_PCM_FMTBIT_S24_LE |
  8358. SNDRV_PCM_FMTBIT_S32_LE,
  8359. .channels_min = 1,
  8360. .channels_max = 8,
  8361. .rate_min = 8000,
  8362. .rate_max = 352800,
  8363. },
  8364. .name = "TERT_TDM_RX_2",
  8365. .ops = &msm_dai_q6_tdm_ops,
  8366. .id = AFE_PORT_ID_TERTIARY_TDM_RX_2,
  8367. .probe = msm_dai_q6_dai_tdm_probe,
  8368. .remove = msm_dai_q6_dai_tdm_remove,
  8369. },
  8370. {
  8371. .playback = {
  8372. .stream_name = "Tertiary TDM3 Playback",
  8373. .aif_name = "TERT_TDM_RX_3",
  8374. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8375. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8376. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8377. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8378. SNDRV_PCM_FMTBIT_S24_LE |
  8379. SNDRV_PCM_FMTBIT_S32_LE,
  8380. .channels_min = 1,
  8381. .channels_max = 8,
  8382. .rate_min = 8000,
  8383. .rate_max = 352800,
  8384. },
  8385. .name = "TERT_TDM_RX_3",
  8386. .ops = &msm_dai_q6_tdm_ops,
  8387. .id = AFE_PORT_ID_TERTIARY_TDM_RX_3,
  8388. .probe = msm_dai_q6_dai_tdm_probe,
  8389. .remove = msm_dai_q6_dai_tdm_remove,
  8390. },
  8391. {
  8392. .playback = {
  8393. .stream_name = "Tertiary TDM4 Playback",
  8394. .aif_name = "TERT_TDM_RX_4",
  8395. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8396. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8397. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8398. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8399. SNDRV_PCM_FMTBIT_S24_LE |
  8400. SNDRV_PCM_FMTBIT_S32_LE,
  8401. .channels_min = 1,
  8402. .channels_max = 8,
  8403. .rate_min = 8000,
  8404. .rate_max = 352800,
  8405. },
  8406. .name = "TERT_TDM_RX_4",
  8407. .ops = &msm_dai_q6_tdm_ops,
  8408. .id = AFE_PORT_ID_TERTIARY_TDM_RX_4,
  8409. .probe = msm_dai_q6_dai_tdm_probe,
  8410. .remove = msm_dai_q6_dai_tdm_remove,
  8411. },
  8412. {
  8413. .playback = {
  8414. .stream_name = "Tertiary TDM5 Playback",
  8415. .aif_name = "TERT_TDM_RX_5",
  8416. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8417. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8418. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8419. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8420. SNDRV_PCM_FMTBIT_S24_LE |
  8421. SNDRV_PCM_FMTBIT_S32_LE,
  8422. .channels_min = 1,
  8423. .channels_max = 8,
  8424. .rate_min = 8000,
  8425. .rate_max = 352800,
  8426. },
  8427. .name = "TERT_TDM_RX_5",
  8428. .ops = &msm_dai_q6_tdm_ops,
  8429. .id = AFE_PORT_ID_TERTIARY_TDM_RX_5,
  8430. .probe = msm_dai_q6_dai_tdm_probe,
  8431. .remove = msm_dai_q6_dai_tdm_remove,
  8432. },
  8433. {
  8434. .playback = {
  8435. .stream_name = "Tertiary TDM6 Playback",
  8436. .aif_name = "TERT_TDM_RX_6",
  8437. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8438. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8439. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8440. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8441. SNDRV_PCM_FMTBIT_S24_LE |
  8442. SNDRV_PCM_FMTBIT_S32_LE,
  8443. .channels_min = 1,
  8444. .channels_max = 8,
  8445. .rate_min = 8000,
  8446. .rate_max = 352800,
  8447. },
  8448. .name = "TERT_TDM_RX_6",
  8449. .ops = &msm_dai_q6_tdm_ops,
  8450. .id = AFE_PORT_ID_TERTIARY_TDM_RX_6,
  8451. .probe = msm_dai_q6_dai_tdm_probe,
  8452. .remove = msm_dai_q6_dai_tdm_remove,
  8453. },
  8454. {
  8455. .playback = {
  8456. .stream_name = "Tertiary TDM7 Playback",
  8457. .aif_name = "TERT_TDM_RX_7",
  8458. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8459. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8460. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8461. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8462. SNDRV_PCM_FMTBIT_S24_LE |
  8463. SNDRV_PCM_FMTBIT_S32_LE,
  8464. .channels_min = 1,
  8465. .channels_max = 8,
  8466. .rate_min = 8000,
  8467. .rate_max = 352800,
  8468. },
  8469. .name = "TERT_TDM_RX_7",
  8470. .ops = &msm_dai_q6_tdm_ops,
  8471. .id = AFE_PORT_ID_TERTIARY_TDM_RX_7,
  8472. .probe = msm_dai_q6_dai_tdm_probe,
  8473. .remove = msm_dai_q6_dai_tdm_remove,
  8474. },
  8475. {
  8476. .capture = {
  8477. .stream_name = "Tertiary TDM0 Capture",
  8478. .aif_name = "TERT_TDM_TX_0",
  8479. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8480. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8481. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8482. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8483. SNDRV_PCM_FMTBIT_S24_LE |
  8484. SNDRV_PCM_FMTBIT_S32_LE,
  8485. .channels_min = 1,
  8486. .channels_max = 8,
  8487. .rate_min = 8000,
  8488. .rate_max = 352800,
  8489. },
  8490. .name = "TERT_TDM_TX_0",
  8491. .ops = &msm_dai_q6_tdm_ops,
  8492. .id = AFE_PORT_ID_TERTIARY_TDM_TX,
  8493. .probe = msm_dai_q6_dai_tdm_probe,
  8494. .remove = msm_dai_q6_dai_tdm_remove,
  8495. },
  8496. {
  8497. .capture = {
  8498. .stream_name = "Tertiary TDM1 Capture",
  8499. .aif_name = "TERT_TDM_TX_1",
  8500. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8501. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8502. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8503. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8504. SNDRV_PCM_FMTBIT_S24_LE |
  8505. SNDRV_PCM_FMTBIT_S32_LE,
  8506. .channels_min = 1,
  8507. .channels_max = 8,
  8508. .rate_min = 8000,
  8509. .rate_max = 352800,
  8510. },
  8511. .name = "TERT_TDM_TX_1",
  8512. .ops = &msm_dai_q6_tdm_ops,
  8513. .id = AFE_PORT_ID_TERTIARY_TDM_TX_1,
  8514. .probe = msm_dai_q6_dai_tdm_probe,
  8515. .remove = msm_dai_q6_dai_tdm_remove,
  8516. },
  8517. {
  8518. .capture = {
  8519. .stream_name = "Tertiary TDM2 Capture",
  8520. .aif_name = "TERT_TDM_TX_2",
  8521. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8522. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8523. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8524. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8525. SNDRV_PCM_FMTBIT_S24_LE |
  8526. SNDRV_PCM_FMTBIT_S32_LE,
  8527. .channels_min = 1,
  8528. .channels_max = 8,
  8529. .rate_min = 8000,
  8530. .rate_max = 352800,
  8531. },
  8532. .name = "TERT_TDM_TX_2",
  8533. .ops = &msm_dai_q6_tdm_ops,
  8534. .id = AFE_PORT_ID_TERTIARY_TDM_TX_2,
  8535. .probe = msm_dai_q6_dai_tdm_probe,
  8536. .remove = msm_dai_q6_dai_tdm_remove,
  8537. },
  8538. {
  8539. .capture = {
  8540. .stream_name = "Tertiary TDM3 Capture",
  8541. .aif_name = "TERT_TDM_TX_3",
  8542. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8543. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8544. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8545. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8546. SNDRV_PCM_FMTBIT_S24_LE |
  8547. SNDRV_PCM_FMTBIT_S32_LE,
  8548. .channels_min = 1,
  8549. .channels_max = 8,
  8550. .rate_min = 8000,
  8551. .rate_max = 352800,
  8552. },
  8553. .name = "TERT_TDM_TX_3",
  8554. .ops = &msm_dai_q6_tdm_ops,
  8555. .id = AFE_PORT_ID_TERTIARY_TDM_TX_3,
  8556. .probe = msm_dai_q6_dai_tdm_probe,
  8557. .remove = msm_dai_q6_dai_tdm_remove,
  8558. },
  8559. {
  8560. .capture = {
  8561. .stream_name = "Tertiary TDM4 Capture",
  8562. .aif_name = "TERT_TDM_TX_4",
  8563. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8564. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8565. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8566. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8567. SNDRV_PCM_FMTBIT_S24_LE |
  8568. SNDRV_PCM_FMTBIT_S32_LE,
  8569. .channels_min = 1,
  8570. .channels_max = 8,
  8571. .rate_min = 8000,
  8572. .rate_max = 352800,
  8573. },
  8574. .name = "TERT_TDM_TX_4",
  8575. .ops = &msm_dai_q6_tdm_ops,
  8576. .id = AFE_PORT_ID_TERTIARY_TDM_TX_4,
  8577. .probe = msm_dai_q6_dai_tdm_probe,
  8578. .remove = msm_dai_q6_dai_tdm_remove,
  8579. },
  8580. {
  8581. .capture = {
  8582. .stream_name = "Tertiary TDM5 Capture",
  8583. .aif_name = "TERT_TDM_TX_5",
  8584. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8585. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8586. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8587. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8588. SNDRV_PCM_FMTBIT_S24_LE |
  8589. SNDRV_PCM_FMTBIT_S32_LE,
  8590. .channels_min = 1,
  8591. .channels_max = 8,
  8592. .rate_min = 8000,
  8593. .rate_max = 352800,
  8594. },
  8595. .name = "TERT_TDM_TX_5",
  8596. .ops = &msm_dai_q6_tdm_ops,
  8597. .id = AFE_PORT_ID_TERTIARY_TDM_TX_5,
  8598. .probe = msm_dai_q6_dai_tdm_probe,
  8599. .remove = msm_dai_q6_dai_tdm_remove,
  8600. },
  8601. {
  8602. .capture = {
  8603. .stream_name = "Tertiary TDM6 Capture",
  8604. .aif_name = "TERT_TDM_TX_6",
  8605. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8606. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8607. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8608. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8609. SNDRV_PCM_FMTBIT_S24_LE |
  8610. SNDRV_PCM_FMTBIT_S32_LE,
  8611. .channels_min = 1,
  8612. .channels_max = 8,
  8613. .rate_min = 8000,
  8614. .rate_max = 352800,
  8615. },
  8616. .name = "TERT_TDM_TX_6",
  8617. .ops = &msm_dai_q6_tdm_ops,
  8618. .id = AFE_PORT_ID_TERTIARY_TDM_TX_6,
  8619. .probe = msm_dai_q6_dai_tdm_probe,
  8620. .remove = msm_dai_q6_dai_tdm_remove,
  8621. },
  8622. {
  8623. .capture = {
  8624. .stream_name = "Tertiary TDM7 Capture",
  8625. .aif_name = "TERT_TDM_TX_7",
  8626. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8627. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8628. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8629. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8630. SNDRV_PCM_FMTBIT_S24_LE |
  8631. SNDRV_PCM_FMTBIT_S32_LE,
  8632. .channels_min = 1,
  8633. .channels_max = 8,
  8634. .rate_min = 8000,
  8635. .rate_max = 352800,
  8636. },
  8637. .name = "TERT_TDM_TX_7",
  8638. .ops = &msm_dai_q6_tdm_ops,
  8639. .id = AFE_PORT_ID_TERTIARY_TDM_TX_7,
  8640. .probe = msm_dai_q6_dai_tdm_probe,
  8641. .remove = msm_dai_q6_dai_tdm_remove,
  8642. },
  8643. {
  8644. .playback = {
  8645. .stream_name = "Quaternary TDM0 Playback",
  8646. .aif_name = "QUAT_TDM_RX_0",
  8647. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  8648. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_48000 |
  8649. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8650. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8651. SNDRV_PCM_FMTBIT_S24_LE |
  8652. SNDRV_PCM_FMTBIT_S32_LE,
  8653. .channels_min = 1,
  8654. .channels_max = 8,
  8655. .rate_min = 8000,
  8656. .rate_max = 352800,
  8657. },
  8658. .name = "QUAT_TDM_RX_0",
  8659. .ops = &msm_dai_q6_tdm_ops,
  8660. .id = AFE_PORT_ID_QUATERNARY_TDM_RX,
  8661. .probe = msm_dai_q6_dai_tdm_probe,
  8662. .remove = msm_dai_q6_dai_tdm_remove,
  8663. },
  8664. {
  8665. .playback = {
  8666. .stream_name = "Quaternary TDM1 Playback",
  8667. .aif_name = "QUAT_TDM_RX_1",
  8668. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8669. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8670. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8671. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8672. SNDRV_PCM_FMTBIT_S24_LE |
  8673. SNDRV_PCM_FMTBIT_S32_LE,
  8674. .channels_min = 1,
  8675. .channels_max = 8,
  8676. .rate_min = 8000,
  8677. .rate_max = 352800,
  8678. },
  8679. .name = "QUAT_TDM_RX_1",
  8680. .ops = &msm_dai_q6_tdm_ops,
  8681. .id = AFE_PORT_ID_QUATERNARY_TDM_RX_1,
  8682. .probe = msm_dai_q6_dai_tdm_probe,
  8683. .remove = msm_dai_q6_dai_tdm_remove,
  8684. },
  8685. {
  8686. .playback = {
  8687. .stream_name = "Quaternary TDM2 Playback",
  8688. .aif_name = "QUAT_TDM_RX_2",
  8689. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8690. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8691. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8692. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8693. SNDRV_PCM_FMTBIT_S24_LE |
  8694. SNDRV_PCM_FMTBIT_S32_LE,
  8695. .channels_min = 1,
  8696. .channels_max = 8,
  8697. .rate_min = 8000,
  8698. .rate_max = 352800,
  8699. },
  8700. .name = "QUAT_TDM_RX_2",
  8701. .ops = &msm_dai_q6_tdm_ops,
  8702. .id = AFE_PORT_ID_QUATERNARY_TDM_RX_2,
  8703. .probe = msm_dai_q6_dai_tdm_probe,
  8704. .remove = msm_dai_q6_dai_tdm_remove,
  8705. },
  8706. {
  8707. .playback = {
  8708. .stream_name = "Quaternary TDM3 Playback",
  8709. .aif_name = "QUAT_TDM_RX_3",
  8710. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8711. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8712. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8713. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8714. SNDRV_PCM_FMTBIT_S24_LE |
  8715. SNDRV_PCM_FMTBIT_S32_LE,
  8716. .channels_min = 1,
  8717. .channels_max = 8,
  8718. .rate_min = 8000,
  8719. .rate_max = 352800,
  8720. },
  8721. .name = "QUAT_TDM_RX_3",
  8722. .ops = &msm_dai_q6_tdm_ops,
  8723. .id = AFE_PORT_ID_QUATERNARY_TDM_RX_3,
  8724. .probe = msm_dai_q6_dai_tdm_probe,
  8725. .remove = msm_dai_q6_dai_tdm_remove,
  8726. },
  8727. {
  8728. .playback = {
  8729. .stream_name = "Quaternary TDM4 Playback",
  8730. .aif_name = "QUAT_TDM_RX_4",
  8731. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8732. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8733. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8734. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8735. SNDRV_PCM_FMTBIT_S24_LE |
  8736. SNDRV_PCM_FMTBIT_S32_LE,
  8737. .channels_min = 1,
  8738. .channels_max = 8,
  8739. .rate_min = 8000,
  8740. .rate_max = 352800,
  8741. },
  8742. .name = "QUAT_TDM_RX_4",
  8743. .ops = &msm_dai_q6_tdm_ops,
  8744. .id = AFE_PORT_ID_QUATERNARY_TDM_RX_4,
  8745. .probe = msm_dai_q6_dai_tdm_probe,
  8746. .remove = msm_dai_q6_dai_tdm_remove,
  8747. },
  8748. {
  8749. .playback = {
  8750. .stream_name = "Quaternary TDM5 Playback",
  8751. .aif_name = "QUAT_TDM_RX_5",
  8752. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8753. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8754. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8755. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8756. SNDRV_PCM_FMTBIT_S24_LE |
  8757. SNDRV_PCM_FMTBIT_S32_LE,
  8758. .channels_min = 1,
  8759. .channels_max = 8,
  8760. .rate_min = 8000,
  8761. .rate_max = 352800,
  8762. },
  8763. .name = "QUAT_TDM_RX_5",
  8764. .ops = &msm_dai_q6_tdm_ops,
  8765. .id = AFE_PORT_ID_QUATERNARY_TDM_RX_5,
  8766. .probe = msm_dai_q6_dai_tdm_probe,
  8767. .remove = msm_dai_q6_dai_tdm_remove,
  8768. },
  8769. {
  8770. .playback = {
  8771. .stream_name = "Quaternary TDM6 Playback",
  8772. .aif_name = "QUAT_TDM_RX_6",
  8773. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8774. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8775. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8776. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8777. SNDRV_PCM_FMTBIT_S24_LE |
  8778. SNDRV_PCM_FMTBIT_S32_LE,
  8779. .channels_min = 1,
  8780. .channels_max = 8,
  8781. .rate_min = 8000,
  8782. .rate_max = 352800,
  8783. },
  8784. .name = "QUAT_TDM_RX_6",
  8785. .ops = &msm_dai_q6_tdm_ops,
  8786. .id = AFE_PORT_ID_QUATERNARY_TDM_RX_6,
  8787. .probe = msm_dai_q6_dai_tdm_probe,
  8788. .remove = msm_dai_q6_dai_tdm_remove,
  8789. },
  8790. {
  8791. .playback = {
  8792. .stream_name = "Quaternary TDM7 Playback",
  8793. .aif_name = "QUAT_TDM_RX_7",
  8794. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8795. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8796. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8797. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8798. SNDRV_PCM_FMTBIT_S24_LE |
  8799. SNDRV_PCM_FMTBIT_S32_LE,
  8800. .channels_min = 1,
  8801. .channels_max = 8,
  8802. .rate_min = 8000,
  8803. .rate_max = 352800,
  8804. },
  8805. .name = "QUAT_TDM_RX_7",
  8806. .ops = &msm_dai_q6_tdm_ops,
  8807. .id = AFE_PORT_ID_QUATERNARY_TDM_RX_7,
  8808. .probe = msm_dai_q6_dai_tdm_probe,
  8809. .remove = msm_dai_q6_dai_tdm_remove,
  8810. },
  8811. {
  8812. .capture = {
  8813. .stream_name = "Quaternary TDM0 Capture",
  8814. .aif_name = "QUAT_TDM_TX_0",
  8815. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8816. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8817. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8818. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8819. SNDRV_PCM_FMTBIT_S24_LE |
  8820. SNDRV_PCM_FMTBIT_S32_LE,
  8821. .channels_min = 1,
  8822. .channels_max = 8,
  8823. .rate_min = 8000,
  8824. .rate_max = 352800,
  8825. },
  8826. .name = "QUAT_TDM_TX_0",
  8827. .ops = &msm_dai_q6_tdm_ops,
  8828. .id = AFE_PORT_ID_QUATERNARY_TDM_TX,
  8829. .probe = msm_dai_q6_dai_tdm_probe,
  8830. .remove = msm_dai_q6_dai_tdm_remove,
  8831. },
  8832. {
  8833. .capture = {
  8834. .stream_name = "Quaternary TDM1 Capture",
  8835. .aif_name = "QUAT_TDM_TX_1",
  8836. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8837. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8838. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8839. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8840. SNDRV_PCM_FMTBIT_S24_LE |
  8841. SNDRV_PCM_FMTBIT_S32_LE,
  8842. .channels_min = 1,
  8843. .channels_max = 8,
  8844. .rate_min = 8000,
  8845. .rate_max = 352800,
  8846. },
  8847. .name = "QUAT_TDM_TX_1",
  8848. .ops = &msm_dai_q6_tdm_ops,
  8849. .id = AFE_PORT_ID_QUATERNARY_TDM_TX_1,
  8850. .probe = msm_dai_q6_dai_tdm_probe,
  8851. .remove = msm_dai_q6_dai_tdm_remove,
  8852. },
  8853. {
  8854. .capture = {
  8855. .stream_name = "Quaternary TDM2 Capture",
  8856. .aif_name = "QUAT_TDM_TX_2",
  8857. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8858. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8859. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8860. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8861. SNDRV_PCM_FMTBIT_S24_LE |
  8862. SNDRV_PCM_FMTBIT_S32_LE,
  8863. .channels_min = 1,
  8864. .channels_max = 8,
  8865. .rate_min = 8000,
  8866. .rate_max = 352800,
  8867. },
  8868. .name = "QUAT_TDM_TX_2",
  8869. .ops = &msm_dai_q6_tdm_ops,
  8870. .id = AFE_PORT_ID_QUATERNARY_TDM_TX_2,
  8871. .probe = msm_dai_q6_dai_tdm_probe,
  8872. .remove = msm_dai_q6_dai_tdm_remove,
  8873. },
  8874. {
  8875. .capture = {
  8876. .stream_name = "Quaternary TDM3 Capture",
  8877. .aif_name = "QUAT_TDM_TX_3",
  8878. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8879. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8880. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8881. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8882. SNDRV_PCM_FMTBIT_S24_LE |
  8883. SNDRV_PCM_FMTBIT_S32_LE,
  8884. .channels_min = 1,
  8885. .channels_max = 8,
  8886. .rate_min = 8000,
  8887. .rate_max = 352800,
  8888. },
  8889. .name = "QUAT_TDM_TX_3",
  8890. .ops = &msm_dai_q6_tdm_ops,
  8891. .id = AFE_PORT_ID_QUATERNARY_TDM_TX_3,
  8892. .probe = msm_dai_q6_dai_tdm_probe,
  8893. .remove = msm_dai_q6_dai_tdm_remove,
  8894. },
  8895. {
  8896. .capture = {
  8897. .stream_name = "Quaternary TDM4 Capture",
  8898. .aif_name = "QUAT_TDM_TX_4",
  8899. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8900. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8901. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8902. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8903. SNDRV_PCM_FMTBIT_S24_LE |
  8904. SNDRV_PCM_FMTBIT_S32_LE,
  8905. .channels_min = 1,
  8906. .channels_max = 8,
  8907. .rate_min = 8000,
  8908. .rate_max = 352800,
  8909. },
  8910. .name = "QUAT_TDM_TX_4",
  8911. .ops = &msm_dai_q6_tdm_ops,
  8912. .id = AFE_PORT_ID_QUATERNARY_TDM_TX_4,
  8913. .probe = msm_dai_q6_dai_tdm_probe,
  8914. .remove = msm_dai_q6_dai_tdm_remove,
  8915. },
  8916. {
  8917. .capture = {
  8918. .stream_name = "Quaternary TDM5 Capture",
  8919. .aif_name = "QUAT_TDM_TX_5",
  8920. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8921. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8922. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8923. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8924. SNDRV_PCM_FMTBIT_S24_LE |
  8925. SNDRV_PCM_FMTBIT_S32_LE,
  8926. .channels_min = 1,
  8927. .channels_max = 8,
  8928. .rate_min = 8000,
  8929. .rate_max = 352800,
  8930. },
  8931. .name = "QUAT_TDM_TX_5",
  8932. .ops = &msm_dai_q6_tdm_ops,
  8933. .id = AFE_PORT_ID_QUATERNARY_TDM_TX_5,
  8934. .probe = msm_dai_q6_dai_tdm_probe,
  8935. .remove = msm_dai_q6_dai_tdm_remove,
  8936. },
  8937. {
  8938. .capture = {
  8939. .stream_name = "Quaternary TDM6 Capture",
  8940. .aif_name = "QUAT_TDM_TX_6",
  8941. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8942. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8943. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8944. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8945. SNDRV_PCM_FMTBIT_S24_LE |
  8946. SNDRV_PCM_FMTBIT_S32_LE,
  8947. .channels_min = 1,
  8948. .channels_max = 8,
  8949. .rate_min = 8000,
  8950. .rate_max = 352800,
  8951. },
  8952. .name = "QUAT_TDM_TX_6",
  8953. .ops = &msm_dai_q6_tdm_ops,
  8954. .id = AFE_PORT_ID_QUATERNARY_TDM_TX_6,
  8955. .probe = msm_dai_q6_dai_tdm_probe,
  8956. .remove = msm_dai_q6_dai_tdm_remove,
  8957. },
  8958. {
  8959. .capture = {
  8960. .stream_name = "Quaternary TDM7 Capture",
  8961. .aif_name = "QUAT_TDM_TX_7",
  8962. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  8963. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  8964. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8965. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8966. SNDRV_PCM_FMTBIT_S24_LE |
  8967. SNDRV_PCM_FMTBIT_S32_LE,
  8968. .channels_min = 1,
  8969. .channels_max = 8,
  8970. .rate_min = 8000,
  8971. .rate_max = 352800,
  8972. },
  8973. .name = "QUAT_TDM_TX_7",
  8974. .ops = &msm_dai_q6_tdm_ops,
  8975. .id = AFE_PORT_ID_QUATERNARY_TDM_TX_7,
  8976. .probe = msm_dai_q6_dai_tdm_probe,
  8977. .remove = msm_dai_q6_dai_tdm_remove,
  8978. },
  8979. {
  8980. .playback = {
  8981. .stream_name = "Quinary TDM0 Playback",
  8982. .aif_name = "QUIN_TDM_RX_0",
  8983. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  8984. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_48000 |
  8985. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  8986. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  8987. SNDRV_PCM_FMTBIT_S24_LE |
  8988. SNDRV_PCM_FMTBIT_S32_LE,
  8989. .channels_min = 1,
  8990. .channels_max = 8,
  8991. .rate_min = 8000,
  8992. .rate_max = 352800,
  8993. },
  8994. .name = "QUIN_TDM_RX_0",
  8995. .ops = &msm_dai_q6_tdm_ops,
  8996. .id = AFE_PORT_ID_QUINARY_TDM_RX,
  8997. .probe = msm_dai_q6_dai_tdm_probe,
  8998. .remove = msm_dai_q6_dai_tdm_remove,
  8999. },
  9000. {
  9001. .playback = {
  9002. .stream_name = "Quinary TDM1 Playback",
  9003. .aif_name = "QUIN_TDM_RX_1",
  9004. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  9005. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_48000 |
  9006. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  9007. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9008. SNDRV_PCM_FMTBIT_S24_LE |
  9009. SNDRV_PCM_FMTBIT_S32_LE,
  9010. .channels_min = 1,
  9011. .channels_max = 8,
  9012. .rate_min = 8000,
  9013. .rate_max = 352800,
  9014. },
  9015. .name = "QUIN_TDM_RX_1",
  9016. .ops = &msm_dai_q6_tdm_ops,
  9017. .id = AFE_PORT_ID_QUINARY_TDM_RX_1,
  9018. .probe = msm_dai_q6_dai_tdm_probe,
  9019. .remove = msm_dai_q6_dai_tdm_remove,
  9020. },
  9021. {
  9022. .playback = {
  9023. .stream_name = "Quinary TDM2 Playback",
  9024. .aif_name = "QUIN_TDM_RX_2",
  9025. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  9026. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_48000 |
  9027. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  9028. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9029. SNDRV_PCM_FMTBIT_S24_LE |
  9030. SNDRV_PCM_FMTBIT_S32_LE,
  9031. .channels_min = 1,
  9032. .channels_max = 8,
  9033. .rate_min = 8000,
  9034. .rate_max = 352800,
  9035. },
  9036. .name = "QUIN_TDM_RX_2",
  9037. .ops = &msm_dai_q6_tdm_ops,
  9038. .id = AFE_PORT_ID_QUINARY_TDM_RX_2,
  9039. .probe = msm_dai_q6_dai_tdm_probe,
  9040. .remove = msm_dai_q6_dai_tdm_remove,
  9041. },
  9042. {
  9043. .playback = {
  9044. .stream_name = "Quinary TDM3 Playback",
  9045. .aif_name = "QUIN_TDM_RX_3",
  9046. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  9047. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_48000 |
  9048. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  9049. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9050. SNDRV_PCM_FMTBIT_S24_LE |
  9051. SNDRV_PCM_FMTBIT_S32_LE,
  9052. .channels_min = 1,
  9053. .channels_max = 8,
  9054. .rate_min = 8000,
  9055. .rate_max = 352800,
  9056. },
  9057. .name = "QUIN_TDM_RX_3",
  9058. .ops = &msm_dai_q6_tdm_ops,
  9059. .id = AFE_PORT_ID_QUINARY_TDM_RX_3,
  9060. .probe = msm_dai_q6_dai_tdm_probe,
  9061. .remove = msm_dai_q6_dai_tdm_remove,
  9062. },
  9063. {
  9064. .playback = {
  9065. .stream_name = "Quinary TDM4 Playback",
  9066. .aif_name = "QUIN_TDM_RX_4",
  9067. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  9068. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_48000 |
  9069. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  9070. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9071. SNDRV_PCM_FMTBIT_S24_LE |
  9072. SNDRV_PCM_FMTBIT_S32_LE,
  9073. .channels_min = 1,
  9074. .channels_max = 8,
  9075. .rate_min = 8000,
  9076. .rate_max = 352800,
  9077. },
  9078. .name = "QUIN_TDM_RX_4",
  9079. .ops = &msm_dai_q6_tdm_ops,
  9080. .id = AFE_PORT_ID_QUINARY_TDM_RX_4,
  9081. .probe = msm_dai_q6_dai_tdm_probe,
  9082. .remove = msm_dai_q6_dai_tdm_remove,
  9083. },
  9084. {
  9085. .playback = {
  9086. .stream_name = "Quinary TDM5 Playback",
  9087. .aif_name = "QUIN_TDM_RX_5",
  9088. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  9089. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_48000 |
  9090. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  9091. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9092. SNDRV_PCM_FMTBIT_S24_LE |
  9093. SNDRV_PCM_FMTBIT_S32_LE,
  9094. .channels_min = 1,
  9095. .channels_max = 8,
  9096. .rate_min = 8000,
  9097. .rate_max = 352800,
  9098. },
  9099. .name = "QUIN_TDM_RX_5",
  9100. .ops = &msm_dai_q6_tdm_ops,
  9101. .id = AFE_PORT_ID_QUINARY_TDM_RX_5,
  9102. .probe = msm_dai_q6_dai_tdm_probe,
  9103. .remove = msm_dai_q6_dai_tdm_remove,
  9104. },
  9105. {
  9106. .playback = {
  9107. .stream_name = "Quinary TDM6 Playback",
  9108. .aif_name = "QUIN_TDM_RX_6",
  9109. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  9110. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_48000 |
  9111. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  9112. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9113. SNDRV_PCM_FMTBIT_S24_LE |
  9114. SNDRV_PCM_FMTBIT_S32_LE,
  9115. .channels_min = 1,
  9116. .channels_max = 8,
  9117. .rate_min = 8000,
  9118. .rate_max = 352800,
  9119. },
  9120. .name = "QUIN_TDM_RX_6",
  9121. .ops = &msm_dai_q6_tdm_ops,
  9122. .id = AFE_PORT_ID_QUINARY_TDM_RX_6,
  9123. .probe = msm_dai_q6_dai_tdm_probe,
  9124. .remove = msm_dai_q6_dai_tdm_remove,
  9125. },
  9126. {
  9127. .playback = {
  9128. .stream_name = "Quinary TDM7 Playback",
  9129. .aif_name = "QUIN_TDM_RX_7",
  9130. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_8000 |
  9131. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_48000 |
  9132. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  9133. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9134. SNDRV_PCM_FMTBIT_S24_LE |
  9135. SNDRV_PCM_FMTBIT_S32_LE,
  9136. .channels_min = 1,
  9137. .channels_max = 8,
  9138. .rate_min = 8000,
  9139. .rate_max = 352800,
  9140. },
  9141. .name = "QUIN_TDM_RX_7",
  9142. .ops = &msm_dai_q6_tdm_ops,
  9143. .id = AFE_PORT_ID_QUINARY_TDM_RX_7,
  9144. .probe = msm_dai_q6_dai_tdm_probe,
  9145. .remove = msm_dai_q6_dai_tdm_remove,
  9146. },
  9147. {
  9148. .capture = {
  9149. .stream_name = "Quinary TDM0 Capture",
  9150. .aif_name = "QUIN_TDM_TX_0",
  9151. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  9152. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  9153. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  9154. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9155. SNDRV_PCM_FMTBIT_S24_LE |
  9156. SNDRV_PCM_FMTBIT_S32_LE,
  9157. .channels_min = 1,
  9158. .channels_max = 8,
  9159. .rate_min = 8000,
  9160. .rate_max = 352800,
  9161. },
  9162. .name = "QUIN_TDM_TX_0",
  9163. .ops = &msm_dai_q6_tdm_ops,
  9164. .id = AFE_PORT_ID_QUINARY_TDM_TX,
  9165. .probe = msm_dai_q6_dai_tdm_probe,
  9166. .remove = msm_dai_q6_dai_tdm_remove,
  9167. },
  9168. {
  9169. .capture = {
  9170. .stream_name = "Quinary TDM1 Capture",
  9171. .aif_name = "QUIN_TDM_TX_1",
  9172. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  9173. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  9174. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  9175. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9176. SNDRV_PCM_FMTBIT_S24_LE |
  9177. SNDRV_PCM_FMTBIT_S32_LE,
  9178. .channels_min = 1,
  9179. .channels_max = 8,
  9180. .rate_min = 8000,
  9181. .rate_max = 352800,
  9182. },
  9183. .name = "QUIN_TDM_TX_1",
  9184. .ops = &msm_dai_q6_tdm_ops,
  9185. .id = AFE_PORT_ID_QUINARY_TDM_TX_1,
  9186. .probe = msm_dai_q6_dai_tdm_probe,
  9187. .remove = msm_dai_q6_dai_tdm_remove,
  9188. },
  9189. {
  9190. .capture = {
  9191. .stream_name = "Quinary TDM2 Capture",
  9192. .aif_name = "QUIN_TDM_TX_2",
  9193. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  9194. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  9195. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  9196. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9197. SNDRV_PCM_FMTBIT_S24_LE |
  9198. SNDRV_PCM_FMTBIT_S32_LE,
  9199. .channels_min = 1,
  9200. .channels_max = 8,
  9201. .rate_min = 8000,
  9202. .rate_max = 352800,
  9203. },
  9204. .name = "QUIN_TDM_TX_2",
  9205. .ops = &msm_dai_q6_tdm_ops,
  9206. .id = AFE_PORT_ID_QUINARY_TDM_TX_2,
  9207. .probe = msm_dai_q6_dai_tdm_probe,
  9208. .remove = msm_dai_q6_dai_tdm_remove,
  9209. },
  9210. {
  9211. .capture = {
  9212. .stream_name = "Quinary TDM3 Capture",
  9213. .aif_name = "QUIN_TDM_TX_3",
  9214. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  9215. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  9216. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  9217. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9218. SNDRV_PCM_FMTBIT_S24_LE |
  9219. SNDRV_PCM_FMTBIT_S32_LE,
  9220. .channels_min = 1,
  9221. .channels_max = 8,
  9222. .rate_min = 8000,
  9223. .rate_max = 352800,
  9224. },
  9225. .name = "QUIN_TDM_TX_3",
  9226. .ops = &msm_dai_q6_tdm_ops,
  9227. .id = AFE_PORT_ID_QUINARY_TDM_TX_3,
  9228. .probe = msm_dai_q6_dai_tdm_probe,
  9229. .remove = msm_dai_q6_dai_tdm_remove,
  9230. },
  9231. {
  9232. .capture = {
  9233. .stream_name = "Quinary TDM4 Capture",
  9234. .aif_name = "QUIN_TDM_TX_4",
  9235. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  9236. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  9237. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  9238. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9239. SNDRV_PCM_FMTBIT_S24_LE |
  9240. SNDRV_PCM_FMTBIT_S32_LE,
  9241. .channels_min = 1,
  9242. .channels_max = 8,
  9243. .rate_min = 8000,
  9244. .rate_max = 352800,
  9245. },
  9246. .name = "QUIN_TDM_TX_4",
  9247. .ops = &msm_dai_q6_tdm_ops,
  9248. .id = AFE_PORT_ID_QUINARY_TDM_TX_4,
  9249. .probe = msm_dai_q6_dai_tdm_probe,
  9250. .remove = msm_dai_q6_dai_tdm_remove,
  9251. },
  9252. {
  9253. .capture = {
  9254. .stream_name = "Quinary TDM5 Capture",
  9255. .aif_name = "QUIN_TDM_TX_5",
  9256. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  9257. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  9258. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  9259. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9260. SNDRV_PCM_FMTBIT_S24_LE |
  9261. SNDRV_PCM_FMTBIT_S32_LE,
  9262. .channels_min = 1,
  9263. .channels_max = 8,
  9264. .rate_min = 8000,
  9265. .rate_max = 352800,
  9266. },
  9267. .name = "QUIN_TDM_TX_5",
  9268. .ops = &msm_dai_q6_tdm_ops,
  9269. .id = AFE_PORT_ID_QUINARY_TDM_TX_5,
  9270. .probe = msm_dai_q6_dai_tdm_probe,
  9271. .remove = msm_dai_q6_dai_tdm_remove,
  9272. },
  9273. {
  9274. .capture = {
  9275. .stream_name = "Quinary TDM6 Capture",
  9276. .aif_name = "QUIN_TDM_TX_6",
  9277. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  9278. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  9279. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  9280. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9281. SNDRV_PCM_FMTBIT_S24_LE |
  9282. SNDRV_PCM_FMTBIT_S32_LE,
  9283. .channels_min = 1,
  9284. .channels_max = 8,
  9285. .rate_min = 8000,
  9286. .rate_max = 352800,
  9287. },
  9288. .name = "QUIN_TDM_TX_6",
  9289. .ops = &msm_dai_q6_tdm_ops,
  9290. .id = AFE_PORT_ID_QUINARY_TDM_TX_6,
  9291. .probe = msm_dai_q6_dai_tdm_probe,
  9292. .remove = msm_dai_q6_dai_tdm_remove,
  9293. },
  9294. {
  9295. .capture = {
  9296. .stream_name = "Quinary TDM7 Capture",
  9297. .aif_name = "QUIN_TDM_TX_7",
  9298. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  9299. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  9300. SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_352800,
  9301. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9302. SNDRV_PCM_FMTBIT_S24_LE |
  9303. SNDRV_PCM_FMTBIT_S32_LE,
  9304. .channels_min = 1,
  9305. .channels_max = 8,
  9306. .rate_min = 8000,
  9307. .rate_max = 352800,
  9308. },
  9309. .name = "QUIN_TDM_TX_7",
  9310. .ops = &msm_dai_q6_tdm_ops,
  9311. .id = AFE_PORT_ID_QUINARY_TDM_TX_7,
  9312. .probe = msm_dai_q6_dai_tdm_probe,
  9313. .remove = msm_dai_q6_dai_tdm_remove,
  9314. },
  9315. };
  9316. static const struct snd_soc_component_driver msm_q6_tdm_dai_component = {
  9317. .name = "msm-dai-q6-tdm",
  9318. };
  9319. static int msm_dai_q6_tdm_dev_probe(struct platform_device *pdev)
  9320. {
  9321. struct msm_dai_q6_tdm_dai_data *dai_data = NULL;
  9322. struct afe_param_id_custom_tdm_header_cfg *custom_tdm_header = NULL;
  9323. int rc = 0;
  9324. u32 tdm_dev_id = 0;
  9325. int port_idx = 0;
  9326. struct device_node *tdm_parent_node = NULL;
  9327. /* retrieve device/afe id */
  9328. rc = of_property_read_u32(pdev->dev.of_node,
  9329. "qcom,msm-cpudai-tdm-dev-id",
  9330. &tdm_dev_id);
  9331. if (rc) {
  9332. dev_err(&pdev->dev, "%s: Device ID missing in DT file\n",
  9333. __func__);
  9334. goto rtn;
  9335. }
  9336. if ((tdm_dev_id < AFE_PORT_ID_TDM_PORT_RANGE_START) ||
  9337. (tdm_dev_id > AFE_PORT_ID_TDM_PORT_RANGE_END)) {
  9338. dev_err(&pdev->dev, "%s: Invalid TDM Device ID 0x%x in DT file\n",
  9339. __func__, tdm_dev_id);
  9340. rc = -ENXIO;
  9341. goto rtn;
  9342. }
  9343. pdev->id = tdm_dev_id;
  9344. dai_data = kzalloc(sizeof(struct msm_dai_q6_tdm_dai_data),
  9345. GFP_KERNEL);
  9346. if (!dai_data) {
  9347. rc = -ENOMEM;
  9348. dev_err(&pdev->dev,
  9349. "%s Failed to allocate memory for tdm dai_data\n",
  9350. __func__);
  9351. goto rtn;
  9352. }
  9353. memset(dai_data, 0, sizeof(*dai_data));
  9354. rc = of_property_read_u32(pdev->dev.of_node,
  9355. "qcom,msm-dai-is-island-supported",
  9356. &dai_data->is_island_dai);
  9357. if (rc)
  9358. dev_dbg(&pdev->dev, "island supported entry not found\n");
  9359. /* TDM CFG */
  9360. tdm_parent_node = of_get_parent(pdev->dev.of_node);
  9361. rc = of_property_read_u32(tdm_parent_node,
  9362. "qcom,msm-cpudai-tdm-sync-mode",
  9363. (u32 *)&dai_data->port_cfg.tdm.sync_mode);
  9364. if (rc) {
  9365. dev_err(&pdev->dev, "%s: Sync Mode from DT file %s\n",
  9366. __func__, "qcom,msm-cpudai-tdm-sync-mode");
  9367. goto free_dai_data;
  9368. }
  9369. dev_dbg(&pdev->dev, "%s: Sync Mode from DT file 0x%x\n",
  9370. __func__, dai_data->port_cfg.tdm.sync_mode);
  9371. rc = of_property_read_u32(tdm_parent_node,
  9372. "qcom,msm-cpudai-tdm-sync-src",
  9373. (u32 *)&dai_data->port_cfg.tdm.sync_src);
  9374. if (rc) {
  9375. dev_err(&pdev->dev, "%s: Sync Src from DT file %s\n",
  9376. __func__, "qcom,msm-cpudai-tdm-sync-src");
  9377. goto free_dai_data;
  9378. }
  9379. dev_dbg(&pdev->dev, "%s: Sync Src from DT file 0x%x\n",
  9380. __func__, dai_data->port_cfg.tdm.sync_src);
  9381. rc = of_property_read_u32(tdm_parent_node,
  9382. "qcom,msm-cpudai-tdm-data-out",
  9383. (u32 *)&dai_data->port_cfg.tdm.ctrl_data_out_enable);
  9384. if (rc) {
  9385. dev_err(&pdev->dev, "%s: Data Out from DT file %s\n",
  9386. __func__, "qcom,msm-cpudai-tdm-data-out");
  9387. goto free_dai_data;
  9388. }
  9389. dev_dbg(&pdev->dev, "%s: Data Out from DT file 0x%x\n",
  9390. __func__, dai_data->port_cfg.tdm.ctrl_data_out_enable);
  9391. rc = of_property_read_u32(tdm_parent_node,
  9392. "qcom,msm-cpudai-tdm-invert-sync",
  9393. (u32 *)&dai_data->port_cfg.tdm.ctrl_invert_sync_pulse);
  9394. if (rc) {
  9395. dev_err(&pdev->dev, "%s: Invert Sync from DT file %s\n",
  9396. __func__, "qcom,msm-cpudai-tdm-invert-sync");
  9397. goto free_dai_data;
  9398. }
  9399. dev_dbg(&pdev->dev, "%s: Invert Sync from DT file 0x%x\n",
  9400. __func__, dai_data->port_cfg.tdm.ctrl_invert_sync_pulse);
  9401. rc = of_property_read_u32(tdm_parent_node,
  9402. "qcom,msm-cpudai-tdm-data-delay",
  9403. (u32 *)&dai_data->port_cfg.tdm.ctrl_sync_data_delay);
  9404. if (rc) {
  9405. dev_err(&pdev->dev, "%s: Data Delay from DT file %s\n",
  9406. __func__, "qcom,msm-cpudai-tdm-data-delay");
  9407. goto free_dai_data;
  9408. }
  9409. dev_dbg(&pdev->dev, "%s: Data Delay from DT file 0x%x\n",
  9410. __func__, dai_data->port_cfg.tdm.ctrl_sync_data_delay);
  9411. /* TDM CFG -- set default */
  9412. dai_data->port_cfg.tdm.data_format = AFE_LINEAR_PCM_DATA;
  9413. dai_data->port_cfg.tdm.tdm_cfg_minor_version =
  9414. AFE_API_VERSION_TDM_CONFIG;
  9415. /* TDM SLOT MAPPING CFG */
  9416. rc = of_property_read_u32(pdev->dev.of_node,
  9417. "qcom,msm-cpudai-tdm-data-align",
  9418. &dai_data->port_cfg.slot_mapping.data_align_type);
  9419. if (rc) {
  9420. dev_err(&pdev->dev, "%s: Data Align from DT file %s\n",
  9421. __func__,
  9422. "qcom,msm-cpudai-tdm-data-align");
  9423. goto free_dai_data;
  9424. }
  9425. dev_dbg(&pdev->dev, "%s: Data Align from DT file 0x%x\n",
  9426. __func__, dai_data->port_cfg.slot_mapping.data_align_type);
  9427. /* TDM SLOT MAPPING CFG -- set default */
  9428. dai_data->port_cfg.slot_mapping.minor_version =
  9429. AFE_API_VERSION_SLOT_MAPPING_CONFIG;
  9430. /* CUSTOM TDM HEADER CFG */
  9431. custom_tdm_header = &dai_data->port_cfg.custom_tdm_header;
  9432. if (of_find_property(pdev->dev.of_node,
  9433. "qcom,msm-cpudai-tdm-header-start-offset", NULL) &&
  9434. of_find_property(pdev->dev.of_node,
  9435. "qcom,msm-cpudai-tdm-header-width", NULL) &&
  9436. of_find_property(pdev->dev.of_node,
  9437. "qcom,msm-cpudai-tdm-header-num-frame-repeat", NULL)) {
  9438. /* if the property exist */
  9439. rc = of_property_read_u32(pdev->dev.of_node,
  9440. "qcom,msm-cpudai-tdm-header-start-offset",
  9441. (u32 *)&custom_tdm_header->start_offset);
  9442. if (rc) {
  9443. dev_err(&pdev->dev, "%s: Header Start Offset from DT file %s\n",
  9444. __func__,
  9445. "qcom,msm-cpudai-tdm-header-start-offset");
  9446. goto free_dai_data;
  9447. }
  9448. dev_dbg(&pdev->dev, "%s: Header Start Offset from DT file 0x%x\n",
  9449. __func__, custom_tdm_header->start_offset);
  9450. rc = of_property_read_u32(pdev->dev.of_node,
  9451. "qcom,msm-cpudai-tdm-header-width",
  9452. (u32 *)&custom_tdm_header->header_width);
  9453. if (rc) {
  9454. dev_err(&pdev->dev, "%s: Header Width from DT file %s\n",
  9455. __func__, "qcom,msm-cpudai-tdm-header-width");
  9456. goto free_dai_data;
  9457. }
  9458. dev_dbg(&pdev->dev, "%s: Header Width from DT file 0x%x\n",
  9459. __func__, custom_tdm_header->header_width);
  9460. rc = of_property_read_u32(pdev->dev.of_node,
  9461. "qcom,msm-cpudai-tdm-header-num-frame-repeat",
  9462. (u32 *)&custom_tdm_header->num_frame_repeat);
  9463. if (rc) {
  9464. dev_err(&pdev->dev, "%s: Header Num Frame Repeat from DT file %s\n",
  9465. __func__,
  9466. "qcom,msm-cpudai-tdm-header-num-frame-repeat");
  9467. goto free_dai_data;
  9468. }
  9469. dev_dbg(&pdev->dev, "%s: Header Num Frame Repeat from DT file 0x%x\n",
  9470. __func__, custom_tdm_header->num_frame_repeat);
  9471. /* CUSTOM TDM HEADER CFG -- set default */
  9472. custom_tdm_header->minor_version =
  9473. AFE_API_VERSION_CUSTOM_TDM_HEADER_CONFIG;
  9474. custom_tdm_header->header_type =
  9475. AFE_CUSTOM_TDM_HEADER_TYPE_INVALID;
  9476. } else {
  9477. /* CUSTOM TDM HEADER CFG -- set default */
  9478. custom_tdm_header->header_type =
  9479. AFE_CUSTOM_TDM_HEADER_TYPE_INVALID;
  9480. /* proceed with probe */
  9481. }
  9482. /* copy static clk per parent node */
  9483. dai_data->clk_set = tdm_clk_set;
  9484. /* copy static group cfg per parent node */
  9485. dai_data->group_cfg.tdm_cfg = tdm_group_cfg;
  9486. /* copy static num group ports per parent node */
  9487. dai_data->num_group_ports = num_tdm_group_ports;
  9488. dev_set_drvdata(&pdev->dev, dai_data);
  9489. port_idx = msm_dai_q6_get_port_idx(tdm_dev_id);
  9490. if (port_idx < 0) {
  9491. dev_err(&pdev->dev, "%s Port id 0x%x not supported\n",
  9492. __func__, tdm_dev_id);
  9493. rc = -EINVAL;
  9494. goto free_dai_data;
  9495. }
  9496. rc = snd_soc_register_component(&pdev->dev,
  9497. &msm_q6_tdm_dai_component,
  9498. &msm_dai_q6_tdm_dai[port_idx], 1);
  9499. if (rc) {
  9500. dev_err(&pdev->dev, "%s: TDM dai 0x%x register failed, rc=%d\n",
  9501. __func__, tdm_dev_id, rc);
  9502. goto err_register;
  9503. }
  9504. return 0;
  9505. err_register:
  9506. free_dai_data:
  9507. kfree(dai_data);
  9508. rtn:
  9509. return rc;
  9510. }
  9511. static int msm_dai_q6_tdm_dev_remove(struct platform_device *pdev)
  9512. {
  9513. struct msm_dai_q6_tdm_dai_data *dai_data =
  9514. dev_get_drvdata(&pdev->dev);
  9515. snd_soc_unregister_component(&pdev->dev);
  9516. kfree(dai_data);
  9517. return 0;
  9518. }
  9519. static const struct of_device_id msm_dai_q6_tdm_dev_dt_match[] = {
  9520. { .compatible = "qcom,msm-dai-q6-tdm", },
  9521. {}
  9522. };
  9523. MODULE_DEVICE_TABLE(of, msm_dai_q6_tdm_dev_dt_match);
  9524. static struct platform_driver msm_dai_q6_tdm_driver = {
  9525. .probe = msm_dai_q6_tdm_dev_probe,
  9526. .remove = msm_dai_q6_tdm_dev_remove,
  9527. .driver = {
  9528. .name = "msm-dai-q6-tdm",
  9529. .owner = THIS_MODULE,
  9530. .of_match_table = msm_dai_q6_tdm_dev_dt_match,
  9531. },
  9532. };
  9533. static int msm_dai_q6_cdc_dma_format_put(struct snd_kcontrol *kcontrol,
  9534. struct snd_ctl_elem_value *ucontrol)
  9535. {
  9536. struct msm_dai_q6_cdc_dma_dai_data *dai_data = kcontrol->private_data;
  9537. int value = ucontrol->value.integer.value[0];
  9538. dai_data->port_config.cdc_dma.data_format = value;
  9539. pr_debug("%s: format = %d\n", __func__, value);
  9540. return 0;
  9541. }
  9542. static int msm_dai_q6_cdc_dma_format_get(struct snd_kcontrol *kcontrol,
  9543. struct snd_ctl_elem_value *ucontrol)
  9544. {
  9545. struct msm_dai_q6_cdc_dma_dai_data *dai_data = kcontrol->private_data;
  9546. ucontrol->value.integer.value[0] =
  9547. dai_data->port_config.cdc_dma.data_format;
  9548. return 0;
  9549. }
  9550. static const struct snd_kcontrol_new cdc_dma_config_controls[] = {
  9551. SOC_ENUM_EXT("WSA_CDC_DMA_0 TX Format", cdc_dma_config_enum[0],
  9552. msm_dai_q6_cdc_dma_format_get,
  9553. msm_dai_q6_cdc_dma_format_put),
  9554. };
  9555. /* SOC probe for codec DMA interface */
  9556. static int msm_dai_q6_dai_cdc_dma_probe(struct snd_soc_dai *dai)
  9557. {
  9558. struct msm_dai_q6_cdc_dma_dai_data *dai_data = NULL;
  9559. int rc = 0;
  9560. if (!dai) {
  9561. pr_err("%s: Invalid params dai\n", __func__);
  9562. return -EINVAL;
  9563. }
  9564. if (!dai->dev) {
  9565. pr_err("%s: Invalid params dai dev\n", __func__);
  9566. return -EINVAL;
  9567. }
  9568. msm_dai_q6_set_dai_id(dai);
  9569. dai_data = dev_get_drvdata(dai->dev);
  9570. switch (dai->id) {
  9571. case AFE_PORT_ID_WSA_CODEC_DMA_TX_0:
  9572. rc = snd_ctl_add(dai->component->card->snd_card,
  9573. snd_ctl_new1(&cdc_dma_config_controls[0],
  9574. dai_data));
  9575. break;
  9576. default:
  9577. break;
  9578. }
  9579. if (rc < 0)
  9580. dev_err(dai->dev, "%s: err add config ctl, DAI = %s\n",
  9581. __func__, dai->name);
  9582. if (dai_data->is_island_dai)
  9583. rc = msm_dai_q6_add_island_mx_ctls(
  9584. dai->component->card->snd_card,
  9585. dai->name, dai->id,
  9586. (void *)dai_data);
  9587. rc = msm_dai_q6_dai_add_route(dai);
  9588. return rc;
  9589. }
  9590. static int msm_dai_q6_dai_cdc_dma_remove(struct snd_soc_dai *dai)
  9591. {
  9592. struct msm_dai_q6_cdc_dma_dai_data *dai_data =
  9593. dev_get_drvdata(dai->dev);
  9594. int rc = 0;
  9595. /* If AFE port is still up, close it */
  9596. if (test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  9597. dev_dbg(dai->dev, "%s: stop codec dma port:%d\n", __func__,
  9598. dai->id);
  9599. rc = afe_close(dai->id); /* can block */
  9600. if (rc < 0)
  9601. dev_err(dai->dev, "fail to close AFE port\n");
  9602. clear_bit(STATUS_PORT_STARTED, dai_data->status_mask);
  9603. }
  9604. return rc;
  9605. }
  9606. static int msm_dai_q6_cdc_dma_set_channel_map(struct snd_soc_dai *dai,
  9607. unsigned int tx_num_ch, unsigned int *tx_ch_mask,
  9608. unsigned int rx_num_ch, unsigned int *rx_ch_mask)
  9609. {
  9610. int rc = 0;
  9611. struct msm_dai_q6_cdc_dma_dai_data *dai_data =
  9612. dev_get_drvdata(dai->dev);
  9613. unsigned int ch_mask = 0, ch_num = 0;
  9614. dev_dbg(dai->dev, "%s: id = %d\n", __func__, dai->id);
  9615. switch (dai->id) {
  9616. case AFE_PORT_ID_WSA_CODEC_DMA_RX_0:
  9617. case AFE_PORT_ID_WSA_CODEC_DMA_RX_1:
  9618. case AFE_PORT_ID_RX_CODEC_DMA_RX_0:
  9619. case AFE_PORT_ID_RX_CODEC_DMA_RX_1:
  9620. case AFE_PORT_ID_RX_CODEC_DMA_RX_2:
  9621. case AFE_PORT_ID_RX_CODEC_DMA_RX_3:
  9622. case AFE_PORT_ID_RX_CODEC_DMA_RX_4:
  9623. case AFE_PORT_ID_RX_CODEC_DMA_RX_5:
  9624. case AFE_PORT_ID_RX_CODEC_DMA_RX_6:
  9625. case AFE_PORT_ID_RX_CODEC_DMA_RX_7:
  9626. if (!rx_ch_mask) {
  9627. dev_err(dai->dev, "%s: invalid rx ch mask\n", __func__);
  9628. return -EINVAL;
  9629. }
  9630. if (rx_num_ch > AFE_PORT_MAX_AUDIO_CHAN_CNT) {
  9631. dev_err(dai->dev, "%s: invalid rx_num_ch %d\n",
  9632. __func__, rx_num_ch);
  9633. return -EINVAL;
  9634. }
  9635. ch_mask = *rx_ch_mask;
  9636. ch_num = rx_num_ch;
  9637. break;
  9638. case AFE_PORT_ID_WSA_CODEC_DMA_TX_0:
  9639. case AFE_PORT_ID_WSA_CODEC_DMA_TX_1:
  9640. case AFE_PORT_ID_WSA_CODEC_DMA_TX_2:
  9641. case AFE_PORT_ID_VA_CODEC_DMA_TX_0:
  9642. case AFE_PORT_ID_VA_CODEC_DMA_TX_1:
  9643. case AFE_PORT_ID_TX_CODEC_DMA_TX_0:
  9644. case AFE_PORT_ID_TX_CODEC_DMA_TX_1:
  9645. case AFE_PORT_ID_TX_CODEC_DMA_TX_2:
  9646. case AFE_PORT_ID_TX_CODEC_DMA_TX_3:
  9647. case AFE_PORT_ID_TX_CODEC_DMA_TX_4:
  9648. case AFE_PORT_ID_TX_CODEC_DMA_TX_5:
  9649. if (!tx_ch_mask) {
  9650. dev_err(dai->dev, "%s: invalid tx ch mask\n", __func__);
  9651. return -EINVAL;
  9652. }
  9653. if (tx_num_ch > AFE_PORT_MAX_AUDIO_CHAN_CNT) {
  9654. dev_err(dai->dev, "%s: invalid tx_num_ch %d\n",
  9655. __func__, tx_num_ch);
  9656. return -EINVAL;
  9657. }
  9658. ch_mask = *tx_ch_mask;
  9659. ch_num = tx_num_ch;
  9660. break;
  9661. default:
  9662. dev_err(dai->dev, "%s: invalid dai id %d\n", __func__, dai->id);
  9663. return -EINVAL;
  9664. }
  9665. dai_data->port_config.cdc_dma.active_channels_mask = ch_mask;
  9666. dev_dbg(dai->dev, "%s: CDC_DMA_%d_ch cnt[%d] ch mask[0x%x]\n", __func__,
  9667. dai->id, ch_num, ch_mask);
  9668. return rc;
  9669. }
  9670. static int msm_dai_q6_cdc_dma_hw_params(
  9671. struct snd_pcm_substream *substream,
  9672. struct snd_pcm_hw_params *params,
  9673. struct snd_soc_dai *dai)
  9674. {
  9675. struct msm_dai_q6_cdc_dma_dai_data *dai_data =
  9676. dev_get_drvdata(dai->dev);
  9677. switch (params_format(params)) {
  9678. case SNDRV_PCM_FORMAT_S16_LE:
  9679. case SNDRV_PCM_FORMAT_SPECIAL:
  9680. dai_data->port_config.cdc_dma.bit_width = 16;
  9681. break;
  9682. case SNDRV_PCM_FORMAT_S24_LE:
  9683. case SNDRV_PCM_FORMAT_S24_3LE:
  9684. dai_data->port_config.cdc_dma.bit_width = 24;
  9685. break;
  9686. case SNDRV_PCM_FORMAT_S32_LE:
  9687. dai_data->port_config.cdc_dma.bit_width = 32;
  9688. break;
  9689. default:
  9690. dev_err(dai->dev, "%s: format %d\n",
  9691. __func__, params_format(params));
  9692. return -EINVAL;
  9693. }
  9694. dai_data->rate = params_rate(params);
  9695. dai_data->channels = params_channels(params);
  9696. dai_data->port_config.cdc_dma.cdc_dma_cfg_minor_version =
  9697. AFE_API_VERSION_CODEC_DMA_CONFIG;
  9698. dai_data->port_config.cdc_dma.sample_rate = dai_data->rate;
  9699. dai_data->port_config.cdc_dma.num_channels = dai_data->channels;
  9700. dev_dbg(dai->dev, "%s: bit_wd[%hu] format[%hu]\n"
  9701. "num_channel %hu sample_rate %d\n", __func__,
  9702. dai_data->port_config.cdc_dma.bit_width,
  9703. dai_data->port_config.cdc_dma.data_format,
  9704. dai_data->port_config.cdc_dma.num_channels,
  9705. dai_data->rate);
  9706. return 0;
  9707. }
  9708. static int msm_dai_q6_cdc_dma_prepare(struct snd_pcm_substream *substream,
  9709. struct snd_soc_dai *dai)
  9710. {
  9711. struct msm_dai_q6_cdc_dma_dai_data *dai_data =
  9712. dev_get_drvdata(dai->dev);
  9713. int rc = 0;
  9714. if (!test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  9715. if (q6core_get_avcs_api_version_per_service(
  9716. APRV2_IDS_SERVICE_ID_ADSP_AFE_V) >= AFE_API_VERSION_V4) {
  9717. /*
  9718. * send island mode config.
  9719. * This should be the first configuration
  9720. */
  9721. rc = afe_send_port_island_mode(dai->id);
  9722. if (rc)
  9723. pr_err("%s: afe send island mode failed %d\n",
  9724. __func__, rc);
  9725. }
  9726. if ((dai->id == AFE_PORT_ID_WSA_CODEC_DMA_TX_0) &&
  9727. (dai_data->port_config.cdc_dma.data_format == 1))
  9728. dai_data->port_config.cdc_dma.data_format =
  9729. AFE_LINEAR_PCM_DATA_PACKED_16BIT;
  9730. rc = afe_port_start(dai->id, &dai_data->port_config,
  9731. dai_data->rate);
  9732. if (rc < 0)
  9733. dev_err(dai->dev, "fail to open AFE port 0x%x\n",
  9734. dai->id);
  9735. else
  9736. set_bit(STATUS_PORT_STARTED,
  9737. dai_data->status_mask);
  9738. }
  9739. return rc;
  9740. }
  9741. static void msm_dai_q6_cdc_dma_shutdown(struct snd_pcm_substream *substream,
  9742. struct snd_soc_dai *dai)
  9743. {
  9744. struct msm_dai_q6_dai_data *dai_data = dev_get_drvdata(dai->dev);
  9745. int rc = 0;
  9746. if (test_bit(STATUS_PORT_STARTED, dai_data->status_mask)) {
  9747. dev_dbg(dai->dev, "%s: stop AFE port:%d\n", __func__,
  9748. dai->id);
  9749. rc = afe_close(dai->id); /* can block */
  9750. if (rc < 0)
  9751. dev_err(dai->dev, "fail to close AFE port\n");
  9752. dev_dbg(dai->dev, "%s: dai_data->status_mask = %ld\n", __func__,
  9753. *dai_data->status_mask);
  9754. clear_bit(STATUS_PORT_STARTED, dai_data->status_mask);
  9755. }
  9756. if (test_bit(STATUS_PORT_STARTED, dai_data->hwfree_status))
  9757. clear_bit(STATUS_PORT_STARTED, dai_data->hwfree_status);
  9758. }
  9759. static struct snd_soc_dai_ops msm_dai_q6_cdc_dma_ops = {
  9760. .prepare = msm_dai_q6_cdc_dma_prepare,
  9761. .hw_params = msm_dai_q6_cdc_dma_hw_params,
  9762. .shutdown = msm_dai_q6_cdc_dma_shutdown,
  9763. .set_channel_map = msm_dai_q6_cdc_dma_set_channel_map,
  9764. };
  9765. static struct snd_soc_dai_driver msm_dai_q6_cdc_dma_dai[] = {
  9766. {
  9767. .playback = {
  9768. .stream_name = "WSA CDC DMA0 Playback",
  9769. .aif_name = "WSA_CDC_DMA_RX_0",
  9770. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  9771. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  9772. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  9773. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  9774. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  9775. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  9776. SNDRV_PCM_RATE_384000,
  9777. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9778. SNDRV_PCM_FMTBIT_S24_LE |
  9779. SNDRV_PCM_FMTBIT_S24_3LE |
  9780. SNDRV_PCM_FMTBIT_S32_LE,
  9781. .channels_min = 1,
  9782. .channels_max = 4,
  9783. .rate_min = 8000,
  9784. .rate_max = 384000,
  9785. },
  9786. .name = "WSA_CDC_DMA_RX_0",
  9787. .ops = &msm_dai_q6_cdc_dma_ops,
  9788. .id = AFE_PORT_ID_WSA_CODEC_DMA_RX_0,
  9789. .probe = msm_dai_q6_dai_cdc_dma_probe,
  9790. .remove = msm_dai_q6_dai_cdc_dma_remove,
  9791. },
  9792. {
  9793. .capture = {
  9794. .stream_name = "WSA CDC DMA0 Capture",
  9795. .aif_name = "WSA_CDC_DMA_TX_0",
  9796. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  9797. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  9798. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  9799. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  9800. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  9801. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  9802. SNDRV_PCM_RATE_384000,
  9803. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9804. SNDRV_PCM_FMTBIT_S24_LE |
  9805. SNDRV_PCM_FMTBIT_S24_3LE |
  9806. SNDRV_PCM_FMTBIT_S32_LE,
  9807. .channels_min = 1,
  9808. .channels_max = 4,
  9809. .rate_min = 8000,
  9810. .rate_max = 384000,
  9811. },
  9812. .name = "WSA_CDC_DMA_TX_0",
  9813. .ops = &msm_dai_q6_cdc_dma_ops,
  9814. .id = AFE_PORT_ID_WSA_CODEC_DMA_TX_0,
  9815. .probe = msm_dai_q6_dai_cdc_dma_probe,
  9816. .remove = msm_dai_q6_dai_cdc_dma_remove,
  9817. },
  9818. {
  9819. .playback = {
  9820. .stream_name = "WSA CDC DMA1 Playback",
  9821. .aif_name = "WSA_CDC_DMA_RX_1",
  9822. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  9823. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  9824. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  9825. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  9826. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  9827. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  9828. SNDRV_PCM_RATE_384000,
  9829. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9830. SNDRV_PCM_FMTBIT_S24_LE |
  9831. SNDRV_PCM_FMTBIT_S24_3LE |
  9832. SNDRV_PCM_FMTBIT_S32_LE,
  9833. .channels_min = 1,
  9834. .channels_max = 2,
  9835. .rate_min = 8000,
  9836. .rate_max = 384000,
  9837. },
  9838. .name = "WSA_CDC_DMA_RX_1",
  9839. .ops = &msm_dai_q6_cdc_dma_ops,
  9840. .id = AFE_PORT_ID_WSA_CODEC_DMA_RX_1,
  9841. .probe = msm_dai_q6_dai_cdc_dma_probe,
  9842. .remove = msm_dai_q6_dai_cdc_dma_remove,
  9843. },
  9844. {
  9845. .capture = {
  9846. .stream_name = "WSA CDC DMA1 Capture",
  9847. .aif_name = "WSA_CDC_DMA_TX_1",
  9848. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  9849. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  9850. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  9851. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  9852. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  9853. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  9854. SNDRV_PCM_RATE_384000,
  9855. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9856. SNDRV_PCM_FMTBIT_S24_LE |
  9857. SNDRV_PCM_FMTBIT_S24_3LE |
  9858. SNDRV_PCM_FMTBIT_S32_LE,
  9859. .channels_min = 1,
  9860. .channels_max = 2,
  9861. .rate_min = 8000,
  9862. .rate_max = 384000,
  9863. },
  9864. .name = "WSA_CDC_DMA_TX_1",
  9865. .ops = &msm_dai_q6_cdc_dma_ops,
  9866. .id = AFE_PORT_ID_WSA_CODEC_DMA_TX_1,
  9867. .probe = msm_dai_q6_dai_cdc_dma_probe,
  9868. .remove = msm_dai_q6_dai_cdc_dma_remove,
  9869. },
  9870. {
  9871. .capture = {
  9872. .stream_name = "WSA CDC DMA2 Capture",
  9873. .aif_name = "WSA_CDC_DMA_TX_2",
  9874. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  9875. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  9876. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  9877. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  9878. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  9879. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  9880. SNDRV_PCM_RATE_384000,
  9881. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9882. SNDRV_PCM_FMTBIT_S24_LE |
  9883. SNDRV_PCM_FMTBIT_S24_3LE |
  9884. SNDRV_PCM_FMTBIT_S32_LE,
  9885. .channels_min = 1,
  9886. .channels_max = 1,
  9887. .rate_min = 8000,
  9888. .rate_max = 384000,
  9889. },
  9890. .name = "WSA_CDC_DMA_TX_2",
  9891. .ops = &msm_dai_q6_cdc_dma_ops,
  9892. .id = AFE_PORT_ID_WSA_CODEC_DMA_TX_2,
  9893. .probe = msm_dai_q6_dai_cdc_dma_probe,
  9894. .remove = msm_dai_q6_dai_cdc_dma_remove,
  9895. },
  9896. {
  9897. .capture = {
  9898. .stream_name = "VA CDC DMA0 Capture",
  9899. .aif_name = "VA_CDC_DMA_TX_0",
  9900. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  9901. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  9902. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  9903. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  9904. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  9905. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  9906. SNDRV_PCM_RATE_384000,
  9907. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9908. SNDRV_PCM_FMTBIT_S24_LE |
  9909. SNDRV_PCM_FMTBIT_S24_3LE,
  9910. .channels_min = 1,
  9911. .channels_max = 8,
  9912. .rate_min = 8000,
  9913. .rate_max = 384000,
  9914. },
  9915. .name = "VA_CDC_DMA_TX_0",
  9916. .ops = &msm_dai_q6_cdc_dma_ops,
  9917. .id = AFE_PORT_ID_VA_CODEC_DMA_TX_0,
  9918. .probe = msm_dai_q6_dai_cdc_dma_probe,
  9919. .remove = msm_dai_q6_dai_cdc_dma_remove,
  9920. },
  9921. {
  9922. .capture = {
  9923. .stream_name = "VA CDC DMA1 Capture",
  9924. .aif_name = "VA_CDC_DMA_TX_1",
  9925. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  9926. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  9927. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  9928. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  9929. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  9930. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  9931. SNDRV_PCM_RATE_384000,
  9932. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9933. SNDRV_PCM_FMTBIT_S24_LE |
  9934. SNDRV_PCM_FMTBIT_S24_3LE,
  9935. .channels_min = 1,
  9936. .channels_max = 8,
  9937. .rate_min = 8000,
  9938. .rate_max = 384000,
  9939. },
  9940. .name = "VA_CDC_DMA_TX_1",
  9941. .ops = &msm_dai_q6_cdc_dma_ops,
  9942. .id = AFE_PORT_ID_VA_CODEC_DMA_TX_1,
  9943. .probe = msm_dai_q6_dai_cdc_dma_probe,
  9944. .remove = msm_dai_q6_dai_cdc_dma_remove,
  9945. },
  9946. {
  9947. .playback = {
  9948. .stream_name = "RX CDC DMA0 Playback",
  9949. .aif_name = "RX_CDC_DMA_RX_0",
  9950. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  9951. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  9952. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  9953. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  9954. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  9955. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  9956. SNDRV_PCM_RATE_384000,
  9957. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9958. SNDRV_PCM_FMTBIT_S24_LE |
  9959. SNDRV_PCM_FMTBIT_S24_3LE |
  9960. SNDRV_PCM_FMTBIT_S32_LE,
  9961. .channels_min = 1,
  9962. .channels_max = 2,
  9963. .rate_min = 8000,
  9964. .rate_max = 384000,
  9965. },
  9966. .ops = &msm_dai_q6_cdc_dma_ops,
  9967. .id = AFE_PORT_ID_RX_CODEC_DMA_RX_0,
  9968. .probe = msm_dai_q6_dai_cdc_dma_probe,
  9969. .remove = msm_dai_q6_dai_cdc_dma_remove,
  9970. },
  9971. {
  9972. .capture = {
  9973. .stream_name = "TX CDC DMA0 Capture",
  9974. .aif_name = "TX_CDC_DMA_TX_0",
  9975. .rates = SNDRV_PCM_RATE_8000 |
  9976. SNDRV_PCM_RATE_16000 |
  9977. SNDRV_PCM_RATE_32000 |
  9978. SNDRV_PCM_RATE_48000 |
  9979. SNDRV_PCM_RATE_96000 |
  9980. SNDRV_PCM_RATE_192000 |
  9981. SNDRV_PCM_RATE_384000,
  9982. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  9983. SNDRV_PCM_FMTBIT_S24_LE |
  9984. SNDRV_PCM_FMTBIT_S24_3LE |
  9985. SNDRV_PCM_FMTBIT_S32_LE,
  9986. .channels_min = 1,
  9987. .channels_max = 3,
  9988. .rate_min = 8000,
  9989. .rate_max = 384000,
  9990. },
  9991. .ops = &msm_dai_q6_cdc_dma_ops,
  9992. .id = AFE_PORT_ID_TX_CODEC_DMA_TX_0,
  9993. .probe = msm_dai_q6_dai_cdc_dma_probe,
  9994. .remove = msm_dai_q6_dai_cdc_dma_remove,
  9995. },
  9996. {
  9997. .playback = {
  9998. .stream_name = "RX CDC DMA1 Playback",
  9999. .aif_name = "RX_CDC_DMA_RX_1",
  10000. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  10001. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  10002. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  10003. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  10004. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  10005. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  10006. SNDRV_PCM_RATE_384000,
  10007. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  10008. SNDRV_PCM_FMTBIT_S24_LE |
  10009. SNDRV_PCM_FMTBIT_S24_3LE |
  10010. SNDRV_PCM_FMTBIT_S32_LE,
  10011. .channels_min = 1,
  10012. .channels_max = 2,
  10013. .rate_min = 8000,
  10014. .rate_max = 384000,
  10015. },
  10016. .ops = &msm_dai_q6_cdc_dma_ops,
  10017. .id = AFE_PORT_ID_RX_CODEC_DMA_RX_1,
  10018. .probe = msm_dai_q6_dai_cdc_dma_probe,
  10019. .remove = msm_dai_q6_dai_cdc_dma_remove,
  10020. },
  10021. {
  10022. .capture = {
  10023. .stream_name = "TX CDC DMA1 Capture",
  10024. .aif_name = "TX_CDC_DMA_TX_1",
  10025. .rates = SNDRV_PCM_RATE_8000 |
  10026. SNDRV_PCM_RATE_16000 |
  10027. SNDRV_PCM_RATE_32000 |
  10028. SNDRV_PCM_RATE_48000 |
  10029. SNDRV_PCM_RATE_96000 |
  10030. SNDRV_PCM_RATE_192000 |
  10031. SNDRV_PCM_RATE_384000,
  10032. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  10033. SNDRV_PCM_FMTBIT_S24_LE |
  10034. SNDRV_PCM_FMTBIT_S24_3LE |
  10035. SNDRV_PCM_FMTBIT_S32_LE,
  10036. .channels_min = 1,
  10037. .channels_max = 3,
  10038. .rate_min = 8000,
  10039. .rate_max = 384000,
  10040. },
  10041. .ops = &msm_dai_q6_cdc_dma_ops,
  10042. .id = AFE_PORT_ID_TX_CODEC_DMA_TX_1,
  10043. .probe = msm_dai_q6_dai_cdc_dma_probe,
  10044. .remove = msm_dai_q6_dai_cdc_dma_remove,
  10045. },
  10046. {
  10047. .playback = {
  10048. .stream_name = "RX CDC DMA2 Playback",
  10049. .aif_name = "RX_CDC_DMA_RX_2",
  10050. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  10051. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  10052. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  10053. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  10054. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  10055. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  10056. SNDRV_PCM_RATE_384000,
  10057. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  10058. SNDRV_PCM_FMTBIT_S24_LE |
  10059. SNDRV_PCM_FMTBIT_S24_3LE |
  10060. SNDRV_PCM_FMTBIT_S32_LE,
  10061. .channels_min = 1,
  10062. .channels_max = 1,
  10063. .rate_min = 8000,
  10064. .rate_max = 384000,
  10065. },
  10066. .ops = &msm_dai_q6_cdc_dma_ops,
  10067. .id = AFE_PORT_ID_RX_CODEC_DMA_RX_2,
  10068. .probe = msm_dai_q6_dai_cdc_dma_probe,
  10069. .remove = msm_dai_q6_dai_cdc_dma_remove,
  10070. },
  10071. {
  10072. .capture = {
  10073. .stream_name = "TX CDC DMA2 Capture",
  10074. .aif_name = "TX_CDC_DMA_TX_2",
  10075. .rates = SNDRV_PCM_RATE_8000 |
  10076. SNDRV_PCM_RATE_16000 |
  10077. SNDRV_PCM_RATE_32000 |
  10078. SNDRV_PCM_RATE_48000 |
  10079. SNDRV_PCM_RATE_96000 |
  10080. SNDRV_PCM_RATE_192000 |
  10081. SNDRV_PCM_RATE_384000,
  10082. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  10083. SNDRV_PCM_FMTBIT_S24_LE |
  10084. SNDRV_PCM_FMTBIT_S24_3LE |
  10085. SNDRV_PCM_FMTBIT_S32_LE,
  10086. .channels_min = 1,
  10087. .channels_max = 4,
  10088. .rate_min = 8000,
  10089. .rate_max = 384000,
  10090. },
  10091. .ops = &msm_dai_q6_cdc_dma_ops,
  10092. .id = AFE_PORT_ID_TX_CODEC_DMA_TX_2,
  10093. .probe = msm_dai_q6_dai_cdc_dma_probe,
  10094. .remove = msm_dai_q6_dai_cdc_dma_remove,
  10095. }, {
  10096. .playback = {
  10097. .stream_name = "RX CDC DMA3 Playback",
  10098. .aif_name = "RX_CDC_DMA_RX_3",
  10099. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  10100. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  10101. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  10102. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  10103. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  10104. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  10105. SNDRV_PCM_RATE_384000,
  10106. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  10107. SNDRV_PCM_FMTBIT_S24_LE |
  10108. SNDRV_PCM_FMTBIT_S24_3LE |
  10109. SNDRV_PCM_FMTBIT_S32_LE,
  10110. .channels_min = 1,
  10111. .channels_max = 1,
  10112. .rate_min = 8000,
  10113. .rate_max = 384000,
  10114. },
  10115. .ops = &msm_dai_q6_cdc_dma_ops,
  10116. .id = AFE_PORT_ID_RX_CODEC_DMA_RX_3,
  10117. .probe = msm_dai_q6_dai_cdc_dma_probe,
  10118. .remove = msm_dai_q6_dai_cdc_dma_remove,
  10119. },
  10120. {
  10121. .capture = {
  10122. .stream_name = "TX CDC DMA3 Capture",
  10123. .aif_name = "TX_CDC_DMA_TX_3",
  10124. .rates = SNDRV_PCM_RATE_8000 |
  10125. SNDRV_PCM_RATE_16000 |
  10126. SNDRV_PCM_RATE_32000 |
  10127. SNDRV_PCM_RATE_48000 |
  10128. SNDRV_PCM_RATE_96000 |
  10129. SNDRV_PCM_RATE_192000 |
  10130. SNDRV_PCM_RATE_384000,
  10131. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  10132. SNDRV_PCM_FMTBIT_S24_LE |
  10133. SNDRV_PCM_FMTBIT_S24_3LE |
  10134. SNDRV_PCM_FMTBIT_S32_LE,
  10135. .channels_min = 1,
  10136. .channels_max = 8,
  10137. .rate_min = 8000,
  10138. .rate_max = 384000,
  10139. },
  10140. .ops = &msm_dai_q6_cdc_dma_ops,
  10141. .id = AFE_PORT_ID_TX_CODEC_DMA_TX_3,
  10142. .probe = msm_dai_q6_dai_cdc_dma_probe,
  10143. .remove = msm_dai_q6_dai_cdc_dma_remove,
  10144. },
  10145. {
  10146. .playback = {
  10147. .stream_name = "RX CDC DMA4 Playback",
  10148. .aif_name = "RX_CDC_DMA_RX_4",
  10149. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  10150. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  10151. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  10152. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  10153. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  10154. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  10155. SNDRV_PCM_RATE_384000,
  10156. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  10157. SNDRV_PCM_FMTBIT_S24_LE |
  10158. SNDRV_PCM_FMTBIT_S24_3LE |
  10159. SNDRV_PCM_FMTBIT_S32_LE,
  10160. .channels_min = 1,
  10161. .channels_max = 6,
  10162. .rate_min = 8000,
  10163. .rate_max = 384000,
  10164. },
  10165. .ops = &msm_dai_q6_cdc_dma_ops,
  10166. .id = AFE_PORT_ID_RX_CODEC_DMA_RX_4,
  10167. .probe = msm_dai_q6_dai_cdc_dma_probe,
  10168. .remove = msm_dai_q6_dai_cdc_dma_remove,
  10169. },
  10170. {
  10171. .capture = {
  10172. .stream_name = "TX CDC DMA4 Capture",
  10173. .aif_name = "TX_CDC_DMA_TX_4",
  10174. .rates = SNDRV_PCM_RATE_8000 |
  10175. SNDRV_PCM_RATE_16000 |
  10176. SNDRV_PCM_RATE_32000 |
  10177. SNDRV_PCM_RATE_48000 |
  10178. SNDRV_PCM_RATE_96000 |
  10179. SNDRV_PCM_RATE_192000 |
  10180. SNDRV_PCM_RATE_384000,
  10181. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  10182. SNDRV_PCM_FMTBIT_S24_LE |
  10183. SNDRV_PCM_FMTBIT_S24_3LE |
  10184. SNDRV_PCM_FMTBIT_S32_LE,
  10185. .channels_min = 1,
  10186. .channels_max = 8,
  10187. .rate_min = 8000,
  10188. .rate_max = 384000,
  10189. },
  10190. .ops = &msm_dai_q6_cdc_dma_ops,
  10191. .id = AFE_PORT_ID_TX_CODEC_DMA_TX_4,
  10192. .probe = msm_dai_q6_dai_cdc_dma_probe,
  10193. .remove = msm_dai_q6_dai_cdc_dma_remove,
  10194. },
  10195. {
  10196. .playback = {
  10197. .stream_name = "RX CDC DMA5 Playback",
  10198. .aif_name = "RX_CDC_DMA_RX_5",
  10199. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  10200. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  10201. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  10202. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  10203. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  10204. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  10205. SNDRV_PCM_RATE_384000,
  10206. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  10207. SNDRV_PCM_FMTBIT_S24_LE |
  10208. SNDRV_PCM_FMTBIT_S24_3LE |
  10209. SNDRV_PCM_FMTBIT_S32_LE,
  10210. .channels_min = 1,
  10211. .channels_max = 1,
  10212. .rate_min = 8000,
  10213. .rate_max = 384000,
  10214. },
  10215. .ops = &msm_dai_q6_cdc_dma_ops,
  10216. .id = AFE_PORT_ID_RX_CODEC_DMA_RX_5,
  10217. .probe = msm_dai_q6_dai_cdc_dma_probe,
  10218. .remove = msm_dai_q6_dai_cdc_dma_remove,
  10219. },
  10220. {
  10221. .capture = {
  10222. .stream_name = "TX CDC DMA5 Capture",
  10223. .aif_name = "TX_CDC_DMA_TX_5",
  10224. .rates = SNDRV_PCM_RATE_8000 |
  10225. SNDRV_PCM_RATE_16000 |
  10226. SNDRV_PCM_RATE_32000 |
  10227. SNDRV_PCM_RATE_48000 |
  10228. SNDRV_PCM_RATE_96000 |
  10229. SNDRV_PCM_RATE_192000 |
  10230. SNDRV_PCM_RATE_384000,
  10231. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  10232. SNDRV_PCM_FMTBIT_S24_LE |
  10233. SNDRV_PCM_FMTBIT_S24_3LE |
  10234. SNDRV_PCM_FMTBIT_S32_LE,
  10235. .channels_min = 1,
  10236. .channels_max = 4,
  10237. .rate_min = 8000,
  10238. .rate_max = 384000,
  10239. },
  10240. .ops = &msm_dai_q6_cdc_dma_ops,
  10241. .id = AFE_PORT_ID_TX_CODEC_DMA_TX_5,
  10242. .probe = msm_dai_q6_dai_cdc_dma_probe,
  10243. .remove = msm_dai_q6_dai_cdc_dma_remove,
  10244. },
  10245. {
  10246. .playback = {
  10247. .stream_name = "RX CDC DMA6 Playback",
  10248. .aif_name = "RX_CDC_DMA_RX_6",
  10249. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  10250. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  10251. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  10252. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  10253. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  10254. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  10255. SNDRV_PCM_RATE_384000,
  10256. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  10257. SNDRV_PCM_FMTBIT_S24_LE |
  10258. SNDRV_PCM_FMTBIT_S24_3LE |
  10259. SNDRV_PCM_FMTBIT_S32_LE,
  10260. .channels_min = 1,
  10261. .channels_max = 4,
  10262. .rate_min = 8000,
  10263. .rate_max = 384000,
  10264. },
  10265. .ops = &msm_dai_q6_cdc_dma_ops,
  10266. .id = AFE_PORT_ID_RX_CODEC_DMA_RX_6,
  10267. .probe = msm_dai_q6_dai_cdc_dma_probe,
  10268. .remove = msm_dai_q6_dai_cdc_dma_remove,
  10269. },
  10270. {
  10271. .playback = {
  10272. .stream_name = "RX CDC DMA7 Playback",
  10273. .aif_name = "RX_CDC_DMA_RX_7",
  10274. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
  10275. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |
  10276. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  10277. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  10278. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  10279. SNDRV_PCM_RATE_192000 | SNDRV_PCM_RATE_352800 |
  10280. SNDRV_PCM_RATE_384000,
  10281. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  10282. SNDRV_PCM_FMTBIT_S24_LE |
  10283. SNDRV_PCM_FMTBIT_S24_3LE |
  10284. SNDRV_PCM_FMTBIT_S32_LE,
  10285. .channels_min = 1,
  10286. .channels_max = 2,
  10287. .rate_min = 8000,
  10288. .rate_max = 384000,
  10289. },
  10290. .ops = &msm_dai_q6_cdc_dma_ops,
  10291. .id = AFE_PORT_ID_RX_CODEC_DMA_RX_7,
  10292. .probe = msm_dai_q6_dai_cdc_dma_probe,
  10293. .remove = msm_dai_q6_dai_cdc_dma_remove,
  10294. },
  10295. };
  10296. static const struct snd_soc_component_driver msm_q6_cdc_dma_dai_component = {
  10297. .name = "msm-dai-cdc-dma-dev",
  10298. };
  10299. /* DT related probe for each codec DMA interface device */
  10300. static int msm_dai_q6_cdc_dma_dev_probe(struct platform_device *pdev)
  10301. {
  10302. const char *q6_cdc_dma_dev_id = "qcom,msm-dai-cdc-dma-dev-id";
  10303. u32 cdc_dma_id = 0;
  10304. int i;
  10305. int rc = 0;
  10306. struct msm_dai_q6_cdc_dma_dai_data *dai_data = NULL;
  10307. rc = of_property_read_u32(pdev->dev.of_node, q6_cdc_dma_dev_id,
  10308. &cdc_dma_id);
  10309. if (rc) {
  10310. dev_err(&pdev->dev,
  10311. "%s: missing 0x%x in dt node\n", __func__, cdc_dma_id);
  10312. return rc;
  10313. }
  10314. dev_dbg(&pdev->dev, "%s: dev name %s dev id 0x%x\n", __func__,
  10315. dev_name(&pdev->dev), cdc_dma_id);
  10316. pdev->id = cdc_dma_id;
  10317. dai_data = devm_kzalloc(&pdev->dev,
  10318. sizeof(struct msm_dai_q6_cdc_dma_dai_data),
  10319. GFP_KERNEL);
  10320. if (!dai_data)
  10321. return -ENOMEM;
  10322. rc = of_property_read_u32(pdev->dev.of_node,
  10323. "qcom,msm-dai-is-island-supported",
  10324. &dai_data->is_island_dai);
  10325. if (rc)
  10326. dev_dbg(&pdev->dev, "island supported entry not found\n");
  10327. dev_set_drvdata(&pdev->dev, dai_data);
  10328. for (i = 0; i < ARRAY_SIZE(msm_dai_q6_cdc_dma_dai); i++) {
  10329. if (msm_dai_q6_cdc_dma_dai[i].id == cdc_dma_id) {
  10330. return snd_soc_register_component(&pdev->dev,
  10331. &msm_q6_cdc_dma_dai_component,
  10332. &msm_dai_q6_cdc_dma_dai[i], 1);
  10333. }
  10334. }
  10335. return -ENODEV;
  10336. }
  10337. static int msm_dai_q6_cdc_dma_dev_remove(struct platform_device *pdev)
  10338. {
  10339. snd_soc_unregister_component(&pdev->dev);
  10340. return 0;
  10341. }
  10342. static const struct of_device_id msm_dai_q6_cdc_dma_dev_dt_match[] = {
  10343. { .compatible = "qcom,msm-dai-cdc-dma-dev", },
  10344. { }
  10345. };
  10346. MODULE_DEVICE_TABLE(of, msm_dai_q6_cdc_dma_dev_dt_match);
  10347. static struct platform_driver msm_dai_q6_cdc_dma_driver = {
  10348. .probe = msm_dai_q6_cdc_dma_dev_probe,
  10349. .remove = msm_dai_q6_cdc_dma_dev_remove,
  10350. .driver = {
  10351. .name = "msm-dai-cdc-dma-dev",
  10352. .owner = THIS_MODULE,
  10353. .of_match_table = msm_dai_q6_cdc_dma_dev_dt_match,
  10354. },
  10355. };
  10356. /* DT related probe for codec DMA interface device group */
  10357. static int msm_dai_cdc_dma_q6_probe(struct platform_device *pdev)
  10358. {
  10359. int rc;
  10360. rc = of_platform_populate(pdev->dev.of_node, NULL, NULL, &pdev->dev);
  10361. if (rc) {
  10362. dev_err(&pdev->dev, "%s: failed to add child nodes, rc=%d\n",
  10363. __func__, rc);
  10364. } else
  10365. dev_dbg(&pdev->dev, "%s: added child node\n", __func__);
  10366. return rc;
  10367. }
  10368. static int msm_dai_cdc_dma_q6_remove(struct platform_device *pdev)
  10369. {
  10370. of_platform_depopulate(&pdev->dev);
  10371. return 0;
  10372. }
  10373. static const struct of_device_id msm_dai_cdc_dma_dt_match[] = {
  10374. { .compatible = "qcom,msm-dai-cdc-dma", },
  10375. { }
  10376. };
  10377. MODULE_DEVICE_TABLE(of, msm_dai_cdc_dma_dt_match);
  10378. static struct platform_driver msm_dai_cdc_dma_q6 = {
  10379. .probe = msm_dai_cdc_dma_q6_probe,
  10380. .remove = msm_dai_cdc_dma_q6_remove,
  10381. .driver = {
  10382. .name = "msm-dai-cdc-dma",
  10383. .owner = THIS_MODULE,
  10384. .of_match_table = msm_dai_cdc_dma_dt_match,
  10385. },
  10386. };
  10387. int __init msm_dai_q6_init(void)
  10388. {
  10389. int rc;
  10390. rc = platform_driver_register(&msm_auxpcm_dev_driver);
  10391. if (rc) {
  10392. pr_err("%s: fail to register auxpcm dev driver", __func__);
  10393. goto fail;
  10394. }
  10395. rc = platform_driver_register(&msm_dai_q6);
  10396. if (rc) {
  10397. pr_err("%s: fail to register dai q6 driver", __func__);
  10398. goto dai_q6_fail;
  10399. }
  10400. rc = platform_driver_register(&msm_dai_q6_dev);
  10401. if (rc) {
  10402. pr_err("%s: fail to register dai q6 dev driver", __func__);
  10403. goto dai_q6_dev_fail;
  10404. }
  10405. rc = platform_driver_register(&msm_dai_q6_mi2s_driver);
  10406. if (rc) {
  10407. pr_err("%s: fail to register dai MI2S dev drv\n", __func__);
  10408. goto dai_q6_mi2s_drv_fail;
  10409. }
  10410. rc = platform_driver_register(&msm_dai_mi2s_q6);
  10411. if (rc) {
  10412. pr_err("%s: fail to register dai MI2S\n", __func__);
  10413. goto dai_mi2s_q6_fail;
  10414. }
  10415. rc = platform_driver_register(&msm_dai_q6_spdif_driver);
  10416. if (rc) {
  10417. pr_err("%s: fail to register dai SPDIF\n", __func__);
  10418. goto dai_spdif_q6_fail;
  10419. }
  10420. rc = platform_driver_register(&msm_dai_q6_tdm_driver);
  10421. if (rc) {
  10422. pr_err("%s: fail to register dai TDM dev drv\n", __func__);
  10423. goto dai_q6_tdm_drv_fail;
  10424. }
  10425. rc = platform_driver_register(&msm_dai_tdm_q6);
  10426. if (rc) {
  10427. pr_err("%s: fail to register dai TDM\n", __func__);
  10428. goto dai_tdm_q6_fail;
  10429. }
  10430. rc = platform_driver_register(&msm_dai_q6_cdc_dma_driver);
  10431. if (rc) {
  10432. pr_err("%s: fail to register dai CDC DMA dev\n", __func__);
  10433. goto dai_cdc_dma_q6_dev_fail;
  10434. }
  10435. rc = platform_driver_register(&msm_dai_cdc_dma_q6);
  10436. if (rc) {
  10437. pr_err("%s: fail to register dai CDC DMA\n", __func__);
  10438. goto dai_cdc_dma_q6_fail;
  10439. }
  10440. return rc;
  10441. dai_cdc_dma_q6_fail:
  10442. platform_driver_unregister(&msm_dai_q6_cdc_dma_driver);
  10443. dai_cdc_dma_q6_dev_fail:
  10444. platform_driver_unregister(&msm_dai_tdm_q6);
  10445. dai_tdm_q6_fail:
  10446. platform_driver_unregister(&msm_dai_q6_tdm_driver);
  10447. dai_q6_tdm_drv_fail:
  10448. platform_driver_unregister(&msm_dai_q6_spdif_driver);
  10449. dai_spdif_q6_fail:
  10450. platform_driver_unregister(&msm_dai_mi2s_q6);
  10451. dai_mi2s_q6_fail:
  10452. platform_driver_unregister(&msm_dai_q6_mi2s_driver);
  10453. dai_q6_mi2s_drv_fail:
  10454. platform_driver_unregister(&msm_dai_q6_dev);
  10455. dai_q6_dev_fail:
  10456. platform_driver_unregister(&msm_dai_q6);
  10457. dai_q6_fail:
  10458. platform_driver_unregister(&msm_auxpcm_dev_driver);
  10459. fail:
  10460. return rc;
  10461. }
  10462. void msm_dai_q6_exit(void)
  10463. {
  10464. platform_driver_unregister(&msm_dai_cdc_dma_q6);
  10465. platform_driver_unregister(&msm_dai_q6_cdc_dma_driver);
  10466. platform_driver_unregister(&msm_dai_tdm_q6);
  10467. platform_driver_unregister(&msm_dai_q6_tdm_driver);
  10468. platform_driver_unregister(&msm_dai_q6_spdif_driver);
  10469. platform_driver_unregister(&msm_dai_mi2s_q6);
  10470. platform_driver_unregister(&msm_dai_q6_mi2s_driver);
  10471. platform_driver_unregister(&msm_dai_q6_dev);
  10472. platform_driver_unregister(&msm_dai_q6);
  10473. platform_driver_unregister(&msm_auxpcm_dev_driver);
  10474. }
  10475. /* Module information */
  10476. MODULE_DESCRIPTION("MSM DSP DAI driver");
  10477. MODULE_LICENSE("GPL v2");