msm-dai-q6-v2.c 267 KB

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