ipc3-topology.c 76 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517
  1. // SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)
  2. //
  3. // This file is provided under a dual BSD/GPLv2 license. When using or
  4. // redistributing this file, you may do so under either license.
  5. //
  6. // Copyright(c) 2021 Intel Corporation. All rights reserved.
  7. //
  8. //
  9. #include <uapi/sound/sof/tokens.h>
  10. #include <sound/pcm_params.h>
  11. #include "sof-priv.h"
  12. #include "sof-audio.h"
  13. #include "ipc3-priv.h"
  14. #include "ops.h"
  15. /* Full volume for default values */
  16. #define VOL_ZERO_DB BIT(VOLUME_FWL)
  17. /* size of tplg ABI in bytes */
  18. #define SOF_IPC3_TPLG_ABI_SIZE 3
  19. struct sof_widget_data {
  20. int ctrl_type;
  21. int ipc_cmd;
  22. void *pdata;
  23. size_t pdata_size;
  24. struct snd_sof_control *control;
  25. };
  26. struct sof_process_types {
  27. const char *name;
  28. enum sof_ipc_process_type type;
  29. enum sof_comp_type comp_type;
  30. };
  31. static const struct sof_process_types sof_process[] = {
  32. {"EQFIR", SOF_PROCESS_EQFIR, SOF_COMP_EQ_FIR},
  33. {"EQIIR", SOF_PROCESS_EQIIR, SOF_COMP_EQ_IIR},
  34. {"KEYWORD_DETECT", SOF_PROCESS_KEYWORD_DETECT, SOF_COMP_KEYWORD_DETECT},
  35. {"KPB", SOF_PROCESS_KPB, SOF_COMP_KPB},
  36. {"CHAN_SELECTOR", SOF_PROCESS_CHAN_SELECTOR, SOF_COMP_SELECTOR},
  37. {"MUX", SOF_PROCESS_MUX, SOF_COMP_MUX},
  38. {"DEMUX", SOF_PROCESS_DEMUX, SOF_COMP_DEMUX},
  39. {"DCBLOCK", SOF_PROCESS_DCBLOCK, SOF_COMP_DCBLOCK},
  40. {"SMART_AMP", SOF_PROCESS_SMART_AMP, SOF_COMP_SMART_AMP},
  41. };
  42. static enum sof_ipc_process_type find_process(const char *name)
  43. {
  44. int i;
  45. for (i = 0; i < ARRAY_SIZE(sof_process); i++) {
  46. if (strcmp(name, sof_process[i].name) == 0)
  47. return sof_process[i].type;
  48. }
  49. return SOF_PROCESS_NONE;
  50. }
  51. static int get_token_process_type(void *elem, void *object, u32 offset)
  52. {
  53. u32 *val = (u32 *)((u8 *)object + offset);
  54. *val = find_process((const char *)elem);
  55. return 0;
  56. }
  57. /* Buffers */
  58. static const struct sof_topology_token buffer_tokens[] = {
  59. {SOF_TKN_BUF_SIZE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  60. offsetof(struct sof_ipc_buffer, size)},
  61. {SOF_TKN_BUF_CAPS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  62. offsetof(struct sof_ipc_buffer, caps)},
  63. };
  64. /* DAI */
  65. static const struct sof_topology_token dai_tokens[] = {
  66. {SOF_TKN_DAI_TYPE, SND_SOC_TPLG_TUPLE_TYPE_STRING, get_token_dai_type,
  67. offsetof(struct sof_ipc_comp_dai, type)},
  68. {SOF_TKN_DAI_INDEX, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  69. offsetof(struct sof_ipc_comp_dai, dai_index)},
  70. {SOF_TKN_DAI_DIRECTION, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  71. offsetof(struct sof_ipc_comp_dai, direction)},
  72. };
  73. /* BE DAI link */
  74. static const struct sof_topology_token dai_link_tokens[] = {
  75. {SOF_TKN_DAI_TYPE, SND_SOC_TPLG_TUPLE_TYPE_STRING, get_token_dai_type,
  76. offsetof(struct sof_ipc_dai_config, type)},
  77. {SOF_TKN_DAI_INDEX, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  78. offsetof(struct sof_ipc_dai_config, dai_index)},
  79. };
  80. /* scheduling */
  81. static const struct sof_topology_token sched_tokens[] = {
  82. {SOF_TKN_SCHED_PERIOD, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  83. offsetof(struct sof_ipc_pipe_new, period)},
  84. {SOF_TKN_SCHED_PRIORITY, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  85. offsetof(struct sof_ipc_pipe_new, priority)},
  86. {SOF_TKN_SCHED_MIPS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  87. offsetof(struct sof_ipc_pipe_new, period_mips)},
  88. {SOF_TKN_SCHED_CORE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  89. offsetof(struct sof_ipc_pipe_new, core)},
  90. {SOF_TKN_SCHED_FRAMES, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  91. offsetof(struct sof_ipc_pipe_new, frames_per_sched)},
  92. {SOF_TKN_SCHED_TIME_DOMAIN, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  93. offsetof(struct sof_ipc_pipe_new, time_domain)},
  94. };
  95. static const struct sof_topology_token pipeline_tokens[] = {
  96. {SOF_TKN_SCHED_DYNAMIC_PIPELINE, SND_SOC_TPLG_TUPLE_TYPE_BOOL, get_token_u16,
  97. offsetof(struct snd_sof_widget, dynamic_pipeline_widget)},
  98. };
  99. /* volume */
  100. static const struct sof_topology_token volume_tokens[] = {
  101. {SOF_TKN_VOLUME_RAMP_STEP_TYPE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  102. offsetof(struct sof_ipc_comp_volume, ramp)},
  103. {SOF_TKN_VOLUME_RAMP_STEP_MS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  104. offsetof(struct sof_ipc_comp_volume, initial_ramp)},
  105. };
  106. /* SRC */
  107. static const struct sof_topology_token src_tokens[] = {
  108. {SOF_TKN_SRC_RATE_IN, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  109. offsetof(struct sof_ipc_comp_src, source_rate)},
  110. {SOF_TKN_SRC_RATE_OUT, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  111. offsetof(struct sof_ipc_comp_src, sink_rate)},
  112. };
  113. /* ASRC */
  114. static const struct sof_topology_token asrc_tokens[] = {
  115. {SOF_TKN_ASRC_RATE_IN, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  116. offsetof(struct sof_ipc_comp_asrc, source_rate)},
  117. {SOF_TKN_ASRC_RATE_OUT, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  118. offsetof(struct sof_ipc_comp_asrc, sink_rate)},
  119. {SOF_TKN_ASRC_ASYNCHRONOUS_MODE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  120. offsetof(struct sof_ipc_comp_asrc, asynchronous_mode)},
  121. {SOF_TKN_ASRC_OPERATION_MODE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  122. offsetof(struct sof_ipc_comp_asrc, operation_mode)},
  123. };
  124. /* EFFECT */
  125. static const struct sof_topology_token process_tokens[] = {
  126. {SOF_TKN_PROCESS_TYPE, SND_SOC_TPLG_TUPLE_TYPE_STRING, get_token_process_type,
  127. offsetof(struct sof_ipc_comp_process, type)},
  128. };
  129. /* PCM */
  130. static const struct sof_topology_token pcm_tokens[] = {
  131. {SOF_TKN_PCM_DMAC_CONFIG, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  132. offsetof(struct sof_ipc_comp_host, dmac_config)},
  133. };
  134. /* Generic components */
  135. static const struct sof_topology_token comp_tokens[] = {
  136. {SOF_TKN_COMP_PERIOD_SINK_COUNT, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  137. offsetof(struct sof_ipc_comp_config, periods_sink)},
  138. {SOF_TKN_COMP_PERIOD_SOURCE_COUNT, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  139. offsetof(struct sof_ipc_comp_config, periods_source)},
  140. {SOF_TKN_COMP_FORMAT,
  141. SND_SOC_TPLG_TUPLE_TYPE_STRING, get_token_comp_format,
  142. offsetof(struct sof_ipc_comp_config, frame_fmt)},
  143. };
  144. /* SSP */
  145. static const struct sof_topology_token ssp_tokens[] = {
  146. {SOF_TKN_INTEL_SSP_CLKS_CONTROL, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  147. offsetof(struct sof_ipc_dai_ssp_params, clks_control)},
  148. {SOF_TKN_INTEL_SSP_MCLK_ID, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
  149. offsetof(struct sof_ipc_dai_ssp_params, mclk_id)},
  150. {SOF_TKN_INTEL_SSP_SAMPLE_BITS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  151. offsetof(struct sof_ipc_dai_ssp_params, sample_valid_bits)},
  152. {SOF_TKN_INTEL_SSP_FRAME_PULSE_WIDTH, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
  153. offsetof(struct sof_ipc_dai_ssp_params, frame_pulse_width)},
  154. {SOF_TKN_INTEL_SSP_QUIRKS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  155. offsetof(struct sof_ipc_dai_ssp_params, quirks)},
  156. {SOF_TKN_INTEL_SSP_TDM_PADDING_PER_SLOT, SND_SOC_TPLG_TUPLE_TYPE_BOOL, get_token_u16,
  157. offsetof(struct sof_ipc_dai_ssp_params, tdm_per_slot_padding_flag)},
  158. {SOF_TKN_INTEL_SSP_BCLK_DELAY, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  159. offsetof(struct sof_ipc_dai_ssp_params, bclk_delay)},
  160. };
  161. /* ALH */
  162. static const struct sof_topology_token alh_tokens[] = {
  163. {SOF_TKN_INTEL_ALH_RATE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  164. offsetof(struct sof_ipc_dai_alh_params, rate)},
  165. {SOF_TKN_INTEL_ALH_CH, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  166. offsetof(struct sof_ipc_dai_alh_params, channels)},
  167. };
  168. /* DMIC */
  169. static const struct sof_topology_token dmic_tokens[] = {
  170. {SOF_TKN_INTEL_DMIC_DRIVER_VERSION, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  171. offsetof(struct sof_ipc_dai_dmic_params, driver_ipc_version)},
  172. {SOF_TKN_INTEL_DMIC_CLK_MIN, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  173. offsetof(struct sof_ipc_dai_dmic_params, pdmclk_min)},
  174. {SOF_TKN_INTEL_DMIC_CLK_MAX, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  175. offsetof(struct sof_ipc_dai_dmic_params, pdmclk_max)},
  176. {SOF_TKN_INTEL_DMIC_SAMPLE_RATE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  177. offsetof(struct sof_ipc_dai_dmic_params, fifo_fs)},
  178. {SOF_TKN_INTEL_DMIC_DUTY_MIN, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
  179. offsetof(struct sof_ipc_dai_dmic_params, duty_min)},
  180. {SOF_TKN_INTEL_DMIC_DUTY_MAX, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
  181. offsetof(struct sof_ipc_dai_dmic_params, duty_max)},
  182. {SOF_TKN_INTEL_DMIC_NUM_PDM_ACTIVE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  183. offsetof(struct sof_ipc_dai_dmic_params, num_pdm_active)},
  184. {SOF_TKN_INTEL_DMIC_FIFO_WORD_LENGTH, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
  185. offsetof(struct sof_ipc_dai_dmic_params, fifo_bits)},
  186. {SOF_TKN_INTEL_DMIC_UNMUTE_RAMP_TIME_MS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  187. offsetof(struct sof_ipc_dai_dmic_params, unmute_ramp_time)},
  188. };
  189. /* ESAI */
  190. static const struct sof_topology_token esai_tokens[] = {
  191. {SOF_TKN_IMX_ESAI_MCLK_ID, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
  192. offsetof(struct sof_ipc_dai_esai_params, mclk_id)},
  193. };
  194. /* SAI */
  195. static const struct sof_topology_token sai_tokens[] = {
  196. {SOF_TKN_IMX_SAI_MCLK_ID, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
  197. offsetof(struct sof_ipc_dai_sai_params, mclk_id)},
  198. };
  199. /*
  200. * DMIC PDM Tokens
  201. * SOF_TKN_INTEL_DMIC_PDM_CTRL_ID should be the first token
  202. * as it increments the index while parsing the array of pdm tokens
  203. * and determines the correct offset
  204. */
  205. static const struct sof_topology_token dmic_pdm_tokens[] = {
  206. {SOF_TKN_INTEL_DMIC_PDM_CTRL_ID, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
  207. offsetof(struct sof_ipc_dai_dmic_pdm_ctrl, id)},
  208. {SOF_TKN_INTEL_DMIC_PDM_MIC_A_Enable, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
  209. offsetof(struct sof_ipc_dai_dmic_pdm_ctrl, enable_mic_a)},
  210. {SOF_TKN_INTEL_DMIC_PDM_MIC_B_Enable, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
  211. offsetof(struct sof_ipc_dai_dmic_pdm_ctrl, enable_mic_b)},
  212. {SOF_TKN_INTEL_DMIC_PDM_POLARITY_A, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
  213. offsetof(struct sof_ipc_dai_dmic_pdm_ctrl, polarity_mic_a)},
  214. {SOF_TKN_INTEL_DMIC_PDM_POLARITY_B, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
  215. offsetof(struct sof_ipc_dai_dmic_pdm_ctrl, polarity_mic_b)},
  216. {SOF_TKN_INTEL_DMIC_PDM_CLK_EDGE, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
  217. offsetof(struct sof_ipc_dai_dmic_pdm_ctrl, clk_edge)},
  218. {SOF_TKN_INTEL_DMIC_PDM_SKEW, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
  219. offsetof(struct sof_ipc_dai_dmic_pdm_ctrl, skew)},
  220. };
  221. /* HDA */
  222. static const struct sof_topology_token hda_tokens[] = {
  223. {SOF_TKN_INTEL_HDA_RATE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  224. offsetof(struct sof_ipc_dai_hda_params, rate)},
  225. {SOF_TKN_INTEL_HDA_CH, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  226. offsetof(struct sof_ipc_dai_hda_params, channels)},
  227. };
  228. /* AFE */
  229. static const struct sof_topology_token afe_tokens[] = {
  230. {SOF_TKN_MEDIATEK_AFE_RATE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  231. offsetof(struct sof_ipc_dai_mtk_afe_params, rate)},
  232. {SOF_TKN_MEDIATEK_AFE_CH, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  233. offsetof(struct sof_ipc_dai_mtk_afe_params, channels)},
  234. {SOF_TKN_MEDIATEK_AFE_FORMAT, SND_SOC_TPLG_TUPLE_TYPE_STRING, get_token_comp_format,
  235. offsetof(struct sof_ipc_dai_mtk_afe_params, format)},
  236. };
  237. /* ACPDMIC */
  238. static const struct sof_topology_token acpdmic_tokens[] = {
  239. {SOF_TKN_AMD_ACPDMIC_RATE,
  240. SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  241. offsetof(struct sof_ipc_dai_acpdmic_params, pdm_rate)},
  242. {SOF_TKN_AMD_ACPDMIC_CH,
  243. SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  244. offsetof(struct sof_ipc_dai_acpdmic_params, pdm_ch)},
  245. };
  246. /* Core tokens */
  247. static const struct sof_topology_token core_tokens[] = {
  248. {SOF_TKN_COMP_CORE_ID, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
  249. offsetof(struct sof_ipc_comp, core)},
  250. };
  251. /* Component extended tokens */
  252. static const struct sof_topology_token comp_ext_tokens[] = {
  253. {SOF_TKN_COMP_UUID, SND_SOC_TPLG_TUPLE_TYPE_UUID, get_token_uuid,
  254. offsetof(struct snd_sof_widget, uuid)},
  255. };
  256. static const struct sof_token_info ipc3_token_list[SOF_TOKEN_COUNT] = {
  257. [SOF_PCM_TOKENS] = {"PCM tokens", pcm_tokens, ARRAY_SIZE(pcm_tokens)},
  258. [SOF_PIPELINE_TOKENS] = {"Pipeline tokens", pipeline_tokens, ARRAY_SIZE(pipeline_tokens)},
  259. [SOF_SCHED_TOKENS] = {"Scheduler tokens", sched_tokens, ARRAY_SIZE(sched_tokens)},
  260. [SOF_COMP_TOKENS] = {"Comp tokens", comp_tokens, ARRAY_SIZE(comp_tokens)},
  261. [SOF_CORE_TOKENS] = {"Core tokens", core_tokens, ARRAY_SIZE(core_tokens)},
  262. [SOF_COMP_EXT_TOKENS] = {"AFE tokens", comp_ext_tokens, ARRAY_SIZE(comp_ext_tokens)},
  263. [SOF_BUFFER_TOKENS] = {"Buffer tokens", buffer_tokens, ARRAY_SIZE(buffer_tokens)},
  264. [SOF_VOLUME_TOKENS] = {"Volume tokens", volume_tokens, ARRAY_SIZE(volume_tokens)},
  265. [SOF_SRC_TOKENS] = {"SRC tokens", src_tokens, ARRAY_SIZE(src_tokens)},
  266. [SOF_ASRC_TOKENS] = {"ASRC tokens", asrc_tokens, ARRAY_SIZE(asrc_tokens)},
  267. [SOF_PROCESS_TOKENS] = {"Process tokens", process_tokens, ARRAY_SIZE(process_tokens)},
  268. [SOF_DAI_TOKENS] = {"DAI tokens", dai_tokens, ARRAY_SIZE(dai_tokens)},
  269. [SOF_DAI_LINK_TOKENS] = {"DAI link tokens", dai_link_tokens, ARRAY_SIZE(dai_link_tokens)},
  270. [SOF_HDA_TOKENS] = {"HDA tokens", hda_tokens, ARRAY_SIZE(hda_tokens)},
  271. [SOF_SSP_TOKENS] = {"SSP tokens", ssp_tokens, ARRAY_SIZE(ssp_tokens)},
  272. [SOF_ALH_TOKENS] = {"ALH tokens", alh_tokens, ARRAY_SIZE(alh_tokens)},
  273. [SOF_DMIC_TOKENS] = {"DMIC tokens", dmic_tokens, ARRAY_SIZE(dmic_tokens)},
  274. [SOF_DMIC_PDM_TOKENS] = {"DMIC PDM tokens", dmic_pdm_tokens, ARRAY_SIZE(dmic_pdm_tokens)},
  275. [SOF_ESAI_TOKENS] = {"ESAI tokens", esai_tokens, ARRAY_SIZE(esai_tokens)},
  276. [SOF_SAI_TOKENS] = {"SAI tokens", sai_tokens, ARRAY_SIZE(sai_tokens)},
  277. [SOF_AFE_TOKENS] = {"AFE tokens", afe_tokens, ARRAY_SIZE(afe_tokens)},
  278. [SOF_ACPDMIC_TOKENS] = {"ACPDMIC tokens", acpdmic_tokens, ARRAY_SIZE(acpdmic_tokens)},
  279. };
  280. /**
  281. * sof_comp_alloc - allocate and initialize buffer for a new component
  282. * @swidget: pointer to struct snd_sof_widget containing extended data
  283. * @ipc_size: IPC payload size that will be updated depending on valid
  284. * extended data.
  285. * @index: ID of the pipeline the component belongs to
  286. *
  287. * Return: The pointer to the new allocated component, NULL if failed.
  288. */
  289. static void *sof_comp_alloc(struct snd_sof_widget *swidget, size_t *ipc_size,
  290. int index)
  291. {
  292. struct sof_ipc_comp *comp;
  293. size_t total_size = *ipc_size;
  294. size_t ext_size = sizeof(swidget->uuid);
  295. /* only non-zero UUID is valid */
  296. if (!guid_is_null(&swidget->uuid))
  297. total_size += ext_size;
  298. comp = kzalloc(total_size, GFP_KERNEL);
  299. if (!comp)
  300. return NULL;
  301. /* configure comp new IPC message */
  302. comp->hdr.size = total_size;
  303. comp->hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_COMP_NEW;
  304. comp->id = swidget->comp_id;
  305. comp->pipeline_id = index;
  306. comp->core = swidget->core;
  307. /* handle the extended data if needed */
  308. if (total_size > *ipc_size) {
  309. /* append extended data to the end of the component */
  310. memcpy((u8 *)comp + *ipc_size, &swidget->uuid, ext_size);
  311. comp->ext_data_length = ext_size;
  312. }
  313. /* update ipc_size and return */
  314. *ipc_size = total_size;
  315. return comp;
  316. }
  317. static void sof_dbg_comp_config(struct snd_soc_component *scomp, struct sof_ipc_comp_config *config)
  318. {
  319. dev_dbg(scomp->dev, " config: periods snk %d src %d fmt %d\n",
  320. config->periods_sink, config->periods_source,
  321. config->frame_fmt);
  322. }
  323. static int sof_ipc3_widget_setup_comp_host(struct snd_sof_widget *swidget)
  324. {
  325. struct snd_soc_component *scomp = swidget->scomp;
  326. struct sof_ipc_comp_host *host;
  327. size_t ipc_size = sizeof(*host);
  328. int ret;
  329. host = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
  330. if (!host)
  331. return -ENOMEM;
  332. swidget->private = host;
  333. /* configure host comp IPC message */
  334. host->comp.type = SOF_COMP_HOST;
  335. host->config.hdr.size = sizeof(host->config);
  336. if (swidget->id == snd_soc_dapm_aif_out)
  337. host->direction = SOF_IPC_STREAM_CAPTURE;
  338. else
  339. host->direction = SOF_IPC_STREAM_PLAYBACK;
  340. /* parse one set of pcm_tokens */
  341. ret = sof_update_ipc_object(scomp, host, SOF_PCM_TOKENS, swidget->tuples,
  342. swidget->num_tuples, sizeof(*host), 1);
  343. if (ret < 0)
  344. goto err;
  345. /* parse one set of comp_tokens */
  346. ret = sof_update_ipc_object(scomp, &host->config, SOF_COMP_TOKENS, swidget->tuples,
  347. swidget->num_tuples, sizeof(host->config), 1);
  348. if (ret < 0)
  349. goto err;
  350. dev_dbg(scomp->dev, "loaded host %s\n", swidget->widget->name);
  351. sof_dbg_comp_config(scomp, &host->config);
  352. return 0;
  353. err:
  354. kfree(swidget->private);
  355. swidget->private = NULL;
  356. return ret;
  357. }
  358. static void sof_ipc3_widget_free_comp(struct snd_sof_widget *swidget)
  359. {
  360. kfree(swidget->private);
  361. }
  362. static int sof_ipc3_widget_setup_comp_tone(struct snd_sof_widget *swidget)
  363. {
  364. struct snd_soc_component *scomp = swidget->scomp;
  365. struct sof_ipc_comp_tone *tone;
  366. size_t ipc_size = sizeof(*tone);
  367. int ret;
  368. tone = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
  369. if (!tone)
  370. return -ENOMEM;
  371. swidget->private = tone;
  372. /* configure siggen IPC message */
  373. tone->comp.type = SOF_COMP_TONE;
  374. tone->config.hdr.size = sizeof(tone->config);
  375. /* parse one set of comp tokens */
  376. ret = sof_update_ipc_object(scomp, &tone->config, SOF_COMP_TOKENS, swidget->tuples,
  377. swidget->num_tuples, sizeof(tone->config), 1);
  378. if (ret < 0) {
  379. kfree(swidget->private);
  380. swidget->private = NULL;
  381. return ret;
  382. }
  383. dev_dbg(scomp->dev, "tone %s: frequency %d amplitude %d\n",
  384. swidget->widget->name, tone->frequency, tone->amplitude);
  385. sof_dbg_comp_config(scomp, &tone->config);
  386. return 0;
  387. }
  388. static int sof_ipc3_widget_setup_comp_mixer(struct snd_sof_widget *swidget)
  389. {
  390. struct snd_soc_component *scomp = swidget->scomp;
  391. struct sof_ipc_comp_mixer *mixer;
  392. size_t ipc_size = sizeof(*mixer);
  393. int ret;
  394. mixer = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
  395. if (!mixer)
  396. return -ENOMEM;
  397. swidget->private = mixer;
  398. /* configure mixer IPC message */
  399. mixer->comp.type = SOF_COMP_MIXER;
  400. mixer->config.hdr.size = sizeof(mixer->config);
  401. /* parse one set of comp tokens */
  402. ret = sof_update_ipc_object(scomp, &mixer->config, SOF_COMP_TOKENS,
  403. swidget->tuples, swidget->num_tuples,
  404. sizeof(mixer->config), 1);
  405. if (ret < 0) {
  406. kfree(swidget->private);
  407. swidget->private = NULL;
  408. return ret;
  409. }
  410. dev_dbg(scomp->dev, "loaded mixer %s\n", swidget->widget->name);
  411. sof_dbg_comp_config(scomp, &mixer->config);
  412. return 0;
  413. }
  414. static int sof_ipc3_widget_setup_comp_pipeline(struct snd_sof_widget *swidget)
  415. {
  416. struct snd_soc_component *scomp = swidget->scomp;
  417. struct sof_ipc_pipe_new *pipeline;
  418. struct snd_sof_widget *comp_swidget;
  419. int ret;
  420. pipeline = kzalloc(sizeof(*pipeline), GFP_KERNEL);
  421. if (!pipeline)
  422. return -ENOMEM;
  423. /* configure pipeline IPC message */
  424. pipeline->hdr.size = sizeof(*pipeline);
  425. pipeline->hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_PIPE_NEW;
  426. pipeline->pipeline_id = swidget->pipeline_id;
  427. pipeline->comp_id = swidget->comp_id;
  428. swidget->private = pipeline;
  429. /* component at start of pipeline is our stream id */
  430. comp_swidget = snd_sof_find_swidget(scomp, swidget->widget->sname);
  431. if (!comp_swidget) {
  432. dev_err(scomp->dev, "scheduler %s refers to non existent widget %s\n",
  433. swidget->widget->name, swidget->widget->sname);
  434. ret = -EINVAL;
  435. goto err;
  436. }
  437. pipeline->sched_id = comp_swidget->comp_id;
  438. /* parse one set of scheduler tokens */
  439. ret = sof_update_ipc_object(scomp, pipeline, SOF_SCHED_TOKENS, swidget->tuples,
  440. swidget->num_tuples, sizeof(*pipeline), 1);
  441. if (ret < 0)
  442. goto err;
  443. /* parse one set of pipeline tokens */
  444. ret = sof_update_ipc_object(scomp, swidget, SOF_PIPELINE_TOKENS, swidget->tuples,
  445. swidget->num_tuples, sizeof(*swidget), 1);
  446. if (ret < 0)
  447. goto err;
  448. if (sof_debug_check_flag(SOF_DBG_DISABLE_MULTICORE))
  449. pipeline->core = SOF_DSP_PRIMARY_CORE;
  450. if (sof_debug_check_flag(SOF_DBG_DYNAMIC_PIPELINES_OVERRIDE))
  451. swidget->dynamic_pipeline_widget =
  452. sof_debug_check_flag(SOF_DBG_DYNAMIC_PIPELINES_ENABLE);
  453. dev_dbg(scomp->dev, "pipeline %s: period %d pri %d mips %d core %d frames %d dynamic %d\n",
  454. swidget->widget->name, pipeline->period, pipeline->priority,
  455. pipeline->period_mips, pipeline->core, pipeline->frames_per_sched,
  456. swidget->dynamic_pipeline_widget);
  457. swidget->core = pipeline->core;
  458. return 0;
  459. err:
  460. kfree(swidget->private);
  461. swidget->private = NULL;
  462. return ret;
  463. }
  464. static int sof_ipc3_widget_setup_comp_buffer(struct snd_sof_widget *swidget)
  465. {
  466. struct snd_soc_component *scomp = swidget->scomp;
  467. struct sof_ipc_buffer *buffer;
  468. int ret;
  469. buffer = kzalloc(sizeof(*buffer), GFP_KERNEL);
  470. if (!buffer)
  471. return -ENOMEM;
  472. swidget->private = buffer;
  473. /* configure dai IPC message */
  474. buffer->comp.hdr.size = sizeof(*buffer);
  475. buffer->comp.hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_BUFFER_NEW;
  476. buffer->comp.id = swidget->comp_id;
  477. buffer->comp.type = SOF_COMP_BUFFER;
  478. buffer->comp.pipeline_id = swidget->pipeline_id;
  479. buffer->comp.core = swidget->core;
  480. /* parse one set of buffer tokens */
  481. ret = sof_update_ipc_object(scomp, buffer, SOF_BUFFER_TOKENS, swidget->tuples,
  482. swidget->num_tuples, sizeof(*buffer), 1);
  483. if (ret < 0) {
  484. kfree(swidget->private);
  485. swidget->private = NULL;
  486. return ret;
  487. }
  488. dev_dbg(scomp->dev, "buffer %s: size %d caps 0x%x\n",
  489. swidget->widget->name, buffer->size, buffer->caps);
  490. return 0;
  491. }
  492. static int sof_ipc3_widget_setup_comp_src(struct snd_sof_widget *swidget)
  493. {
  494. struct snd_soc_component *scomp = swidget->scomp;
  495. struct sof_ipc_comp_src *src;
  496. size_t ipc_size = sizeof(*src);
  497. int ret;
  498. src = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
  499. if (!src)
  500. return -ENOMEM;
  501. swidget->private = src;
  502. /* configure src IPC message */
  503. src->comp.type = SOF_COMP_SRC;
  504. src->config.hdr.size = sizeof(src->config);
  505. /* parse one set of src tokens */
  506. ret = sof_update_ipc_object(scomp, src, SOF_SRC_TOKENS, swidget->tuples,
  507. swidget->num_tuples, sizeof(*src), 1);
  508. if (ret < 0)
  509. goto err;
  510. /* parse one set of comp tokens */
  511. ret = sof_update_ipc_object(scomp, &src->config, SOF_COMP_TOKENS,
  512. swidget->tuples, swidget->num_tuples, sizeof(src->config), 1);
  513. if (ret < 0)
  514. goto err;
  515. dev_dbg(scomp->dev, "src %s: source rate %d sink rate %d\n",
  516. swidget->widget->name, src->source_rate, src->sink_rate);
  517. sof_dbg_comp_config(scomp, &src->config);
  518. return 0;
  519. err:
  520. kfree(swidget->private);
  521. swidget->private = NULL;
  522. return ret;
  523. }
  524. static int sof_ipc3_widget_setup_comp_asrc(struct snd_sof_widget *swidget)
  525. {
  526. struct snd_soc_component *scomp = swidget->scomp;
  527. struct sof_ipc_comp_asrc *asrc;
  528. size_t ipc_size = sizeof(*asrc);
  529. int ret;
  530. asrc = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
  531. if (!asrc)
  532. return -ENOMEM;
  533. swidget->private = asrc;
  534. /* configure ASRC IPC message */
  535. asrc->comp.type = SOF_COMP_ASRC;
  536. asrc->config.hdr.size = sizeof(asrc->config);
  537. /* parse one set of asrc tokens */
  538. ret = sof_update_ipc_object(scomp, asrc, SOF_ASRC_TOKENS, swidget->tuples,
  539. swidget->num_tuples, sizeof(*asrc), 1);
  540. if (ret < 0)
  541. goto err;
  542. /* parse one set of comp tokens */
  543. ret = sof_update_ipc_object(scomp, &asrc->config, SOF_COMP_TOKENS,
  544. swidget->tuples, swidget->num_tuples, sizeof(asrc->config), 1);
  545. if (ret < 0)
  546. goto err;
  547. dev_dbg(scomp->dev, "asrc %s: source rate %d sink rate %d asynch %d operation %d\n",
  548. swidget->widget->name, asrc->source_rate, asrc->sink_rate,
  549. asrc->asynchronous_mode, asrc->operation_mode);
  550. sof_dbg_comp_config(scomp, &asrc->config);
  551. return 0;
  552. err:
  553. kfree(swidget->private);
  554. swidget->private = NULL;
  555. return ret;
  556. }
  557. /*
  558. * Mux topology
  559. */
  560. static int sof_ipc3_widget_setup_comp_mux(struct snd_sof_widget *swidget)
  561. {
  562. struct snd_soc_component *scomp = swidget->scomp;
  563. struct sof_ipc_comp_mux *mux;
  564. size_t ipc_size = sizeof(*mux);
  565. int ret;
  566. mux = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
  567. if (!mux)
  568. return -ENOMEM;
  569. swidget->private = mux;
  570. /* configure mux IPC message */
  571. mux->comp.type = SOF_COMP_MUX;
  572. mux->config.hdr.size = sizeof(mux->config);
  573. /* parse one set of comp tokens */
  574. ret = sof_update_ipc_object(scomp, &mux->config, SOF_COMP_TOKENS,
  575. swidget->tuples, swidget->num_tuples, sizeof(mux->config), 1);
  576. if (ret < 0) {
  577. kfree(swidget->private);
  578. swidget->private = NULL;
  579. return ret;
  580. }
  581. dev_dbg(scomp->dev, "loaded mux %s\n", swidget->widget->name);
  582. sof_dbg_comp_config(scomp, &mux->config);
  583. return 0;
  584. }
  585. /*
  586. * PGA Topology
  587. */
  588. static int sof_ipc3_widget_setup_comp_pga(struct snd_sof_widget *swidget)
  589. {
  590. struct snd_soc_component *scomp = swidget->scomp;
  591. struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
  592. struct sof_ipc_comp_volume *volume;
  593. struct snd_sof_control *scontrol;
  594. size_t ipc_size = sizeof(*volume);
  595. int min_step, max_step;
  596. int ret;
  597. volume = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
  598. if (!volume)
  599. return -ENOMEM;
  600. swidget->private = volume;
  601. /* configure volume IPC message */
  602. volume->comp.type = SOF_COMP_VOLUME;
  603. volume->config.hdr.size = sizeof(volume->config);
  604. /* parse one set of volume tokens */
  605. ret = sof_update_ipc_object(scomp, volume, SOF_VOLUME_TOKENS, swidget->tuples,
  606. swidget->num_tuples, sizeof(*volume), 1);
  607. if (ret < 0)
  608. goto err;
  609. /* parse one set of comp tokens */
  610. ret = sof_update_ipc_object(scomp, &volume->config, SOF_COMP_TOKENS,
  611. swidget->tuples, swidget->num_tuples,
  612. sizeof(volume->config), 1);
  613. if (ret < 0)
  614. goto err;
  615. dev_dbg(scomp->dev, "loaded PGA %s\n", swidget->widget->name);
  616. sof_dbg_comp_config(scomp, &volume->config);
  617. list_for_each_entry(scontrol, &sdev->kcontrol_list, list) {
  618. if (scontrol->comp_id == swidget->comp_id &&
  619. scontrol->volume_table) {
  620. min_step = scontrol->min_volume_step;
  621. max_step = scontrol->max_volume_step;
  622. volume->min_value = scontrol->volume_table[min_step];
  623. volume->max_value = scontrol->volume_table[max_step];
  624. volume->channels = scontrol->num_channels;
  625. break;
  626. }
  627. }
  628. return 0;
  629. err:
  630. kfree(swidget->private);
  631. swidget->private = NULL;
  632. return ret;
  633. }
  634. static int sof_get_control_data(struct snd_soc_component *scomp,
  635. struct snd_soc_dapm_widget *widget,
  636. struct sof_widget_data *wdata, size_t *size)
  637. {
  638. const struct snd_kcontrol_new *kc;
  639. struct sof_ipc_ctrl_data *cdata;
  640. struct soc_mixer_control *sm;
  641. struct soc_bytes_ext *sbe;
  642. struct soc_enum *se;
  643. int i;
  644. *size = 0;
  645. for (i = 0; i < widget->num_kcontrols; i++) {
  646. kc = &widget->kcontrol_news[i];
  647. switch (widget->dobj.widget.kcontrol_type[i]) {
  648. case SND_SOC_TPLG_TYPE_MIXER:
  649. sm = (struct soc_mixer_control *)kc->private_value;
  650. wdata[i].control = sm->dobj.private;
  651. break;
  652. case SND_SOC_TPLG_TYPE_BYTES:
  653. sbe = (struct soc_bytes_ext *)kc->private_value;
  654. wdata[i].control = sbe->dobj.private;
  655. break;
  656. case SND_SOC_TPLG_TYPE_ENUM:
  657. se = (struct soc_enum *)kc->private_value;
  658. wdata[i].control = se->dobj.private;
  659. break;
  660. default:
  661. dev_err(scomp->dev, "Unknown kcontrol type %u in widget %s\n",
  662. widget->dobj.widget.kcontrol_type[i], widget->name);
  663. return -EINVAL;
  664. }
  665. if (!wdata[i].control) {
  666. dev_err(scomp->dev, "No scontrol for widget %s\n", widget->name);
  667. return -EINVAL;
  668. }
  669. cdata = wdata[i].control->ipc_control_data;
  670. if (widget->dobj.widget.kcontrol_type[i] == SND_SOC_TPLG_TYPE_BYTES) {
  671. /* make sure data is valid - data can be updated at runtime */
  672. if (cdata->data->magic != SOF_ABI_MAGIC)
  673. return -EINVAL;
  674. wdata[i].pdata = cdata->data->data;
  675. wdata[i].pdata_size = cdata->data->size;
  676. } else {
  677. /* points to the control data union */
  678. wdata[i].pdata = cdata->chanv;
  679. /*
  680. * wdata[i].control->size is calculated with struct_size
  681. * and includes the size of struct sof_ipc_ctrl_data
  682. */
  683. wdata[i].pdata_size = wdata[i].control->size -
  684. sizeof(struct sof_ipc_ctrl_data);
  685. }
  686. *size += wdata[i].pdata_size;
  687. /* get data type */
  688. switch (cdata->cmd) {
  689. case SOF_CTRL_CMD_VOLUME:
  690. case SOF_CTRL_CMD_ENUM:
  691. case SOF_CTRL_CMD_SWITCH:
  692. wdata[i].ipc_cmd = SOF_IPC_COMP_SET_VALUE;
  693. wdata[i].ctrl_type = SOF_CTRL_TYPE_VALUE_CHAN_SET;
  694. break;
  695. case SOF_CTRL_CMD_BINARY:
  696. wdata[i].ipc_cmd = SOF_IPC_COMP_SET_DATA;
  697. wdata[i].ctrl_type = SOF_CTRL_TYPE_DATA_SET;
  698. break;
  699. default:
  700. break;
  701. }
  702. }
  703. return 0;
  704. }
  705. static int sof_process_load(struct snd_soc_component *scomp,
  706. struct snd_sof_widget *swidget, int type)
  707. {
  708. struct snd_soc_dapm_widget *widget = swidget->widget;
  709. struct sof_ipc_comp_process *process;
  710. struct sof_widget_data *wdata = NULL;
  711. size_t ipc_data_size = 0;
  712. size_t ipc_size;
  713. int offset = 0;
  714. int ret;
  715. int i;
  716. /* allocate struct for widget control data sizes and types */
  717. if (widget->num_kcontrols) {
  718. wdata = kcalloc(widget->num_kcontrols, sizeof(*wdata), GFP_KERNEL);
  719. if (!wdata)
  720. return -ENOMEM;
  721. /* get possible component controls and get size of all pdata */
  722. ret = sof_get_control_data(scomp, widget, wdata, &ipc_data_size);
  723. if (ret < 0)
  724. goto out;
  725. }
  726. ipc_size = sizeof(struct sof_ipc_comp_process) + ipc_data_size;
  727. /* we are exceeding max ipc size, config needs to be sent separately */
  728. if (ipc_size > SOF_IPC_MSG_MAX_SIZE) {
  729. ipc_size -= ipc_data_size;
  730. ipc_data_size = 0;
  731. }
  732. process = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
  733. if (!process) {
  734. ret = -ENOMEM;
  735. goto out;
  736. }
  737. swidget->private = process;
  738. /* configure iir IPC message */
  739. process->comp.type = type;
  740. process->config.hdr.size = sizeof(process->config);
  741. /* parse one set of comp tokens */
  742. ret = sof_update_ipc_object(scomp, &process->config, SOF_COMP_TOKENS,
  743. swidget->tuples, swidget->num_tuples,
  744. sizeof(process->config), 1);
  745. if (ret < 0)
  746. goto err;
  747. dev_dbg(scomp->dev, "loaded process %s\n", swidget->widget->name);
  748. sof_dbg_comp_config(scomp, &process->config);
  749. /*
  750. * found private data in control, so copy it.
  751. * get possible component controls - get size of all pdata,
  752. * then memcpy with headers
  753. */
  754. if (ipc_data_size) {
  755. for (i = 0; i < widget->num_kcontrols; i++) {
  756. if (!wdata[i].pdata_size)
  757. continue;
  758. memcpy(&process->data[offset], wdata[i].pdata,
  759. wdata[i].pdata_size);
  760. offset += wdata[i].pdata_size;
  761. }
  762. }
  763. process->size = ipc_data_size;
  764. kfree(wdata);
  765. return 0;
  766. err:
  767. kfree(swidget->private);
  768. swidget->private = NULL;
  769. out:
  770. kfree(wdata);
  771. return ret;
  772. }
  773. static enum sof_comp_type find_process_comp_type(enum sof_ipc_process_type type)
  774. {
  775. int i;
  776. for (i = 0; i < ARRAY_SIZE(sof_process); i++) {
  777. if (sof_process[i].type == type)
  778. return sof_process[i].comp_type;
  779. }
  780. return SOF_COMP_NONE;
  781. }
  782. /*
  783. * Processing Component Topology - can be "effect", "codec", or general
  784. * "processing".
  785. */
  786. static int sof_widget_update_ipc_comp_process(struct snd_sof_widget *swidget)
  787. {
  788. struct snd_soc_component *scomp = swidget->scomp;
  789. struct sof_ipc_comp_process config;
  790. int ret;
  791. memset(&config, 0, sizeof(config));
  792. config.comp.core = swidget->core;
  793. /* parse one set of process tokens */
  794. ret = sof_update_ipc_object(scomp, &config, SOF_PROCESS_TOKENS, swidget->tuples,
  795. swidget->num_tuples, sizeof(config), 1);
  796. if (ret < 0)
  797. return ret;
  798. /* now load process specific data and send IPC */
  799. return sof_process_load(scomp, swidget, find_process_comp_type(config.type));
  800. }
  801. static int sof_link_hda_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
  802. struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
  803. {
  804. struct sof_dai_private_data *private = dai->private;
  805. u32 size = sizeof(*config);
  806. int ret;
  807. /* init IPC */
  808. memset(&config->hda, 0, sizeof(config->hda));
  809. config->hdr.size = size;
  810. /* parse one set of HDA tokens */
  811. ret = sof_update_ipc_object(scomp, &config->hda, SOF_HDA_TOKENS, slink->tuples,
  812. slink->num_tuples, size, 1);
  813. if (ret < 0)
  814. return ret;
  815. dev_dbg(scomp->dev, "HDA config rate %d channels %d\n",
  816. config->hda.rate, config->hda.channels);
  817. config->hda.link_dma_ch = DMA_CHAN_INVALID;
  818. dai->number_configs = 1;
  819. dai->current_config = 0;
  820. private->dai_config = kmemdup(config, size, GFP_KERNEL);
  821. if (!private->dai_config)
  822. return -ENOMEM;
  823. return 0;
  824. }
  825. static void sof_dai_set_format(struct snd_soc_tplg_hw_config *hw_config,
  826. struct sof_ipc_dai_config *config)
  827. {
  828. /* clock directions wrt codec */
  829. config->format &= ~SOF_DAI_FMT_CLOCK_PROVIDER_MASK;
  830. if (hw_config->bclk_provider == SND_SOC_TPLG_BCLK_CP) {
  831. /* codec is bclk provider */
  832. if (hw_config->fsync_provider == SND_SOC_TPLG_FSYNC_CP)
  833. config->format |= SOF_DAI_FMT_CBP_CFP;
  834. else
  835. config->format |= SOF_DAI_FMT_CBP_CFC;
  836. } else {
  837. /* codec is bclk consumer */
  838. if (hw_config->fsync_provider == SND_SOC_TPLG_FSYNC_CP)
  839. config->format |= SOF_DAI_FMT_CBC_CFP;
  840. else
  841. config->format |= SOF_DAI_FMT_CBC_CFC;
  842. }
  843. /* inverted clocks ? */
  844. config->format &= ~SOF_DAI_FMT_INV_MASK;
  845. if (hw_config->invert_bclk) {
  846. if (hw_config->invert_fsync)
  847. config->format |= SOF_DAI_FMT_IB_IF;
  848. else
  849. config->format |= SOF_DAI_FMT_IB_NF;
  850. } else {
  851. if (hw_config->invert_fsync)
  852. config->format |= SOF_DAI_FMT_NB_IF;
  853. else
  854. config->format |= SOF_DAI_FMT_NB_NF;
  855. }
  856. }
  857. static int sof_link_sai_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
  858. struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
  859. {
  860. struct snd_soc_tplg_hw_config *hw_config = slink->hw_configs;
  861. struct sof_dai_private_data *private = dai->private;
  862. u32 size = sizeof(*config);
  863. int ret;
  864. /* handle master/slave and inverted clocks */
  865. sof_dai_set_format(hw_config, config);
  866. /* init IPC */
  867. memset(&config->sai, 0, sizeof(config->sai));
  868. config->hdr.size = size;
  869. /* parse one set of SAI tokens */
  870. ret = sof_update_ipc_object(scomp, &config->sai, SOF_SAI_TOKENS, slink->tuples,
  871. slink->num_tuples, size, 1);
  872. if (ret < 0)
  873. return ret;
  874. config->sai.mclk_rate = le32_to_cpu(hw_config->mclk_rate);
  875. config->sai.bclk_rate = le32_to_cpu(hw_config->bclk_rate);
  876. config->sai.fsync_rate = le32_to_cpu(hw_config->fsync_rate);
  877. config->sai.mclk_direction = hw_config->mclk_direction;
  878. config->sai.tdm_slots = le32_to_cpu(hw_config->tdm_slots);
  879. config->sai.tdm_slot_width = le32_to_cpu(hw_config->tdm_slot_width);
  880. config->sai.rx_slots = le32_to_cpu(hw_config->rx_slots);
  881. config->sai.tx_slots = le32_to_cpu(hw_config->tx_slots);
  882. dev_info(scomp->dev,
  883. "tplg: config SAI%d fmt 0x%x mclk %d width %d slots %d mclk id %d\n",
  884. config->dai_index, config->format,
  885. config->sai.mclk_rate, config->sai.tdm_slot_width,
  886. config->sai.tdm_slots, config->sai.mclk_id);
  887. if (config->sai.tdm_slots < 1 || config->sai.tdm_slots > 8) {
  888. dev_err(scomp->dev, "Invalid channel count for SAI%d\n", config->dai_index);
  889. return -EINVAL;
  890. }
  891. dai->number_configs = 1;
  892. dai->current_config = 0;
  893. private->dai_config = kmemdup(config, size, GFP_KERNEL);
  894. if (!private->dai_config)
  895. return -ENOMEM;
  896. return 0;
  897. }
  898. static int sof_link_esai_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
  899. struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
  900. {
  901. struct snd_soc_tplg_hw_config *hw_config = slink->hw_configs;
  902. struct sof_dai_private_data *private = dai->private;
  903. u32 size = sizeof(*config);
  904. int ret;
  905. /* handle master/slave and inverted clocks */
  906. sof_dai_set_format(hw_config, config);
  907. /* init IPC */
  908. memset(&config->esai, 0, sizeof(config->esai));
  909. config->hdr.size = size;
  910. /* parse one set of ESAI tokens */
  911. ret = sof_update_ipc_object(scomp, &config->esai, SOF_ESAI_TOKENS, slink->tuples,
  912. slink->num_tuples, size, 1);
  913. if (ret < 0)
  914. return ret;
  915. config->esai.mclk_rate = le32_to_cpu(hw_config->mclk_rate);
  916. config->esai.bclk_rate = le32_to_cpu(hw_config->bclk_rate);
  917. config->esai.fsync_rate = le32_to_cpu(hw_config->fsync_rate);
  918. config->esai.mclk_direction = hw_config->mclk_direction;
  919. config->esai.tdm_slots = le32_to_cpu(hw_config->tdm_slots);
  920. config->esai.tdm_slot_width = le32_to_cpu(hw_config->tdm_slot_width);
  921. config->esai.rx_slots = le32_to_cpu(hw_config->rx_slots);
  922. config->esai.tx_slots = le32_to_cpu(hw_config->tx_slots);
  923. dev_info(scomp->dev,
  924. "tplg: config ESAI%d fmt 0x%x mclk %d width %d slots %d mclk id %d\n",
  925. config->dai_index, config->format,
  926. config->esai.mclk_rate, config->esai.tdm_slot_width,
  927. config->esai.tdm_slots, config->esai.mclk_id);
  928. if (config->esai.tdm_slots < 1 || config->esai.tdm_slots > 8) {
  929. dev_err(scomp->dev, "Invalid channel count for ESAI%d\n", config->dai_index);
  930. return -EINVAL;
  931. }
  932. dai->number_configs = 1;
  933. dai->current_config = 0;
  934. private->dai_config = kmemdup(config, size, GFP_KERNEL);
  935. if (!private->dai_config)
  936. return -ENOMEM;
  937. return 0;
  938. }
  939. static int sof_link_acp_dmic_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
  940. struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
  941. {
  942. struct snd_soc_tplg_hw_config *hw_config = slink->hw_configs;
  943. struct sof_dai_private_data *private = dai->private;
  944. u32 size = sizeof(*config);
  945. int ret;
  946. /* handle master/slave and inverted clocks */
  947. sof_dai_set_format(hw_config, config);
  948. config->hdr.size = size;
  949. /* parse the required set of ACPDMIC tokens based on num_hw_cfgs */
  950. ret = sof_update_ipc_object(scomp, &config->acpdmic, SOF_ACPDMIC_TOKENS, slink->tuples,
  951. slink->num_tuples, size, slink->num_hw_configs);
  952. if (ret < 0)
  953. return ret;
  954. dev_info(scomp->dev, "ACP_DMIC config ACP%d channel %d rate %d\n",
  955. config->dai_index, config->acpdmic.pdm_ch,
  956. config->acpdmic.pdm_rate);
  957. dai->number_configs = 1;
  958. dai->current_config = 0;
  959. private->dai_config = kmemdup(config, size, GFP_KERNEL);
  960. if (!private->dai_config)
  961. return -ENOMEM;
  962. return 0;
  963. }
  964. static int sof_link_acp_bt_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
  965. struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
  966. {
  967. struct snd_soc_tplg_hw_config *hw_config = slink->hw_configs;
  968. struct sof_dai_private_data *private = dai->private;
  969. u32 size = sizeof(*config);
  970. /* handle master/slave and inverted clocks */
  971. sof_dai_set_format(hw_config, config);
  972. /* init IPC */
  973. memset(&config->acpbt, 0, sizeof(config->acpbt));
  974. config->hdr.size = size;
  975. config->acpbt.fsync_rate = le32_to_cpu(hw_config->fsync_rate);
  976. config->acpbt.tdm_slots = le32_to_cpu(hw_config->tdm_slots);
  977. dev_info(scomp->dev, "ACP_BT config ACP%d channel %d rate %d\n",
  978. config->dai_index, config->acpbt.tdm_slots,
  979. config->acpbt.fsync_rate);
  980. dai->number_configs = 1;
  981. dai->current_config = 0;
  982. private->dai_config = kmemdup(config, size, GFP_KERNEL);
  983. if (!private->dai_config)
  984. return -ENOMEM;
  985. return 0;
  986. }
  987. static int sof_link_acp_sp_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
  988. struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
  989. {
  990. struct snd_soc_tplg_hw_config *hw_config = slink->hw_configs;
  991. struct sof_dai_private_data *private = dai->private;
  992. u32 size = sizeof(*config);
  993. /* handle master/slave and inverted clocks */
  994. sof_dai_set_format(hw_config, config);
  995. /* init IPC */
  996. memset(&config->acpsp, 0, sizeof(config->acpsp));
  997. config->hdr.size = size;
  998. config->acpsp.fsync_rate = le32_to_cpu(hw_config->fsync_rate);
  999. config->acpsp.tdm_slots = le32_to_cpu(hw_config->tdm_slots);
  1000. dev_info(scomp->dev, "ACP_SP config ACP%d channel %d rate %d\n",
  1001. config->dai_index, config->acpsp.tdm_slots,
  1002. config->acpsp.fsync_rate);
  1003. dai->number_configs = 1;
  1004. dai->current_config = 0;
  1005. private->dai_config = kmemdup(config, size, GFP_KERNEL);
  1006. if (!private->dai_config)
  1007. return -ENOMEM;
  1008. return 0;
  1009. }
  1010. static int sof_link_acp_hs_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
  1011. struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
  1012. {
  1013. struct snd_soc_tplg_hw_config *hw_config = slink->hw_configs;
  1014. struct sof_dai_private_data *private = dai->private;
  1015. u32 size = sizeof(*config);
  1016. /* Configures the DAI hardware format and inverted clocks */
  1017. sof_dai_set_format(hw_config, config);
  1018. /* init IPC */
  1019. memset(&config->acphs, 0, sizeof(config->acphs));
  1020. config->hdr.size = size;
  1021. config->acphs.fsync_rate = le32_to_cpu(hw_config->fsync_rate);
  1022. config->acphs.tdm_slots = le32_to_cpu(hw_config->tdm_slots);
  1023. dev_info(scomp->dev, "ACP_HS config ACP%d channel %d rate %d\n",
  1024. config->dai_index, config->acphs.tdm_slots,
  1025. config->acphs.fsync_rate);
  1026. dai->number_configs = 1;
  1027. dai->current_config = 0;
  1028. private->dai_config = kmemdup(config, size, GFP_KERNEL);
  1029. if (!private->dai_config)
  1030. return -ENOMEM;
  1031. return 0;
  1032. }
  1033. static int sof_link_afe_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
  1034. struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
  1035. {
  1036. struct sof_dai_private_data *private = dai->private;
  1037. u32 size = sizeof(*config);
  1038. int ret;
  1039. config->hdr.size = size;
  1040. /* parse the required set of AFE tokens based on num_hw_cfgs */
  1041. ret = sof_update_ipc_object(scomp, &config->afe, SOF_AFE_TOKENS, slink->tuples,
  1042. slink->num_tuples, size, slink->num_hw_configs);
  1043. if (ret < 0)
  1044. return ret;
  1045. dev_dbg(scomp->dev, "AFE config rate %d channels %d format:%d\n",
  1046. config->afe.rate, config->afe.channels, config->afe.format);
  1047. config->afe.stream_id = DMA_CHAN_INVALID;
  1048. dai->number_configs = 1;
  1049. dai->current_config = 0;
  1050. private->dai_config = kmemdup(config, size, GFP_KERNEL);
  1051. if (!private->dai_config)
  1052. return -ENOMEM;
  1053. return 0;
  1054. }
  1055. static int sof_link_ssp_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
  1056. struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
  1057. {
  1058. struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
  1059. struct snd_soc_tplg_hw_config *hw_config = slink->hw_configs;
  1060. struct sof_dai_private_data *private = dai->private;
  1061. u32 size = sizeof(*config);
  1062. int current_config = 0;
  1063. int i, ret;
  1064. /*
  1065. * Parse common data, we should have 1 common data per hw_config.
  1066. */
  1067. ret = sof_update_ipc_object(scomp, &config->ssp, SOF_SSP_TOKENS, slink->tuples,
  1068. slink->num_tuples, size, slink->num_hw_configs);
  1069. if (ret < 0)
  1070. return ret;
  1071. /* process all possible hw configs */
  1072. for (i = 0; i < slink->num_hw_configs; i++) {
  1073. if (le32_to_cpu(hw_config[i].id) == slink->default_hw_cfg_id)
  1074. current_config = i;
  1075. /* handle master/slave and inverted clocks */
  1076. sof_dai_set_format(&hw_config[i], &config[i]);
  1077. config[i].hdr.size = size;
  1078. if (sdev->mclk_id_override) {
  1079. dev_dbg(scomp->dev, "tplg: overriding topology mclk_id %d by quirk %d\n",
  1080. config[i].ssp.mclk_id, sdev->mclk_id_quirk);
  1081. config[i].ssp.mclk_id = sdev->mclk_id_quirk;
  1082. }
  1083. /* copy differentiating hw configs to ipc structs */
  1084. config[i].ssp.mclk_rate = le32_to_cpu(hw_config[i].mclk_rate);
  1085. config[i].ssp.bclk_rate = le32_to_cpu(hw_config[i].bclk_rate);
  1086. config[i].ssp.fsync_rate = le32_to_cpu(hw_config[i].fsync_rate);
  1087. config[i].ssp.tdm_slots = le32_to_cpu(hw_config[i].tdm_slots);
  1088. config[i].ssp.tdm_slot_width = le32_to_cpu(hw_config[i].tdm_slot_width);
  1089. config[i].ssp.mclk_direction = hw_config[i].mclk_direction;
  1090. config[i].ssp.rx_slots = le32_to_cpu(hw_config[i].rx_slots);
  1091. config[i].ssp.tx_slots = le32_to_cpu(hw_config[i].tx_slots);
  1092. dev_dbg(scomp->dev, "tplg: config SSP%d fmt %#x mclk %d bclk %d fclk %d width (%d)%d slots %d mclk id %d quirks %d clks_control %#x\n",
  1093. config[i].dai_index, config[i].format,
  1094. config[i].ssp.mclk_rate, config[i].ssp.bclk_rate,
  1095. config[i].ssp.fsync_rate, config[i].ssp.sample_valid_bits,
  1096. config[i].ssp.tdm_slot_width, config[i].ssp.tdm_slots,
  1097. config[i].ssp.mclk_id, config[i].ssp.quirks, config[i].ssp.clks_control);
  1098. /* validate SSP fsync rate and channel count */
  1099. if (config[i].ssp.fsync_rate < 8000 || config[i].ssp.fsync_rate > 192000) {
  1100. dev_err(scomp->dev, "Invalid fsync rate for SSP%d\n", config[i].dai_index);
  1101. return -EINVAL;
  1102. }
  1103. if (config[i].ssp.tdm_slots < 1 || config[i].ssp.tdm_slots > 8) {
  1104. dev_err(scomp->dev, "Invalid channel count for SSP%d\n",
  1105. config[i].dai_index);
  1106. return -EINVAL;
  1107. }
  1108. }
  1109. dai->number_configs = slink->num_hw_configs;
  1110. dai->current_config = current_config;
  1111. private->dai_config = kmemdup(config, size * slink->num_hw_configs, GFP_KERNEL);
  1112. if (!private->dai_config)
  1113. return -ENOMEM;
  1114. return 0;
  1115. }
  1116. static int sof_link_dmic_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
  1117. struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
  1118. {
  1119. struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
  1120. struct sof_dai_private_data *private = dai->private;
  1121. struct sof_ipc_fw_ready *ready = &sdev->fw_ready;
  1122. struct sof_ipc_fw_version *v = &ready->version;
  1123. size_t size = sizeof(*config);
  1124. int i, ret;
  1125. /* Ensure the entire DMIC config struct is zeros */
  1126. memset(&config->dmic, 0, sizeof(config->dmic));
  1127. /* parse the required set of DMIC tokens based on num_hw_cfgs */
  1128. ret = sof_update_ipc_object(scomp, &config->dmic, SOF_DMIC_TOKENS, slink->tuples,
  1129. slink->num_tuples, size, slink->num_hw_configs);
  1130. if (ret < 0)
  1131. return ret;
  1132. /* parse the required set of DMIC PDM tokens based on number of active PDM's */
  1133. ret = sof_update_ipc_object(scomp, &config->dmic.pdm[0], SOF_DMIC_PDM_TOKENS,
  1134. slink->tuples, slink->num_tuples,
  1135. sizeof(struct sof_ipc_dai_dmic_pdm_ctrl),
  1136. config->dmic.num_pdm_active);
  1137. if (ret < 0)
  1138. return ret;
  1139. /* set IPC header size */
  1140. config->hdr.size = size;
  1141. /* debug messages */
  1142. dev_dbg(scomp->dev, "tplg: config DMIC%d driver version %d\n",
  1143. config->dai_index, config->dmic.driver_ipc_version);
  1144. dev_dbg(scomp->dev, "pdmclk_min %d pdm_clkmax %d duty_min %d\n",
  1145. config->dmic.pdmclk_min, config->dmic.pdmclk_max,
  1146. config->dmic.duty_min);
  1147. dev_dbg(scomp->dev, "duty_max %d fifo_fs %d num_pdms active %d\n",
  1148. config->dmic.duty_max, config->dmic.fifo_fs,
  1149. config->dmic.num_pdm_active);
  1150. dev_dbg(scomp->dev, "fifo word length %d\n", config->dmic.fifo_bits);
  1151. for (i = 0; i < config->dmic.num_pdm_active; i++) {
  1152. dev_dbg(scomp->dev, "pdm %d mic a %d mic b %d\n",
  1153. config->dmic.pdm[i].id,
  1154. config->dmic.pdm[i].enable_mic_a,
  1155. config->dmic.pdm[i].enable_mic_b);
  1156. dev_dbg(scomp->dev, "pdm %d polarity a %d polarity b %d\n",
  1157. config->dmic.pdm[i].id,
  1158. config->dmic.pdm[i].polarity_mic_a,
  1159. config->dmic.pdm[i].polarity_mic_b);
  1160. dev_dbg(scomp->dev, "pdm %d clk_edge %d skew %d\n",
  1161. config->dmic.pdm[i].id,
  1162. config->dmic.pdm[i].clk_edge,
  1163. config->dmic.pdm[i].skew);
  1164. }
  1165. /*
  1166. * this takes care of backwards compatible handling of fifo_bits_b.
  1167. * It is deprecated since firmware ABI version 3.0.1.
  1168. */
  1169. if (SOF_ABI_VER(v->major, v->minor, v->micro) < SOF_ABI_VER(3, 0, 1))
  1170. config->dmic.fifo_bits_b = config->dmic.fifo_bits;
  1171. dai->number_configs = 1;
  1172. dai->current_config = 0;
  1173. private->dai_config = kmemdup(config, size, GFP_KERNEL);
  1174. if (!private->dai_config)
  1175. return -ENOMEM;
  1176. return 0;
  1177. }
  1178. static int sof_link_alh_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
  1179. struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
  1180. {
  1181. struct sof_dai_private_data *private = dai->private;
  1182. u32 size = sizeof(*config);
  1183. int ret;
  1184. /* parse the required set of ALH tokens based on num_hw_cfgs */
  1185. ret = sof_update_ipc_object(scomp, &config->alh, SOF_ALH_TOKENS, slink->tuples,
  1186. slink->num_tuples, size, slink->num_hw_configs);
  1187. if (ret < 0)
  1188. return ret;
  1189. /* init IPC */
  1190. config->hdr.size = size;
  1191. /* set config for all DAI's with name matching the link name */
  1192. dai->number_configs = 1;
  1193. dai->current_config = 0;
  1194. private->dai_config = kmemdup(config, size, GFP_KERNEL);
  1195. if (!private->dai_config)
  1196. return -ENOMEM;
  1197. return 0;
  1198. }
  1199. static int sof_ipc3_widget_setup_comp_dai(struct snd_sof_widget *swidget)
  1200. {
  1201. struct snd_soc_component *scomp = swidget->scomp;
  1202. struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
  1203. struct snd_sof_dai *dai = swidget->private;
  1204. struct sof_dai_private_data *private;
  1205. struct sof_ipc_comp_dai *comp_dai;
  1206. size_t ipc_size = sizeof(*comp_dai);
  1207. struct sof_ipc_dai_config *config;
  1208. struct snd_sof_dai_link *slink;
  1209. int ret;
  1210. private = kzalloc(sizeof(*private), GFP_KERNEL);
  1211. if (!private)
  1212. return -ENOMEM;
  1213. dai->private = private;
  1214. private->comp_dai = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
  1215. if (!private->comp_dai) {
  1216. ret = -ENOMEM;
  1217. goto free;
  1218. }
  1219. /* configure dai IPC message */
  1220. comp_dai = private->comp_dai;
  1221. comp_dai->comp.type = SOF_COMP_DAI;
  1222. comp_dai->config.hdr.size = sizeof(comp_dai->config);
  1223. /* parse one set of DAI tokens */
  1224. ret = sof_update_ipc_object(scomp, comp_dai, SOF_DAI_TOKENS, swidget->tuples,
  1225. swidget->num_tuples, sizeof(*comp_dai), 1);
  1226. if (ret < 0)
  1227. goto free;
  1228. /* update comp_tokens */
  1229. ret = sof_update_ipc_object(scomp, &comp_dai->config, SOF_COMP_TOKENS,
  1230. swidget->tuples, swidget->num_tuples,
  1231. sizeof(comp_dai->config), 1);
  1232. if (ret < 0)
  1233. goto free;
  1234. dev_dbg(scomp->dev, "dai %s: type %d index %d\n",
  1235. swidget->widget->name, comp_dai->type, comp_dai->dai_index);
  1236. sof_dbg_comp_config(scomp, &comp_dai->config);
  1237. /* now update DAI config */
  1238. list_for_each_entry(slink, &sdev->dai_link_list, list) {
  1239. struct sof_ipc_dai_config common_config;
  1240. int i;
  1241. if (strcmp(slink->link->name, dai->name))
  1242. continue;
  1243. /* Reserve memory for all hw configs, eventually freed by widget */
  1244. config = kcalloc(slink->num_hw_configs, sizeof(*config), GFP_KERNEL);
  1245. if (!config) {
  1246. ret = -ENOMEM;
  1247. goto free_comp;
  1248. }
  1249. /* parse one set of DAI link tokens */
  1250. ret = sof_update_ipc_object(scomp, &common_config, SOF_DAI_LINK_TOKENS,
  1251. slink->tuples, slink->num_tuples,
  1252. sizeof(common_config), 1);
  1253. if (ret < 0)
  1254. goto free_config;
  1255. for (i = 0; i < slink->num_hw_configs; i++) {
  1256. config[i].hdr.cmd = SOF_IPC_GLB_DAI_MSG | SOF_IPC_DAI_CONFIG;
  1257. config[i].format = le32_to_cpu(slink->hw_configs[i].fmt);
  1258. config[i].type = common_config.type;
  1259. config[i].dai_index = comp_dai->dai_index;
  1260. }
  1261. switch (common_config.type) {
  1262. case SOF_DAI_INTEL_SSP:
  1263. ret = sof_link_ssp_load(scomp, slink, config, dai);
  1264. break;
  1265. case SOF_DAI_INTEL_DMIC:
  1266. ret = sof_link_dmic_load(scomp, slink, config, dai);
  1267. break;
  1268. case SOF_DAI_INTEL_HDA:
  1269. ret = sof_link_hda_load(scomp, slink, config, dai);
  1270. break;
  1271. case SOF_DAI_INTEL_ALH:
  1272. ret = sof_link_alh_load(scomp, slink, config, dai);
  1273. break;
  1274. case SOF_DAI_IMX_SAI:
  1275. ret = sof_link_sai_load(scomp, slink, config, dai);
  1276. break;
  1277. case SOF_DAI_IMX_ESAI:
  1278. ret = sof_link_esai_load(scomp, slink, config, dai);
  1279. break;
  1280. case SOF_DAI_AMD_BT:
  1281. ret = sof_link_acp_bt_load(scomp, slink, config, dai);
  1282. break;
  1283. case SOF_DAI_AMD_SP:
  1284. ret = sof_link_acp_sp_load(scomp, slink, config, dai);
  1285. break;
  1286. case SOF_DAI_AMD_HS:
  1287. ret = sof_link_acp_hs_load(scomp, slink, config, dai);
  1288. break;
  1289. case SOF_DAI_AMD_DMIC:
  1290. ret = sof_link_acp_dmic_load(scomp, slink, config, dai);
  1291. break;
  1292. case SOF_DAI_MEDIATEK_AFE:
  1293. ret = sof_link_afe_load(scomp, slink, config, dai);
  1294. break;
  1295. default:
  1296. break;
  1297. }
  1298. if (ret < 0) {
  1299. dev_err(scomp->dev, "failed to load config for dai %s\n", dai->name);
  1300. goto free_config;
  1301. }
  1302. kfree(config);
  1303. }
  1304. return 0;
  1305. free_config:
  1306. kfree(config);
  1307. free_comp:
  1308. kfree(comp_dai);
  1309. free:
  1310. kfree(private);
  1311. dai->private = NULL;
  1312. return ret;
  1313. }
  1314. static void sof_ipc3_widget_free_comp_dai(struct snd_sof_widget *swidget)
  1315. {
  1316. switch (swidget->id) {
  1317. case snd_soc_dapm_dai_in:
  1318. case snd_soc_dapm_dai_out:
  1319. {
  1320. struct snd_sof_dai *dai = swidget->private;
  1321. struct sof_dai_private_data *dai_data;
  1322. if (!dai)
  1323. return;
  1324. dai_data = dai->private;
  1325. if (dai_data) {
  1326. kfree(dai_data->comp_dai);
  1327. kfree(dai_data->dai_config);
  1328. kfree(dai_data);
  1329. }
  1330. kfree(dai);
  1331. break;
  1332. }
  1333. default:
  1334. break;
  1335. }
  1336. }
  1337. static int sof_ipc3_route_setup(struct snd_sof_dev *sdev, struct snd_sof_route *sroute)
  1338. {
  1339. struct sof_ipc_pipe_comp_connect connect;
  1340. struct sof_ipc_reply reply;
  1341. int ret;
  1342. connect.hdr.size = sizeof(connect);
  1343. connect.hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_COMP_CONNECT;
  1344. connect.source_id = sroute->src_widget->comp_id;
  1345. connect.sink_id = sroute->sink_widget->comp_id;
  1346. dev_dbg(sdev->dev, "setting up route %s -> %s\n",
  1347. sroute->src_widget->widget->name,
  1348. sroute->sink_widget->widget->name);
  1349. /* send ipc */
  1350. ret = sof_ipc_tx_message(sdev->ipc, &connect, sizeof(connect), &reply, sizeof(reply));
  1351. if (ret < 0)
  1352. dev_err(sdev->dev, "%s: route %s -> %s failed\n", __func__,
  1353. sroute->src_widget->widget->name, sroute->sink_widget->widget->name);
  1354. return ret;
  1355. }
  1356. static int sof_ipc3_control_load_bytes(struct snd_sof_dev *sdev, struct snd_sof_control *scontrol)
  1357. {
  1358. struct sof_ipc_ctrl_data *cdata;
  1359. int ret;
  1360. if (scontrol->max_size < (sizeof(*cdata) + sizeof(struct sof_abi_hdr))) {
  1361. dev_err(sdev->dev, "%s: insufficient size for a bytes control: %zu.\n",
  1362. __func__, scontrol->max_size);
  1363. return -EINVAL;
  1364. }
  1365. if (scontrol->priv_size > scontrol->max_size - sizeof(*cdata)) {
  1366. dev_err(sdev->dev,
  1367. "%s: bytes data size %zu exceeds max %zu.\n", __func__,
  1368. scontrol->priv_size, scontrol->max_size - sizeof(*cdata));
  1369. return -EINVAL;
  1370. }
  1371. scontrol->ipc_control_data = kzalloc(scontrol->max_size, GFP_KERNEL);
  1372. if (!scontrol->ipc_control_data)
  1373. return -ENOMEM;
  1374. scontrol->size = sizeof(struct sof_ipc_ctrl_data) + scontrol->priv_size;
  1375. cdata = scontrol->ipc_control_data;
  1376. cdata->cmd = SOF_CTRL_CMD_BINARY;
  1377. cdata->index = scontrol->index;
  1378. if (scontrol->priv_size > 0) {
  1379. memcpy(cdata->data, scontrol->priv, scontrol->priv_size);
  1380. kfree(scontrol->priv);
  1381. scontrol->priv = NULL;
  1382. if (cdata->data->magic != SOF_ABI_MAGIC) {
  1383. dev_err(sdev->dev, "Wrong ABI magic 0x%08x.\n", cdata->data->magic);
  1384. ret = -EINVAL;
  1385. goto err;
  1386. }
  1387. if (SOF_ABI_VERSION_INCOMPATIBLE(SOF_ABI_VERSION, cdata->data->abi)) {
  1388. dev_err(sdev->dev, "Incompatible ABI version 0x%08x.\n",
  1389. cdata->data->abi);
  1390. ret = -EINVAL;
  1391. goto err;
  1392. }
  1393. if (cdata->data->size + sizeof(struct sof_abi_hdr) != scontrol->priv_size) {
  1394. dev_err(sdev->dev, "Conflict in bytes vs. priv size.\n");
  1395. ret = -EINVAL;
  1396. goto err;
  1397. }
  1398. }
  1399. return 0;
  1400. err:
  1401. kfree(scontrol->ipc_control_data);
  1402. scontrol->ipc_control_data = NULL;
  1403. return ret;
  1404. }
  1405. static int sof_ipc3_control_load_volume(struct snd_sof_dev *sdev, struct snd_sof_control *scontrol)
  1406. {
  1407. struct sof_ipc_ctrl_data *cdata;
  1408. int i;
  1409. /* init the volume get/put data */
  1410. scontrol->size = struct_size(cdata, chanv, scontrol->num_channels);
  1411. scontrol->ipc_control_data = kzalloc(scontrol->size, GFP_KERNEL);
  1412. if (!scontrol->ipc_control_data)
  1413. return -ENOMEM;
  1414. cdata = scontrol->ipc_control_data;
  1415. cdata->index = scontrol->index;
  1416. /* set cmd for mixer control */
  1417. if (scontrol->max == 1) {
  1418. cdata->cmd = SOF_CTRL_CMD_SWITCH;
  1419. return 0;
  1420. }
  1421. cdata->cmd = SOF_CTRL_CMD_VOLUME;
  1422. /* set default volume values to 0dB in control */
  1423. for (i = 0; i < scontrol->num_channels; i++) {
  1424. cdata->chanv[i].channel = i;
  1425. cdata->chanv[i].value = VOL_ZERO_DB;
  1426. }
  1427. return 0;
  1428. }
  1429. static int sof_ipc3_control_load_enum(struct snd_sof_dev *sdev, struct snd_sof_control *scontrol)
  1430. {
  1431. struct sof_ipc_ctrl_data *cdata;
  1432. /* init the enum get/put data */
  1433. scontrol->size = struct_size(cdata, chanv, scontrol->num_channels);
  1434. scontrol->ipc_control_data = kzalloc(scontrol->size, GFP_KERNEL);
  1435. if (!scontrol->ipc_control_data)
  1436. return -ENOMEM;
  1437. cdata = scontrol->ipc_control_data;
  1438. cdata->index = scontrol->index;
  1439. cdata->cmd = SOF_CTRL_CMD_ENUM;
  1440. return 0;
  1441. }
  1442. static int sof_ipc3_control_setup(struct snd_sof_dev *sdev, struct snd_sof_control *scontrol)
  1443. {
  1444. switch (scontrol->info_type) {
  1445. case SND_SOC_TPLG_CTL_VOLSW:
  1446. case SND_SOC_TPLG_CTL_VOLSW_SX:
  1447. case SND_SOC_TPLG_CTL_VOLSW_XR_SX:
  1448. return sof_ipc3_control_load_volume(sdev, scontrol);
  1449. case SND_SOC_TPLG_CTL_BYTES:
  1450. return sof_ipc3_control_load_bytes(sdev, scontrol);
  1451. case SND_SOC_TPLG_CTL_ENUM:
  1452. case SND_SOC_TPLG_CTL_ENUM_VALUE:
  1453. return sof_ipc3_control_load_enum(sdev, scontrol);
  1454. default:
  1455. break;
  1456. }
  1457. return 0;
  1458. }
  1459. static int sof_ipc3_control_free(struct snd_sof_dev *sdev, struct snd_sof_control *scontrol)
  1460. {
  1461. struct sof_ipc_free fcomp;
  1462. fcomp.hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_COMP_FREE;
  1463. fcomp.hdr.size = sizeof(fcomp);
  1464. fcomp.id = scontrol->comp_id;
  1465. /* send IPC to the DSP */
  1466. return sof_ipc_tx_message(sdev->ipc, &fcomp, sizeof(fcomp), NULL, 0);
  1467. }
  1468. /* send pcm params ipc */
  1469. static int sof_ipc3_keyword_detect_pcm_params(struct snd_sof_widget *swidget, int dir)
  1470. {
  1471. struct snd_soc_component *scomp = swidget->scomp;
  1472. struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
  1473. struct sof_ipc_pcm_params_reply ipc_params_reply;
  1474. struct snd_pcm_hw_params *params;
  1475. struct sof_ipc_pcm_params pcm;
  1476. struct snd_sof_pcm *spcm;
  1477. int ret;
  1478. /* get runtime PCM params using widget's stream name */
  1479. spcm = snd_sof_find_spcm_name(scomp, swidget->widget->sname);
  1480. if (!spcm) {
  1481. dev_err(scomp->dev, "Cannot find PCM for %s\n", swidget->widget->name);
  1482. return -EINVAL;
  1483. }
  1484. params = &spcm->params[dir];
  1485. /* set IPC PCM params */
  1486. memset(&pcm, 0, sizeof(pcm));
  1487. pcm.hdr.size = sizeof(pcm);
  1488. pcm.hdr.cmd = SOF_IPC_GLB_STREAM_MSG | SOF_IPC_STREAM_PCM_PARAMS;
  1489. pcm.comp_id = swidget->comp_id;
  1490. pcm.params.hdr.size = sizeof(pcm.params);
  1491. pcm.params.direction = dir;
  1492. pcm.params.sample_valid_bytes = params_width(params) >> 3;
  1493. pcm.params.buffer_fmt = SOF_IPC_BUFFER_INTERLEAVED;
  1494. pcm.params.rate = params_rate(params);
  1495. pcm.params.channels = params_channels(params);
  1496. pcm.params.host_period_bytes = params_period_bytes(params);
  1497. /* set format */
  1498. switch (params_format(params)) {
  1499. case SNDRV_PCM_FORMAT_S16:
  1500. pcm.params.frame_fmt = SOF_IPC_FRAME_S16_LE;
  1501. break;
  1502. case SNDRV_PCM_FORMAT_S24:
  1503. pcm.params.frame_fmt = SOF_IPC_FRAME_S24_4LE;
  1504. break;
  1505. case SNDRV_PCM_FORMAT_S32:
  1506. pcm.params.frame_fmt = SOF_IPC_FRAME_S32_LE;
  1507. break;
  1508. default:
  1509. return -EINVAL;
  1510. }
  1511. /* send IPC to the DSP */
  1512. ret = sof_ipc_tx_message(sdev->ipc, &pcm, sizeof(pcm),
  1513. &ipc_params_reply, sizeof(ipc_params_reply));
  1514. if (ret < 0)
  1515. dev_err(scomp->dev, "%s: PCM params failed for %s\n", __func__,
  1516. swidget->widget->name);
  1517. return ret;
  1518. }
  1519. /* send stream trigger ipc */
  1520. static int sof_ipc3_keyword_detect_trigger(struct snd_sof_widget *swidget, int cmd)
  1521. {
  1522. struct snd_soc_component *scomp = swidget->scomp;
  1523. struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
  1524. struct sof_ipc_stream stream;
  1525. struct sof_ipc_reply reply;
  1526. int ret;
  1527. /* set IPC stream params */
  1528. stream.hdr.size = sizeof(stream);
  1529. stream.hdr.cmd = SOF_IPC_GLB_STREAM_MSG | cmd;
  1530. stream.comp_id = swidget->comp_id;
  1531. /* send IPC to the DSP */
  1532. ret = sof_ipc_tx_message(sdev->ipc, &stream, sizeof(stream), &reply, sizeof(reply));
  1533. if (ret < 0)
  1534. dev_err(scomp->dev, "%s: Failed to trigger %s\n", __func__, swidget->widget->name);
  1535. return ret;
  1536. }
  1537. static int sof_ipc3_keyword_dapm_event(struct snd_soc_dapm_widget *w,
  1538. struct snd_kcontrol *k, int event)
  1539. {
  1540. struct snd_sof_widget *swidget = w->dobj.private;
  1541. struct snd_soc_component *scomp;
  1542. int stream = SNDRV_PCM_STREAM_CAPTURE;
  1543. struct snd_sof_pcm *spcm;
  1544. int ret = 0;
  1545. if (!swidget)
  1546. return 0;
  1547. scomp = swidget->scomp;
  1548. dev_dbg(scomp->dev, "received event %d for widget %s\n",
  1549. event, w->name);
  1550. /* get runtime PCM params using widget's stream name */
  1551. spcm = snd_sof_find_spcm_name(scomp, swidget->widget->sname);
  1552. if (!spcm) {
  1553. dev_err(scomp->dev, "%s: Cannot find PCM for %s\n", __func__,
  1554. swidget->widget->name);
  1555. return -EINVAL;
  1556. }
  1557. /* process events */
  1558. switch (event) {
  1559. case SND_SOC_DAPM_PRE_PMU:
  1560. if (spcm->stream[stream].suspend_ignored) {
  1561. dev_dbg(scomp->dev, "PRE_PMU event ignored, KWD pipeline is already RUNNING\n");
  1562. return 0;
  1563. }
  1564. /* set pcm params */
  1565. ret = sof_ipc3_keyword_detect_pcm_params(swidget, stream);
  1566. if (ret < 0) {
  1567. dev_err(scomp->dev, "%s: Failed to set pcm params for widget %s\n",
  1568. __func__, swidget->widget->name);
  1569. break;
  1570. }
  1571. /* start trigger */
  1572. ret = sof_ipc3_keyword_detect_trigger(swidget, SOF_IPC_STREAM_TRIG_START);
  1573. if (ret < 0)
  1574. dev_err(scomp->dev, "%s: Failed to trigger widget %s\n", __func__,
  1575. swidget->widget->name);
  1576. break;
  1577. case SND_SOC_DAPM_POST_PMD:
  1578. if (spcm->stream[stream].suspend_ignored) {
  1579. dev_dbg(scomp->dev,
  1580. "POST_PMD event ignored, KWD pipeline will remain RUNNING\n");
  1581. return 0;
  1582. }
  1583. /* stop trigger */
  1584. ret = sof_ipc3_keyword_detect_trigger(swidget, SOF_IPC_STREAM_TRIG_STOP);
  1585. if (ret < 0)
  1586. dev_err(scomp->dev, "%s: Failed to trigger widget %s\n", __func__,
  1587. swidget->widget->name);
  1588. /* pcm free */
  1589. ret = sof_ipc3_keyword_detect_trigger(swidget, SOF_IPC_STREAM_PCM_FREE);
  1590. if (ret < 0)
  1591. dev_err(scomp->dev, "%s: Failed to free PCM for widget %s\n", __func__,
  1592. swidget->widget->name);
  1593. break;
  1594. default:
  1595. break;
  1596. }
  1597. return ret;
  1598. }
  1599. /* event handlers for keyword detect component */
  1600. static const struct snd_soc_tplg_widget_events sof_kwd_events[] = {
  1601. {SOF_KEYWORD_DETECT_DAPM_EVENT, sof_ipc3_keyword_dapm_event},
  1602. };
  1603. static int sof_ipc3_widget_bind_event(struct snd_soc_component *scomp,
  1604. struct snd_sof_widget *swidget, u16 event_type)
  1605. {
  1606. struct sof_ipc_comp *ipc_comp;
  1607. /* validate widget event type */
  1608. switch (event_type) {
  1609. case SOF_KEYWORD_DETECT_DAPM_EVENT:
  1610. /* only KEYWORD_DETECT comps should handle this */
  1611. if (swidget->id != snd_soc_dapm_effect)
  1612. break;
  1613. ipc_comp = swidget->private;
  1614. if (ipc_comp && ipc_comp->type != SOF_COMP_KEYWORD_DETECT)
  1615. break;
  1616. /* bind event to keyword detect comp */
  1617. return snd_soc_tplg_widget_bind_event(swidget->widget, sof_kwd_events,
  1618. ARRAY_SIZE(sof_kwd_events), event_type);
  1619. default:
  1620. break;
  1621. }
  1622. dev_err(scomp->dev, "Invalid event type %d for widget %s\n", event_type,
  1623. swidget->widget->name);
  1624. return -EINVAL;
  1625. }
  1626. static int sof_ipc3_complete_pipeline(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget)
  1627. {
  1628. struct sof_ipc_pipe_ready ready;
  1629. struct sof_ipc_reply reply;
  1630. int ret;
  1631. dev_dbg(sdev->dev, "tplg: complete pipeline %s id %d\n",
  1632. swidget->widget->name, swidget->comp_id);
  1633. memset(&ready, 0, sizeof(ready));
  1634. ready.hdr.size = sizeof(ready);
  1635. ready.hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_PIPE_COMPLETE;
  1636. ready.comp_id = swidget->comp_id;
  1637. ret = sof_ipc_tx_message(sdev->ipc, &ready, sizeof(ready), &reply, sizeof(reply));
  1638. if (ret < 0)
  1639. return ret;
  1640. return 1;
  1641. }
  1642. static int sof_ipc3_widget_free(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget)
  1643. {
  1644. struct sof_ipc_free ipc_free = {
  1645. .hdr = {
  1646. .size = sizeof(ipc_free),
  1647. .cmd = SOF_IPC_GLB_TPLG_MSG,
  1648. },
  1649. .id = swidget->comp_id,
  1650. };
  1651. struct sof_ipc_reply reply;
  1652. int ret;
  1653. if (!swidget->private)
  1654. return 0;
  1655. switch (swidget->id) {
  1656. case snd_soc_dapm_scheduler:
  1657. {
  1658. ipc_free.hdr.cmd |= SOF_IPC_TPLG_PIPE_FREE;
  1659. break;
  1660. }
  1661. case snd_soc_dapm_buffer:
  1662. ipc_free.hdr.cmd |= SOF_IPC_TPLG_BUFFER_FREE;
  1663. break;
  1664. default:
  1665. ipc_free.hdr.cmd |= SOF_IPC_TPLG_COMP_FREE;
  1666. break;
  1667. }
  1668. ret = sof_ipc_tx_message(sdev->ipc, &ipc_free, sizeof(ipc_free),
  1669. &reply, sizeof(reply));
  1670. if (ret < 0)
  1671. dev_err(sdev->dev, "failed to free widget %s\n", swidget->widget->name);
  1672. return ret;
  1673. }
  1674. static int sof_ipc3_dai_config(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget,
  1675. unsigned int flags, struct snd_sof_dai_config_data *data)
  1676. {
  1677. struct sof_ipc_fw_version *v = &sdev->fw_ready.version;
  1678. struct snd_sof_dai *dai = swidget->private;
  1679. struct sof_dai_private_data *private;
  1680. struct sof_ipc_dai_config *config;
  1681. struct sof_ipc_reply reply;
  1682. int ret = 0;
  1683. if (!dai || !dai->private) {
  1684. dev_err(sdev->dev, "No private data for DAI %s\n", swidget->widget->name);
  1685. return -EINVAL;
  1686. }
  1687. private = dai->private;
  1688. if (!private->dai_config) {
  1689. dev_err(sdev->dev, "No config for DAI %s\n", dai->name);
  1690. return -EINVAL;
  1691. }
  1692. config = &private->dai_config[dai->current_config];
  1693. if (!config) {
  1694. dev_err(sdev->dev, "Invalid current config for DAI %s\n", dai->name);
  1695. return -EINVAL;
  1696. }
  1697. switch (config->type) {
  1698. case SOF_DAI_INTEL_SSP:
  1699. /*
  1700. * DAI_CONFIG IPC during hw_params/hw_free for SSP DAI's is not supported in older
  1701. * firmware
  1702. */
  1703. if (v->abi_version < SOF_ABI_VER(3, 18, 0) &&
  1704. ((flags & SOF_DAI_CONFIG_FLAGS_HW_PARAMS) ||
  1705. (flags & SOF_DAI_CONFIG_FLAGS_HW_FREE)))
  1706. return 0;
  1707. break;
  1708. case SOF_DAI_INTEL_HDA:
  1709. if (data)
  1710. config->hda.link_dma_ch = data->dai_data;
  1711. break;
  1712. case SOF_DAI_INTEL_ALH:
  1713. if (data) {
  1714. config->dai_index = data->dai_index;
  1715. config->alh.stream_id = data->dai_data;
  1716. }
  1717. break;
  1718. default:
  1719. break;
  1720. }
  1721. config->flags = flags;
  1722. /* only send the IPC if the widget is set up in the DSP */
  1723. if (swidget->use_count > 0) {
  1724. ret = sof_ipc_tx_message(sdev->ipc, config, config->hdr.size,
  1725. &reply, sizeof(reply));
  1726. if (ret < 0)
  1727. dev_err(sdev->dev, "Failed to set dai config for %s\n", dai->name);
  1728. }
  1729. return ret;
  1730. }
  1731. static int sof_ipc3_widget_setup(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget)
  1732. {
  1733. struct sof_ipc_comp_reply reply;
  1734. int ret;
  1735. if (!swidget->private)
  1736. return 0;
  1737. switch (swidget->id) {
  1738. case snd_soc_dapm_dai_in:
  1739. case snd_soc_dapm_dai_out:
  1740. {
  1741. struct snd_sof_dai *dai = swidget->private;
  1742. struct sof_dai_private_data *dai_data = dai->private;
  1743. struct sof_ipc_comp *comp = &dai_data->comp_dai->comp;
  1744. ret = sof_ipc_tx_message(sdev->ipc, dai_data->comp_dai,
  1745. comp->hdr.size, &reply, sizeof(reply));
  1746. break;
  1747. }
  1748. case snd_soc_dapm_scheduler:
  1749. {
  1750. struct sof_ipc_pipe_new *pipeline;
  1751. pipeline = swidget->private;
  1752. ret = sof_ipc_tx_message(sdev->ipc, pipeline, sizeof(*pipeline),
  1753. &reply, sizeof(reply));
  1754. break;
  1755. }
  1756. default:
  1757. {
  1758. struct sof_ipc_cmd_hdr *hdr;
  1759. hdr = swidget->private;
  1760. ret = sof_ipc_tx_message(sdev->ipc, swidget->private, hdr->size,
  1761. &reply, sizeof(reply));
  1762. break;
  1763. }
  1764. }
  1765. if (ret < 0)
  1766. dev_err(sdev->dev, "Failed to setup widget %s\n", swidget->widget->name);
  1767. return ret;
  1768. }
  1769. static int sof_ipc3_set_up_all_pipelines(struct snd_sof_dev *sdev, bool verify)
  1770. {
  1771. struct sof_ipc_fw_version *v = &sdev->fw_ready.version;
  1772. struct snd_sof_widget *swidget;
  1773. struct snd_sof_route *sroute;
  1774. int ret;
  1775. /* restore pipeline components */
  1776. list_for_each_entry(swidget, &sdev->widget_list, list) {
  1777. /* only set up the widgets belonging to static pipelines */
  1778. if (!verify && swidget->dynamic_pipeline_widget)
  1779. continue;
  1780. /*
  1781. * For older firmware, skip scheduler widgets in this loop,
  1782. * sof_widget_setup() will be called in the 'complete pipeline' loop
  1783. */
  1784. if (v->abi_version < SOF_ABI_VER(3, 19, 0) &&
  1785. swidget->id == snd_soc_dapm_scheduler)
  1786. continue;
  1787. /* update DAI config. The IPC will be sent in sof_widget_setup() */
  1788. if (WIDGET_IS_DAI(swidget->id)) {
  1789. struct snd_sof_dai *dai = swidget->private;
  1790. struct sof_dai_private_data *private;
  1791. struct sof_ipc_dai_config *config;
  1792. if (!dai || !dai->private)
  1793. continue;
  1794. private = dai->private;
  1795. if (!private->dai_config)
  1796. continue;
  1797. config = private->dai_config;
  1798. /*
  1799. * The link DMA channel would be invalidated for running
  1800. * streams but not for streams that were in the PAUSED
  1801. * state during suspend. So invalidate it here before setting
  1802. * the dai config in the DSP.
  1803. */
  1804. if (config->type == SOF_DAI_INTEL_HDA)
  1805. config->hda.link_dma_ch = DMA_CHAN_INVALID;
  1806. }
  1807. ret = sof_widget_setup(sdev, swidget);
  1808. if (ret < 0)
  1809. return ret;
  1810. }
  1811. /* restore pipeline connections */
  1812. list_for_each_entry(sroute, &sdev->route_list, list) {
  1813. /* only set up routes belonging to static pipelines */
  1814. if (!verify && (sroute->src_widget->dynamic_pipeline_widget ||
  1815. sroute->sink_widget->dynamic_pipeline_widget))
  1816. continue;
  1817. /*
  1818. * For virtual routes, both sink and source are not buffer. IPC3 only supports
  1819. * connections between a buffer and a component. Ignore the rest.
  1820. */
  1821. if (sroute->src_widget->id != snd_soc_dapm_buffer &&
  1822. sroute->sink_widget->id != snd_soc_dapm_buffer)
  1823. continue;
  1824. ret = sof_route_setup(sdev, sroute->src_widget->widget,
  1825. sroute->sink_widget->widget);
  1826. if (ret < 0) {
  1827. dev_err(sdev->dev, "%s: route set up failed\n", __func__);
  1828. return ret;
  1829. }
  1830. }
  1831. /* complete pipeline */
  1832. list_for_each_entry(swidget, &sdev->widget_list, list) {
  1833. switch (swidget->id) {
  1834. case snd_soc_dapm_scheduler:
  1835. /* only complete static pipelines */
  1836. if (!verify && swidget->dynamic_pipeline_widget)
  1837. continue;
  1838. if (v->abi_version < SOF_ABI_VER(3, 19, 0)) {
  1839. ret = sof_widget_setup(sdev, swidget);
  1840. if (ret < 0)
  1841. return ret;
  1842. }
  1843. swidget->complete = sof_ipc3_complete_pipeline(sdev, swidget);
  1844. if (swidget->complete < 0)
  1845. return swidget->complete;
  1846. break;
  1847. default:
  1848. break;
  1849. }
  1850. }
  1851. return 0;
  1852. }
  1853. /*
  1854. * Free the PCM, its associated widgets and set the prepared flag to false for all PCMs that
  1855. * did not get suspended(ex: paused streams) so the widgets can be set up again during resume.
  1856. */
  1857. static int sof_tear_down_left_over_pipelines(struct snd_sof_dev *sdev)
  1858. {
  1859. struct snd_sof_widget *swidget;
  1860. struct snd_sof_pcm *spcm;
  1861. int dir, ret;
  1862. /*
  1863. * free all PCMs and their associated DAPM widgets if their connected DAPM widget
  1864. * list is not NULL. This should only be true for paused streams at this point.
  1865. * This is equivalent to the handling of FE DAI suspend trigger for running streams.
  1866. */
  1867. list_for_each_entry(spcm, &sdev->pcm_list, list) {
  1868. for_each_pcm_streams(dir) {
  1869. struct snd_pcm_substream *substream = spcm->stream[dir].substream;
  1870. if (!substream || !substream->runtime)
  1871. continue;
  1872. if (spcm->stream[dir].list) {
  1873. ret = sof_pcm_stream_free(sdev, substream, spcm, dir, true);
  1874. if (ret < 0)
  1875. return ret;
  1876. }
  1877. }
  1878. }
  1879. /*
  1880. * free any left over DAI widgets. This is equivalent to the handling of suspend trigger
  1881. * for the BE DAI for running streams.
  1882. */
  1883. list_for_each_entry(swidget, &sdev->widget_list, list)
  1884. if (WIDGET_IS_DAI(swidget->id) && swidget->use_count == 1) {
  1885. ret = sof_widget_free(sdev, swidget);
  1886. if (ret < 0)
  1887. return ret;
  1888. }
  1889. return 0;
  1890. }
  1891. /*
  1892. * For older firmware, this function doesn't free widgets for static pipelines during suspend.
  1893. * It only resets use_count for all widgets.
  1894. */
  1895. static int sof_ipc3_tear_down_all_pipelines(struct snd_sof_dev *sdev, bool verify)
  1896. {
  1897. struct sof_ipc_fw_version *v = &sdev->fw_ready.version;
  1898. struct snd_sof_widget *swidget;
  1899. struct snd_sof_route *sroute;
  1900. bool dyn_widgets = false;
  1901. int ret;
  1902. /*
  1903. * This function is called during suspend and for one-time topology verification during
  1904. * first boot. In both cases, there is no need to protect swidget->use_count and
  1905. * sroute->setup because during suspend all running streams are suspended and during
  1906. * topology loading the sound card unavailable to open PCMs.
  1907. */
  1908. list_for_each_entry(swidget, &sdev->widget_list, list) {
  1909. if (swidget->dynamic_pipeline_widget) {
  1910. dyn_widgets = true;
  1911. continue;
  1912. }
  1913. /* Do not free widgets for static pipelines with FW older than SOF2.2 */
  1914. if (!verify && !swidget->dynamic_pipeline_widget &&
  1915. SOF_FW_VER(v->major, v->minor, v->micro) < SOF_FW_VER(2, 2, 0)) {
  1916. swidget->use_count = 0;
  1917. swidget->complete = 0;
  1918. continue;
  1919. }
  1920. ret = sof_widget_free(sdev, swidget);
  1921. if (ret < 0)
  1922. return ret;
  1923. }
  1924. /*
  1925. * Tear down all pipelines associated with PCMs that did not get suspended
  1926. * and unset the prepare flag so that they can be set up again during resume.
  1927. * Skip this step for older firmware unless topology has any
  1928. * dynamic pipeline (in which case the step is mandatory).
  1929. */
  1930. if (!verify && (dyn_widgets || SOF_FW_VER(v->major, v->minor, v->micro) >=
  1931. SOF_FW_VER(2, 2, 0))) {
  1932. ret = sof_tear_down_left_over_pipelines(sdev);
  1933. if (ret < 0) {
  1934. dev_err(sdev->dev, "failed to tear down paused pipelines\n");
  1935. return ret;
  1936. }
  1937. }
  1938. list_for_each_entry(sroute, &sdev->route_list, list)
  1939. sroute->setup = false;
  1940. /*
  1941. * before suspending, make sure the refcounts are all zeroed out. There's no way
  1942. * to recover at this point but this will help root cause bad sequences leading to
  1943. * more issues on resume
  1944. */
  1945. list_for_each_entry(swidget, &sdev->widget_list, list) {
  1946. if (swidget->use_count != 0) {
  1947. dev_err(sdev->dev, "%s: widget %s is still in use: count %d\n",
  1948. __func__, swidget->widget->name, swidget->use_count);
  1949. }
  1950. }
  1951. return 0;
  1952. }
  1953. static int sof_ipc3_dai_get_clk(struct snd_sof_dev *sdev, struct snd_sof_dai *dai, int clk_type)
  1954. {
  1955. struct sof_dai_private_data *private = dai->private;
  1956. if (!private || !private->dai_config)
  1957. return 0;
  1958. switch (private->dai_config->type) {
  1959. case SOF_DAI_INTEL_SSP:
  1960. switch (clk_type) {
  1961. case SOF_DAI_CLK_INTEL_SSP_MCLK:
  1962. return private->dai_config->ssp.mclk_rate;
  1963. case SOF_DAI_CLK_INTEL_SSP_BCLK:
  1964. return private->dai_config->ssp.bclk_rate;
  1965. default:
  1966. break;
  1967. }
  1968. dev_err(sdev->dev, "fail to get SSP clk %d rate\n", clk_type);
  1969. break;
  1970. default:
  1971. /* not yet implemented for platforms other than the above */
  1972. dev_err(sdev->dev, "DAI type %d not supported yet!\n", private->dai_config->type);
  1973. break;
  1974. }
  1975. return -EINVAL;
  1976. }
  1977. static int sof_ipc3_parse_manifest(struct snd_soc_component *scomp, int index,
  1978. struct snd_soc_tplg_manifest *man)
  1979. {
  1980. u32 size = le32_to_cpu(man->priv.size);
  1981. u32 abi_version;
  1982. /* backward compatible with tplg without ABI info */
  1983. if (!size) {
  1984. dev_dbg(scomp->dev, "No topology ABI info\n");
  1985. return 0;
  1986. }
  1987. if (size != SOF_IPC3_TPLG_ABI_SIZE) {
  1988. dev_err(scomp->dev, "%s: Invalid topology ABI size: %u\n",
  1989. __func__, size);
  1990. return -EINVAL;
  1991. }
  1992. dev_info(scomp->dev,
  1993. "Topology: ABI %d:%d:%d Kernel ABI %d:%d:%d\n",
  1994. man->priv.data[0], man->priv.data[1], man->priv.data[2],
  1995. SOF_ABI_MAJOR, SOF_ABI_MINOR, SOF_ABI_PATCH);
  1996. abi_version = SOF_ABI_VER(man->priv.data[0], man->priv.data[1], man->priv.data[2]);
  1997. if (SOF_ABI_VERSION_INCOMPATIBLE(SOF_ABI_VERSION, abi_version)) {
  1998. dev_err(scomp->dev, "%s: Incompatible topology ABI version\n", __func__);
  1999. return -EINVAL;
  2000. }
  2001. if (IS_ENABLED(CONFIG_SND_SOC_SOF_STRICT_ABI_CHECKS) &&
  2002. SOF_ABI_VERSION_MINOR(abi_version) > SOF_ABI_MINOR) {
  2003. dev_err(scomp->dev, "%s: Topology ABI is more recent than kernel\n", __func__);
  2004. return -EINVAL;
  2005. }
  2006. return 0;
  2007. }
  2008. /* token list for each topology object */
  2009. static enum sof_tokens host_token_list[] = {
  2010. SOF_CORE_TOKENS,
  2011. SOF_COMP_EXT_TOKENS,
  2012. SOF_PCM_TOKENS,
  2013. SOF_COMP_TOKENS,
  2014. };
  2015. static enum sof_tokens comp_generic_token_list[] = {
  2016. SOF_CORE_TOKENS,
  2017. SOF_COMP_EXT_TOKENS,
  2018. SOF_COMP_TOKENS,
  2019. };
  2020. static enum sof_tokens buffer_token_list[] = {
  2021. SOF_BUFFER_TOKENS,
  2022. };
  2023. static enum sof_tokens pipeline_token_list[] = {
  2024. SOF_CORE_TOKENS,
  2025. SOF_COMP_EXT_TOKENS,
  2026. SOF_PIPELINE_TOKENS,
  2027. SOF_SCHED_TOKENS,
  2028. };
  2029. static enum sof_tokens asrc_token_list[] = {
  2030. SOF_CORE_TOKENS,
  2031. SOF_COMP_EXT_TOKENS,
  2032. SOF_ASRC_TOKENS,
  2033. SOF_COMP_TOKENS,
  2034. };
  2035. static enum sof_tokens src_token_list[] = {
  2036. SOF_CORE_TOKENS,
  2037. SOF_COMP_EXT_TOKENS,
  2038. SOF_SRC_TOKENS,
  2039. SOF_COMP_TOKENS
  2040. };
  2041. static enum sof_tokens pga_token_list[] = {
  2042. SOF_CORE_TOKENS,
  2043. SOF_COMP_EXT_TOKENS,
  2044. SOF_VOLUME_TOKENS,
  2045. SOF_COMP_TOKENS,
  2046. };
  2047. static enum sof_tokens dai_token_list[] = {
  2048. SOF_CORE_TOKENS,
  2049. SOF_COMP_EXT_TOKENS,
  2050. SOF_DAI_TOKENS,
  2051. SOF_COMP_TOKENS,
  2052. };
  2053. static enum sof_tokens process_token_list[] = {
  2054. SOF_CORE_TOKENS,
  2055. SOF_COMP_EXT_TOKENS,
  2056. SOF_PROCESS_TOKENS,
  2057. SOF_COMP_TOKENS,
  2058. };
  2059. static const struct sof_ipc_tplg_widget_ops tplg_ipc3_widget_ops[SND_SOC_DAPM_TYPE_COUNT] = {
  2060. [snd_soc_dapm_aif_in] = {sof_ipc3_widget_setup_comp_host, sof_ipc3_widget_free_comp,
  2061. host_token_list, ARRAY_SIZE(host_token_list), NULL},
  2062. [snd_soc_dapm_aif_out] = {sof_ipc3_widget_setup_comp_host, sof_ipc3_widget_free_comp,
  2063. host_token_list, ARRAY_SIZE(host_token_list), NULL},
  2064. [snd_soc_dapm_dai_in] = {sof_ipc3_widget_setup_comp_dai, sof_ipc3_widget_free_comp_dai,
  2065. dai_token_list, ARRAY_SIZE(dai_token_list), NULL},
  2066. [snd_soc_dapm_dai_out] = {sof_ipc3_widget_setup_comp_dai, sof_ipc3_widget_free_comp_dai,
  2067. dai_token_list, ARRAY_SIZE(dai_token_list), NULL},
  2068. [snd_soc_dapm_buffer] = {sof_ipc3_widget_setup_comp_buffer, sof_ipc3_widget_free_comp,
  2069. buffer_token_list, ARRAY_SIZE(buffer_token_list), NULL},
  2070. [snd_soc_dapm_mixer] = {sof_ipc3_widget_setup_comp_mixer, sof_ipc3_widget_free_comp,
  2071. comp_generic_token_list, ARRAY_SIZE(comp_generic_token_list),
  2072. NULL},
  2073. [snd_soc_dapm_src] = {sof_ipc3_widget_setup_comp_src, sof_ipc3_widget_free_comp,
  2074. src_token_list, ARRAY_SIZE(src_token_list), NULL},
  2075. [snd_soc_dapm_asrc] = {sof_ipc3_widget_setup_comp_asrc, sof_ipc3_widget_free_comp,
  2076. asrc_token_list, ARRAY_SIZE(asrc_token_list), NULL},
  2077. [snd_soc_dapm_siggen] = {sof_ipc3_widget_setup_comp_tone, sof_ipc3_widget_free_comp,
  2078. comp_generic_token_list, ARRAY_SIZE(comp_generic_token_list),
  2079. NULL},
  2080. [snd_soc_dapm_scheduler] = {sof_ipc3_widget_setup_comp_pipeline, sof_ipc3_widget_free_comp,
  2081. pipeline_token_list, ARRAY_SIZE(pipeline_token_list), NULL},
  2082. [snd_soc_dapm_pga] = {sof_ipc3_widget_setup_comp_pga, sof_ipc3_widget_free_comp,
  2083. pga_token_list, ARRAY_SIZE(pga_token_list), NULL},
  2084. [snd_soc_dapm_mux] = {sof_ipc3_widget_setup_comp_mux, sof_ipc3_widget_free_comp,
  2085. comp_generic_token_list, ARRAY_SIZE(comp_generic_token_list), NULL},
  2086. [snd_soc_dapm_demux] = {sof_ipc3_widget_setup_comp_mux, sof_ipc3_widget_free_comp,
  2087. comp_generic_token_list, ARRAY_SIZE(comp_generic_token_list),
  2088. NULL},
  2089. [snd_soc_dapm_effect] = {sof_widget_update_ipc_comp_process, sof_ipc3_widget_free_comp,
  2090. process_token_list, ARRAY_SIZE(process_token_list),
  2091. sof_ipc3_widget_bind_event},
  2092. };
  2093. const struct sof_ipc_tplg_ops ipc3_tplg_ops = {
  2094. .widget = tplg_ipc3_widget_ops,
  2095. .control = &tplg_ipc3_control_ops,
  2096. .route_setup = sof_ipc3_route_setup,
  2097. .control_setup = sof_ipc3_control_setup,
  2098. .control_free = sof_ipc3_control_free,
  2099. .pipeline_complete = sof_ipc3_complete_pipeline,
  2100. .token_list = ipc3_token_list,
  2101. .widget_free = sof_ipc3_widget_free,
  2102. .widget_setup = sof_ipc3_widget_setup,
  2103. .dai_config = sof_ipc3_dai_config,
  2104. .dai_get_clk = sof_ipc3_dai_get_clk,
  2105. .set_up_all_pipelines = sof_ipc3_set_up_all_pipelines,
  2106. .tear_down_all_pipelines = sof_ipc3_tear_down_all_pipelines,
  2107. .parse_manifest = sof_ipc3_parse_manifest,
  2108. };