msm-dai-q6-v2.c 240 KB

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