msm-lsm-client.c 79 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955
  1. /*
  2. * Copyright (c) 2013-2018, The Linux Foundation. All rights reserved.
  3. *
  4. * This program is free software; you can redistribute it and/or modify
  5. * it under the terms of the GNU General Public License version 2 and
  6. * only version 2 as published by the Free Software Foundation.
  7. *
  8. * This program is distributed in the hope that it will be useful,
  9. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11. * GNU General Public License for more details.
  12. */
  13. #include <linux/init.h>
  14. #include <linux/err.h>
  15. #include <linux/module.h>
  16. #include <linux/time.h>
  17. #include <linux/wait.h>
  18. #include <linux/platform_device.h>
  19. #include <linux/slab.h>
  20. #include <linux/dma-mapping.h>
  21. #include <linux/of.h>
  22. #include <linux/freezer.h>
  23. #include <sound/core.h>
  24. #include <sound/soc.h>
  25. #include <sound/soc-dapm.h>
  26. #include <sound/pcm.h>
  27. #include <sound/timer.h>
  28. #include <sound/initval.h>
  29. #include <sound/control.h>
  30. #include <sound/lsm_params.h>
  31. #include <sound/pcm_params.h>
  32. #include <dsp/msm_audio_ion.h>
  33. #include <dsp/q6lsm.h>
  34. #include "msm-pcm-routing-v2.h"
  35. #define CAPTURE_MIN_NUM_PERIODS 2
  36. #define CAPTURE_MAX_NUM_PERIODS 8
  37. #define CAPTURE_MAX_PERIOD_SIZE 61440
  38. #define CAPTURE_MIN_PERIOD_SIZE 320
  39. #define LISTEN_MAX_STATUS_PAYLOAD_SIZE 256
  40. #define LAB_BUFFER_ALLOC 1
  41. #define LAB_BUFFER_DEALLOC 0
  42. #define LSM_IS_LAST_STAGE(client, stage_idx) \
  43. (client->num_stages == (stage_idx + 1))
  44. static struct snd_pcm_hardware msm_pcm_hardware_capture = {
  45. .info = (SNDRV_PCM_INFO_MMAP |
  46. SNDRV_PCM_INFO_BLOCK_TRANSFER |
  47. SNDRV_PCM_INFO_INTERLEAVED |
  48. SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_RESUME),
  49. .formats = (SNDRV_PCM_FMTBIT_S16_LE |
  50. SNDRV_PCM_FMTBIT_S24_LE),
  51. .rates = (SNDRV_PCM_RATE_16000 |
  52. SNDRV_PCM_RATE_48000),
  53. .rate_min = 16000,
  54. .rate_max = 48000,
  55. .channels_min = LSM_INPUT_NUM_CHANNELS_MIN,
  56. .channels_max = LSM_INPUT_NUM_CHANNELS_MAX,
  57. .buffer_bytes_max = CAPTURE_MAX_NUM_PERIODS *
  58. CAPTURE_MAX_PERIOD_SIZE,
  59. .period_bytes_min = CAPTURE_MIN_PERIOD_SIZE,
  60. .period_bytes_max = CAPTURE_MAX_PERIOD_SIZE,
  61. .periods_min = CAPTURE_MIN_NUM_PERIODS,
  62. .periods_max = CAPTURE_MAX_NUM_PERIODS,
  63. .fifo_size = 0,
  64. };
  65. /* Conventional and unconventional sample rate supported */
  66. static unsigned int supported_sample_rates[] = {
  67. 16000, 48000,
  68. };
  69. static struct snd_pcm_hw_constraint_list constraints_sample_rates = {
  70. .count = ARRAY_SIZE(supported_sample_rates),
  71. .list = supported_sample_rates,
  72. .mask = 0,
  73. };
  74. struct lsm_priv {
  75. struct snd_pcm_substream *substream;
  76. struct lsm_client *lsm_client;
  77. struct snd_lsm_event_status_v3 *event_status;
  78. struct snd_lsm_event_status *det_event;
  79. spinlock_t event_lock;
  80. wait_queue_head_t event_wait;
  81. unsigned long event_avail;
  82. atomic_t event_wait_stop;
  83. atomic_t buf_count;
  84. atomic_t read_abort;
  85. wait_queue_head_t period_wait;
  86. struct mutex lsm_api_lock;
  87. int appl_cnt;
  88. int dma_write;
  89. };
  90. enum { /* lsm session states */
  91. IDLE = 0,
  92. RUNNING,
  93. };
  94. static int msm_lsm_queue_lab_buffer(struct lsm_priv *prtd, int i)
  95. {
  96. int rc = 0;
  97. struct lsm_cmd_read cmd_read;
  98. struct snd_soc_pcm_runtime *rtd;
  99. if (!prtd || !prtd->lsm_client) {
  100. pr_err("%s: Invalid params prtd %pK lsm client %pK\n",
  101. __func__, prtd, ((!prtd) ? NULL : prtd->lsm_client));
  102. return -EINVAL;
  103. }
  104. if (!prtd->substream || !prtd->substream->private_data) {
  105. pr_err("%s: Invalid %s\n", __func__,
  106. (!prtd->substream) ? "substream" : "private_data");
  107. return -EINVAL;
  108. }
  109. rtd = prtd->substream->private_data;
  110. if (!prtd->lsm_client->lab_buffer ||
  111. i >= prtd->lsm_client->out_hw_params.period_count) {
  112. dev_err(rtd->dev,
  113. "%s: Lab buffer not setup %pK incorrect index %d period count %d\n",
  114. __func__, prtd->lsm_client->lab_buffer, i,
  115. prtd->lsm_client->out_hw_params.period_count);
  116. return -EINVAL;
  117. }
  118. cmd_read.buf_addr_lsw =
  119. lower_32_bits(prtd->lsm_client->lab_buffer[i].phys);
  120. cmd_read.buf_addr_msw =
  121. msm_audio_populate_upper_32_bits(
  122. prtd->lsm_client->lab_buffer[i].phys);
  123. cmd_read.buf_size = prtd->lsm_client->lab_buffer[i].size;
  124. cmd_read.mem_map_handle =
  125. prtd->lsm_client->lab_buffer[i].mem_map_handle;
  126. rc = q6lsm_read(prtd->lsm_client, &cmd_read);
  127. if (rc)
  128. dev_err(rtd->dev,
  129. "%s: error in queuing the lab buffer rc %d\n",
  130. __func__, rc);
  131. return rc;
  132. }
  133. static int lsm_lab_buffer_sanity(struct lsm_priv *prtd,
  134. struct lsm_cmd_read_done *read_done, int *index)
  135. {
  136. int i = 0, rc = -EINVAL;
  137. struct snd_soc_pcm_runtime *rtd;
  138. if (!prtd || !read_done || !index) {
  139. pr_err("%s: Invalid params prtd %pK read_done %pK index %pK\n",
  140. __func__, prtd, read_done, index);
  141. return -EINVAL;
  142. }
  143. if (!prtd->substream || !prtd->substream->private_data) {
  144. pr_err("%s: Invalid %s\n", __func__,
  145. (!prtd->substream) ? "substream" : "private_data");
  146. return -EINVAL;
  147. }
  148. rtd = prtd->substream->private_data;
  149. if (!prtd->lsm_client->lab_enable || !prtd->lsm_client->lab_buffer) {
  150. dev_err(rtd->dev,
  151. "%s: Lab not enabled %d invalid lab buffer %pK\n",
  152. __func__, prtd->lsm_client->lab_enable,
  153. prtd->lsm_client->lab_buffer);
  154. return -EINVAL;
  155. }
  156. for (i = 0; i < prtd->lsm_client->out_hw_params.period_count; i++) {
  157. if ((lower_32_bits(prtd->lsm_client->lab_buffer[i].phys) ==
  158. read_done->buf_addr_lsw) &&
  159. (msm_audio_populate_upper_32_bits
  160. (prtd->lsm_client->lab_buffer[i].phys) ==
  161. read_done->buf_addr_msw) &&
  162. (prtd->lsm_client->lab_buffer[i].mem_map_handle ==
  163. read_done->mem_map_handle)) {
  164. dev_dbg(rtd->dev,
  165. "%s: Buffer found %pK memmap handle %d\n",
  166. __func__, &prtd->lsm_client->lab_buffer[i].phys,
  167. prtd->lsm_client->lab_buffer[i].mem_map_handle);
  168. if (read_done->total_size >
  169. prtd->lsm_client->lab_buffer[i].size) {
  170. dev_err(rtd->dev,
  171. "%s: Size mismatch call back size %d actual size %zd\n",
  172. __func__, read_done->total_size,
  173. prtd->lsm_client->lab_buffer[i].size);
  174. rc = -EINVAL;
  175. break;
  176. } else {
  177. *index = i;
  178. rc = 0;
  179. break;
  180. }
  181. }
  182. }
  183. return rc;
  184. }
  185. static void lsm_event_handler(uint32_t opcode, uint32_t token,
  186. uint32_t *payload, void *priv)
  187. {
  188. unsigned long flags;
  189. struct lsm_priv *prtd = priv;
  190. struct snd_pcm_substream *substream = prtd->substream;
  191. struct snd_soc_pcm_runtime *rtd;
  192. struct snd_lsm_event_status_v3 *temp;
  193. uint16_t status = 0;
  194. uint16_t payload_size = 0;
  195. uint16_t index = 0;
  196. uint32_t event_ts_lsw = 0;
  197. uint32_t event_ts_msw = 0;
  198. if (!substream || !substream->private_data) {
  199. pr_err("%s: Invalid %s\n", __func__,
  200. (!substream) ? "substream" : "private_data");
  201. return;
  202. }
  203. rtd = substream->private_data;
  204. switch (opcode) {
  205. case LSM_DATA_EVENT_READ_DONE: {
  206. int rc;
  207. struct lsm_cmd_read_done *read_done = (struct lsm_cmd_read_done *)payload;
  208. int buf_index = 0;
  209. if (prtd->lsm_client->session != token ||
  210. !read_done) {
  211. dev_err(rtd->dev,
  212. "%s: EVENT_READ_DONE invalid callback, session %d callback %d payload %pK",
  213. __func__, prtd->lsm_client->session,
  214. token, read_done);
  215. return;
  216. }
  217. if (atomic_read(&prtd->read_abort)) {
  218. dev_dbg(rtd->dev,
  219. "%s: read abort set skip data\n", __func__);
  220. return;
  221. }
  222. if (!lsm_lab_buffer_sanity(prtd, read_done, &buf_index)) {
  223. dev_dbg(rtd->dev,
  224. "%s: process read done index %d\n",
  225. __func__, buf_index);
  226. if (buf_index >=
  227. prtd->lsm_client->out_hw_params.period_count) {
  228. dev_err(rtd->dev,
  229. "%s: Invalid index %d buf_index max cnt %d\n",
  230. __func__, buf_index,
  231. prtd->lsm_client->out_hw_params.period_count);
  232. return;
  233. }
  234. prtd->dma_write += read_done->total_size;
  235. atomic_inc(&prtd->buf_count);
  236. snd_pcm_period_elapsed(substream);
  237. wake_up(&prtd->period_wait);
  238. /* queue the next period buffer */
  239. buf_index = (buf_index + 1) %
  240. prtd->lsm_client->out_hw_params.period_count;
  241. rc = msm_lsm_queue_lab_buffer(prtd, buf_index);
  242. if (rc)
  243. dev_err(rtd->dev,
  244. "%s: error in queuing the lab buffer rc %d\n",
  245. __func__, rc);
  246. } else
  247. dev_err(rtd->dev, "%s: Invalid lab buffer returned by dsp\n",
  248. __func__);
  249. break;
  250. }
  251. case LSM_SESSION_EVENT_DETECTION_STATUS:
  252. status = (uint16_t)((uint8_t *)payload)[0];
  253. payload_size = (uint16_t)((uint8_t *)payload)[2];
  254. index = 4;
  255. dev_dbg(rtd->dev,
  256. "%s: event detect status = %d payload size = %d\n",
  257. __func__, status, payload_size);
  258. break;
  259. case LSM_SESSION_EVENT_DETECTION_STATUS_V2:
  260. status = (uint16_t)((uint8_t *)payload)[0];
  261. payload_size = (uint16_t)((uint8_t *)payload)[1];
  262. index = 2;
  263. dev_dbg(rtd->dev,
  264. "%s: event detect status = %d payload size = %d\n",
  265. __func__, status, payload_size);
  266. break;
  267. case LSM_SESSION_EVENT_DETECTION_STATUS_V3:
  268. event_ts_lsw = ((uint32_t *)payload)[0];
  269. event_ts_msw = ((uint32_t *)payload)[1];
  270. status = (uint16_t)((uint8_t *)payload)[8];
  271. payload_size = (uint16_t)((uint8_t *)payload)[9];
  272. index = 10;
  273. dev_dbg(rtd->dev,
  274. "%s: ts_msw = %u, ts_lsw = %u, event detect status = %d payload size = %d\n",
  275. __func__, event_ts_msw, event_ts_lsw, status,
  276. payload_size);
  277. break;
  278. case LSM_SESSION_DETECTION_ENGINE_GENERIC_EVENT: {
  279. struct snd_lsm_event_status *tmp;
  280. status = ((uint16_t *)payload)[0];
  281. payload_size = ((uint16_t *)payload)[1];
  282. spin_lock_irqsave(&prtd->event_lock, flags);
  283. tmp = krealloc(prtd->det_event,
  284. sizeof(struct snd_lsm_event_status) +
  285. payload_size, GFP_ATOMIC);
  286. if (!tmp) {
  287. spin_unlock_irqrestore(&prtd->event_lock, flags);
  288. dev_err(rtd->dev,
  289. "%s: Failed to allocate memory for %s, size = %lu\n",
  290. __func__,
  291. "LSM_SESSION_DETECTION_ENGINE_GENERIC_EVENT",
  292. sizeof(struct snd_lsm_event_status) +
  293. payload_size);
  294. return;
  295. }
  296. prtd->det_event = tmp;
  297. prtd->det_event->status = status;
  298. prtd->det_event->payload_size = payload_size;
  299. memcpy(prtd->det_event->payload, &((uint8_t *)payload)[4],
  300. payload_size);
  301. prtd->event_avail = 1;
  302. spin_unlock_irqrestore(&prtd->event_lock, flags);
  303. wake_up(&prtd->event_wait);
  304. if (substream->timer_running)
  305. snd_timer_interrupt(substream->timer, 1);
  306. dev_dbg(rtd->dev,
  307. "%s: Generic det event status = %d payload size = %d\n",
  308. __func__, prtd->det_event->status,
  309. prtd->det_event->payload_size);
  310. break;
  311. }
  312. default:
  313. break;
  314. }
  315. if (opcode == LSM_SESSION_EVENT_DETECTION_STATUS ||
  316. opcode == LSM_SESSION_EVENT_DETECTION_STATUS_V2 ||
  317. opcode == LSM_SESSION_EVENT_DETECTION_STATUS_V3) {
  318. spin_lock_irqsave(&prtd->event_lock, flags);
  319. temp = krealloc(prtd->event_status,
  320. sizeof(struct snd_lsm_event_status_v3) +
  321. payload_size, GFP_ATOMIC);
  322. if (!temp) {
  323. dev_err(rtd->dev, "%s: no memory for event status\n",
  324. __func__);
  325. return;
  326. }
  327. /*
  328. * event status timestamp will be non-zero and valid if
  329. * opcode is LSM_SESSION_EVENT_DETECTION_STATUS_V3
  330. */
  331. prtd->event_status = temp;
  332. prtd->event_status->timestamp_lsw = event_ts_lsw;
  333. prtd->event_status->timestamp_msw = event_ts_msw;
  334. prtd->event_status->status = status;
  335. prtd->event_status->payload_size = payload_size;
  336. if (likely(prtd->event_status)) {
  337. memcpy(prtd->event_status->payload,
  338. &((uint8_t *)payload)[index],
  339. payload_size);
  340. prtd->event_avail = 1;
  341. spin_unlock_irqrestore(&prtd->event_lock, flags);
  342. wake_up(&prtd->event_wait);
  343. } else {
  344. spin_unlock_irqrestore(&prtd->event_lock, flags);
  345. dev_err(rtd->dev,
  346. "%s: Couldn't allocate %d bytes of memory\n",
  347. __func__, payload_size);
  348. }
  349. if (substream->timer_running)
  350. snd_timer_interrupt(substream->timer, 1);
  351. }
  352. }
  353. static int msm_lsm_lab_buffer_alloc(struct lsm_priv *lsm, int alloc)
  354. {
  355. int ret = 0;
  356. struct snd_dma_buffer *dma_buf = NULL;
  357. if (!lsm) {
  358. pr_err("%s: Invalid param lsm %pK\n", __func__, lsm);
  359. return -EINVAL;
  360. }
  361. if (alloc) {
  362. if (!lsm->substream) {
  363. pr_err("%s: substream is NULL\n", __func__);
  364. return -EINVAL;
  365. }
  366. ret = q6lsm_lab_buffer_alloc(lsm->lsm_client, alloc);
  367. if (ret) {
  368. pr_err("%s: alloc lab buffer failed ret %d\n",
  369. __func__, ret);
  370. goto exit;
  371. }
  372. dma_buf = &lsm->substream->dma_buffer;
  373. dma_buf->dev.type = SNDRV_DMA_TYPE_DEV;
  374. dma_buf->dev.dev = lsm->substream->pcm->card->dev;
  375. dma_buf->private_data = NULL;
  376. dma_buf->area = lsm->lsm_client->lab_buffer[0].data;
  377. dma_buf->addr = lsm->lsm_client->lab_buffer[0].phys;
  378. dma_buf->bytes = lsm->lsm_client->out_hw_params.buf_sz *
  379. lsm->lsm_client->out_hw_params.period_count;
  380. snd_pcm_set_runtime_buffer(lsm->substream, dma_buf);
  381. } else {
  382. ret = q6lsm_lab_buffer_alloc(lsm->lsm_client, alloc);
  383. if (ret)
  384. pr_err("%s: free lab buffer failed ret %d\n",
  385. __func__, ret);
  386. kfree(lsm->lsm_client->lab_buffer);
  387. lsm->lsm_client->lab_buffer = NULL;
  388. }
  389. exit:
  390. return ret;
  391. }
  392. static int msm_lsm_get_conf_levels(struct lsm_client *client,
  393. u8 *conf_levels_ptr)
  394. {
  395. int rc = 0;
  396. if (client->num_confidence_levels == 0) {
  397. pr_debug("%s: no confidence levels provided\n",
  398. __func__);
  399. client->confidence_levels = NULL;
  400. goto done;
  401. }
  402. client->confidence_levels =
  403. kzalloc((sizeof(uint8_t) * client->num_confidence_levels),
  404. GFP_KERNEL);
  405. if (!client->confidence_levels) {
  406. pr_err("%s: No memory for confidence\n"
  407. "levels num of level from user = %d\n",
  408. __func__, client->num_confidence_levels);
  409. rc = -ENOMEM;
  410. goto done;
  411. }
  412. if (copy_from_user(client->confidence_levels,
  413. conf_levels_ptr,
  414. client->num_confidence_levels)) {
  415. pr_err("%s: copy from user failed, size = %d\n",
  416. __func__, client->num_confidence_levels);
  417. rc = -EFAULT;
  418. goto copy_err;
  419. }
  420. return rc;
  421. copy_err:
  422. kfree(client->confidence_levels);
  423. client->confidence_levels = NULL;
  424. done:
  425. return rc;
  426. }
  427. static int msm_lsm_set_epd(struct snd_pcm_substream *substream,
  428. struct lsm_params_info_v2 *p_info)
  429. {
  430. struct snd_pcm_runtime *runtime = substream->runtime;
  431. struct lsm_priv *prtd = runtime->private_data;
  432. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  433. int rc = 0;
  434. struct snd_lsm_ep_det_thres epd_th;
  435. if (p_info->param_size != sizeof(epd_th)) {
  436. dev_err(rtd->dev,
  437. "%s: Invalid param_size %d\n",
  438. __func__, p_info->param_size);
  439. rc = -EINVAL;
  440. goto done;
  441. }
  442. if (copy_from_user(&epd_th, p_info->param_data,
  443. p_info->param_size)) {
  444. dev_err(rtd->dev,
  445. "%s: copy_from_user failed, size = %d\n",
  446. __func__, p_info->param_size);
  447. rc = -EFAULT;
  448. goto done;
  449. }
  450. rc = q6lsm_set_one_param(prtd->lsm_client, p_info,
  451. &epd_th, LSM_ENDPOINT_DETECT_THRESHOLD);
  452. if (rc)
  453. dev_err(rtd->dev,
  454. "%s: Failed to set epd param, err = %d\n",
  455. __func__, rc);
  456. done:
  457. return rc;
  458. }
  459. static int msm_lsm_set_mode(struct snd_pcm_substream *substream,
  460. struct lsm_params_info_v2 *p_info)
  461. {
  462. struct snd_pcm_runtime *runtime = substream->runtime;
  463. struct lsm_priv *prtd = runtime->private_data;
  464. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  465. struct snd_lsm_detect_mode mode;
  466. int rc = 0;
  467. if (p_info->param_size != sizeof(mode)) {
  468. dev_err(rtd->dev,
  469. "%s: Invalid param_size %d\n",
  470. __func__, p_info->param_size);
  471. rc = -EINVAL;
  472. goto done;
  473. }
  474. if (copy_from_user(&mode, p_info->param_data,
  475. sizeof(mode))) {
  476. dev_err(rtd->dev,
  477. "%s: copy_from_user failed, size = %zd\n",
  478. __func__, sizeof(mode));
  479. rc = -EFAULT;
  480. goto done;
  481. }
  482. rc = q6lsm_set_one_param(prtd->lsm_client, p_info,
  483. &mode, LSM_OPERATION_MODE);
  484. if (rc)
  485. dev_err(rtd->dev,
  486. "%s: Failed to set det_mode param, err = %d\n",
  487. __func__, rc);
  488. done:
  489. return rc;
  490. }
  491. static int msm_lsm_set_gain(struct snd_pcm_substream *substream,
  492. struct lsm_params_info_v2 *p_info)
  493. {
  494. struct snd_pcm_runtime *runtime = substream->runtime;
  495. struct lsm_priv *prtd = runtime->private_data;
  496. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  497. struct snd_lsm_gain gain;
  498. int rc = 0;
  499. if (p_info->param_size != sizeof(gain)) {
  500. dev_err(rtd->dev,
  501. "%s: Invalid param_size %d\n",
  502. __func__, p_info->param_size);
  503. rc = -EINVAL;
  504. goto done;
  505. }
  506. if (copy_from_user(&gain, p_info->param_data,
  507. sizeof(gain))) {
  508. dev_err(rtd->dev,
  509. "%s: copy_from_user failed, size = %zd\n",
  510. __func__, sizeof(gain));
  511. rc = -EFAULT;
  512. goto done;
  513. }
  514. rc = q6lsm_set_one_param(prtd->lsm_client, p_info,
  515. &gain, LSM_GAIN);
  516. if (rc)
  517. dev_err(rtd->dev,
  518. "%s: Failed to set det_mode param, err = %d\n",
  519. __func__, rc);
  520. done:
  521. return rc;
  522. }
  523. static int msm_lsm_set_conf(struct snd_pcm_substream *substream,
  524. struct lsm_params_info_v2 *p_info)
  525. {
  526. struct snd_pcm_runtime *runtime = substream->runtime;
  527. struct lsm_priv *prtd = runtime->private_data;
  528. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  529. int rc = 0;
  530. if (p_info->param_size > MAX_NUM_CONFIDENCE) {
  531. dev_err(rtd->dev,
  532. "%s: invalid confidence levels %d\n",
  533. __func__, p_info->param_size);
  534. return -EINVAL;
  535. }
  536. prtd->lsm_client->num_confidence_levels =
  537. p_info->param_size;
  538. rc = msm_lsm_get_conf_levels(prtd->lsm_client,
  539. p_info->param_data);
  540. if (rc) {
  541. dev_err(rtd->dev,
  542. "%s: get_conf_levels failed, err = %d\n",
  543. __func__, rc);
  544. return rc;
  545. }
  546. rc = q6lsm_set_one_param(prtd->lsm_client, p_info,
  547. prtd->lsm_client->confidence_levels,
  548. LSM_MIN_CONFIDENCE_LEVELS);
  549. if (rc)
  550. dev_err(rtd->dev,
  551. "%s: Failed to set min_conf_levels, err = %d\n",
  552. __func__, rc);
  553. return rc;
  554. }
  555. static int msm_lsm_reg_model(struct snd_pcm_substream *substream,
  556. struct lsm_params_info_v2 *p_info)
  557. {
  558. struct snd_pcm_runtime *runtime = substream->runtime;
  559. struct lsm_priv *prtd = runtime->private_data;
  560. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  561. int rc = 0;
  562. struct lsm_sound_model *sm = NULL;
  563. size_t offset = sizeof(union param_hdrs);
  564. rc = q6lsm_snd_model_buf_alloc(prtd->lsm_client,
  565. p_info->param_size, p_info);
  566. if (rc) {
  567. dev_err(rtd->dev,
  568. "%s: snd_model buf alloc failed, size = %d\n",
  569. __func__, p_info->param_size);
  570. return rc;
  571. }
  572. q6lsm_sm_set_param_data(prtd->lsm_client, p_info, &offset);
  573. /*
  574. * For set_param, advance the sound model data with the
  575. * number of bytes required by param_data.
  576. */
  577. sm = &prtd->lsm_client->stage_cfg[p_info->stage_idx].sound_model;
  578. if (copy_from_user((u8 *)sm->data + offset,
  579. p_info->param_data, p_info->param_size)) {
  580. dev_err(rtd->dev,
  581. "%s: copy_from_user for snd_model failed, size = %d\n",
  582. __func__, p_info->param_size);
  583. rc = -EFAULT;
  584. goto err_copy;
  585. }
  586. rc = q6lsm_set_one_param(prtd->lsm_client, p_info, NULL,
  587. LSM_REG_SND_MODEL);
  588. if (rc) {
  589. dev_err(rtd->dev,
  590. "%s: Failed to set sound_model, err = %d\n",
  591. __func__, rc);
  592. goto err_copy;
  593. }
  594. return rc;
  595. err_copy:
  596. q6lsm_snd_model_buf_free(prtd->lsm_client, p_info);
  597. return rc;
  598. }
  599. static int msm_lsm_dereg_model(struct snd_pcm_substream *substream,
  600. struct lsm_params_info_v2 *p_info)
  601. {
  602. struct snd_pcm_runtime *runtime = substream->runtime;
  603. struct lsm_priv *prtd = runtime->private_data;
  604. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  605. int rc = 0;
  606. rc = q6lsm_set_one_param(prtd->lsm_client, p_info,
  607. NULL, LSM_DEREG_SND_MODEL);
  608. if (rc)
  609. dev_err(rtd->dev,
  610. "%s: Failed to set det_mode param, err = %d\n",
  611. __func__, rc);
  612. q6lsm_snd_model_buf_free(prtd->lsm_client, p_info);
  613. return rc;
  614. }
  615. static int msm_lsm_set_custom(struct snd_pcm_substream *substream,
  616. struct lsm_params_info_v2 *p_info)
  617. {
  618. struct snd_pcm_runtime *runtime = substream->runtime;
  619. struct lsm_priv *prtd = runtime->private_data;
  620. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  621. u8 *data;
  622. int rc = 0;
  623. data = kzalloc(p_info->param_size, GFP_KERNEL);
  624. if (!data)
  625. return -ENOMEM;
  626. if (copy_from_user(data, p_info->param_data,
  627. p_info->param_size)) {
  628. dev_err(rtd->dev,
  629. "%s: copy_from_user failed for custom params, size = %d\n",
  630. __func__, p_info->param_size);
  631. rc = -EFAULT;
  632. goto err_ret;
  633. }
  634. rc = q6lsm_set_one_param(prtd->lsm_client, p_info,
  635. data, LSM_CUSTOM_PARAMS);
  636. if (rc)
  637. dev_err(rtd->dev,
  638. "%s: Failed to set custom param, err = %d\n",
  639. __func__, rc);
  640. err_ret:
  641. kfree(data);
  642. return rc;
  643. }
  644. static int msm_lsm_check_and_set_lab_controls(struct snd_pcm_substream *substream,
  645. u32 enable, struct lsm_params_info_v2 *p_info)
  646. {
  647. struct snd_pcm_runtime *runtime = substream->runtime;
  648. struct lsm_priv *prtd = runtime->private_data;
  649. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  650. struct lsm_hw_params *out_hw_params = &prtd->lsm_client->out_hw_params;
  651. u8 chmap[out_hw_params->num_chs];
  652. u32 ch_idx;
  653. int rc = 0, stage_idx = p_info->stage_idx;
  654. if (prtd->lsm_client->stage_cfg[stage_idx].lab_enable == enable) {
  655. dev_dbg(rtd->dev, "%s: Lab for session %d, stage %d already %s\n",
  656. __func__, prtd->lsm_client->session,
  657. stage_idx, enable ? "enabled" : "disabled");
  658. return rc;
  659. }
  660. rc = q6lsm_lab_control(prtd->lsm_client, enable, p_info);
  661. if (rc) {
  662. dev_err(rtd->dev, "%s: Failed to set lab_control param, err = %d\n",
  663. __func__, rc);
  664. return rc;
  665. } else {
  666. if (LSM_IS_LAST_STAGE(prtd->lsm_client, stage_idx)) {
  667. rc = msm_lsm_lab_buffer_alloc(prtd,
  668. enable ? LAB_BUFFER_ALLOC : LAB_BUFFER_DEALLOC);
  669. if (rc) {
  670. dev_err(rtd->dev,
  671. "%s: msm_lsm_lab_buffer_alloc failed rc %d for %s\n",
  672. __func__, rc, enable ? "ALLOC" : "DEALLOC");
  673. return rc;
  674. } else {
  675. /* set client level flag based on last stage control */
  676. prtd->lsm_client->lab_enable = enable;
  677. }
  678. }
  679. if (!rc)
  680. prtd->lsm_client->stage_cfg[stage_idx].lab_enable = enable;
  681. }
  682. memset(chmap, 0, out_hw_params->num_chs);
  683. /*
  684. * First channel to be read from lab is always the
  685. * best channel (0xff). For second channel onwards,
  686. * the channel indices are 0, 1, .. etc
  687. */
  688. chmap[0] = 0xFF;
  689. for (ch_idx = 1; ch_idx < out_hw_params->num_chs; ch_idx++)
  690. chmap[ch_idx] = ch_idx - 1;
  691. rc = q6lsm_lab_out_ch_cfg(prtd->lsm_client, chmap, p_info);
  692. if (rc)
  693. dev_err(rtd->dev, "%s: Failed to set lab out ch cfg %d\n",
  694. __func__, rc);
  695. return rc;
  696. }
  697. static int msm_lsm_set_lab_control(struct snd_pcm_substream *substream,
  698. struct lsm_params_info_v2 *p_info)
  699. {
  700. struct snd_pcm_runtime *runtime = substream->runtime;
  701. struct lsm_priv *prtd = runtime->private_data;
  702. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  703. struct snd_lsm_lab_control lab_ctrl;
  704. int rc = 0;
  705. if (p_info->param_size != sizeof(lab_ctrl))
  706. return -EINVAL;
  707. if (prtd->lsm_client->started) {
  708. dev_err(rtd->dev, "%s: lab control sent after start\n", __func__);
  709. return -EAGAIN;
  710. }
  711. if (copy_from_user(&lab_ctrl, p_info->param_data,
  712. p_info->param_size)) {
  713. dev_err(rtd->dev,
  714. "%s: copy_from_user failed for lab_control params, size = %d\n",
  715. __func__, p_info->param_size);
  716. return -EFAULT;
  717. }
  718. rc = msm_lsm_check_and_set_lab_controls(substream, lab_ctrl.enable, p_info);
  719. return rc;
  720. }
  721. static int msm_lsm_set_poll_enable(struct snd_pcm_substream *substream,
  722. struct lsm_params_info_v2 *p_info)
  723. {
  724. struct snd_pcm_runtime *runtime = substream->runtime;
  725. struct lsm_priv *prtd = runtime->private_data;
  726. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  727. struct snd_lsm_poll_enable poll_enable;
  728. int rc = 0;
  729. if (p_info->param_size != sizeof(poll_enable)) {
  730. dev_err(rtd->dev,
  731. "%s: Invalid param_size %d\n",
  732. __func__, p_info->param_size);
  733. rc = -EINVAL;
  734. goto done;
  735. }
  736. if (copy_from_user(&poll_enable, p_info->param_data,
  737. sizeof(poll_enable))) {
  738. dev_err(rtd->dev,
  739. "%s: copy_from_user failed, size = %zd\n",
  740. __func__, sizeof(poll_enable));
  741. rc = -EFAULT;
  742. goto done;
  743. }
  744. if (prtd->lsm_client->poll_enable == poll_enable.poll_en) {
  745. dev_dbg(rtd->dev,
  746. "%s: Polling for session %d already %s\n",
  747. __func__, prtd->lsm_client->session,
  748. (poll_enable.poll_en ? "enabled" : "disabled"));
  749. rc = 0;
  750. goto done;
  751. }
  752. rc = q6lsm_set_one_param(prtd->lsm_client, p_info,
  753. &poll_enable, LSM_POLLING_ENABLE);
  754. if (!rc) {
  755. prtd->lsm_client->poll_enable = poll_enable.poll_en;
  756. } else {
  757. dev_err(rtd->dev,
  758. "%s: Failed to set poll enable, err = %d\n",
  759. __func__, rc);
  760. }
  761. done:
  762. return rc;
  763. }
  764. static int msm_lsm_set_det_event_type(struct snd_pcm_substream *substream,
  765. struct lsm_params_info_v2 *p_info)
  766. {
  767. struct snd_lsm_det_event_type det_event_type;
  768. struct snd_pcm_runtime *runtime = substream->runtime;
  769. struct lsm_priv *prtd = runtime->private_data;
  770. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  771. int rc = 0;
  772. if (p_info->param_size != sizeof(det_event_type)) {
  773. dev_err(rtd->dev,
  774. "%s: Invalid param_size %d\n",
  775. __func__, p_info->param_size);
  776. rc = -EINVAL;
  777. goto done;
  778. }
  779. if (copy_from_user(&det_event_type, p_info->param_data,
  780. sizeof(det_event_type))) {
  781. dev_err(rtd->dev,
  782. "%s: copy_from_user failed, size = %zd\n",
  783. __func__, sizeof(det_event_type));
  784. rc = -EFAULT;
  785. goto done;
  786. }
  787. rc = q6lsm_set_one_param(prtd->lsm_client, p_info,
  788. &det_event_type, LSM_DET_EVENT_TYPE);
  789. if (!rc)
  790. prtd->lsm_client->event_type = det_event_type.event_type;
  791. else
  792. dev_err(rtd->dev,
  793. "%s: Failed to set detection event type %s, err = %d\n",
  794. __func__, (det_event_type.event_type ?
  795. "LSM_DET_EVENT_TYPE_GENERIC" :
  796. "LSM_DET_EVENT_TYPE_LEGACY"), rc);
  797. done:
  798. return rc;
  799. }
  800. static int msm_lsm_process_params(struct snd_pcm_substream *substream,
  801. struct lsm_params_info_v2 *p_info)
  802. {
  803. struct snd_pcm_runtime *runtime = substream->runtime;
  804. struct lsm_priv *prtd = runtime->private_data;
  805. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  806. int rc = 0;
  807. dev_dbg(rtd->dev,
  808. "%s: mid=0x%x, pid=0x%x, iid=0x%x, stage_idx=%d, size=0x%x, type=%d\n",
  809. __func__, p_info->module_id, p_info->param_id, p_info->instance_id,
  810. p_info->stage_idx, p_info->param_size, p_info->param_type);
  811. if (!prtd->lsm_client ||
  812. prtd->lsm_client->num_stages <= p_info->stage_idx) {
  813. dev_err(rtd->dev,
  814. "%s: invalid stage_idx(%d) for client(%p) having num_stages(%d)\n",
  815. __func__, p_info->stage_idx, prtd->lsm_client,
  816. prtd->lsm_client ? prtd->lsm_client->num_stages : 0);
  817. return -EINVAL;
  818. }
  819. switch (p_info->param_type) {
  820. case LSM_ENDPOINT_DETECT_THRESHOLD:
  821. rc = msm_lsm_set_epd(substream, p_info);
  822. break;
  823. case LSM_OPERATION_MODE:
  824. rc = msm_lsm_set_mode(substream, p_info);
  825. break;
  826. case LSM_GAIN:
  827. rc = msm_lsm_set_gain(substream, p_info);
  828. break;
  829. case LSM_MIN_CONFIDENCE_LEVELS:
  830. rc = msm_lsm_set_conf(substream, p_info);
  831. break;
  832. case LSM_REG_SND_MODEL:
  833. rc = msm_lsm_reg_model(substream, p_info);
  834. break;
  835. case LSM_DEREG_SND_MODEL:
  836. rc = msm_lsm_dereg_model(substream, p_info);
  837. break;
  838. case LSM_CUSTOM_PARAMS:
  839. rc = msm_lsm_set_custom(substream, p_info);
  840. break;
  841. case LSM_POLLING_ENABLE:
  842. rc = msm_lsm_set_poll_enable(substream, p_info);
  843. break;
  844. case LSM_DET_EVENT_TYPE:
  845. rc = msm_lsm_set_det_event_type(substream, p_info);
  846. break;
  847. case LSM_LAB_CONTROL:
  848. rc = msm_lsm_set_lab_control(substream, p_info);
  849. break;
  850. default:
  851. dev_err(rtd->dev,
  852. "%s: Invalid param_type %d\n",
  853. __func__, p_info->param_type);
  854. rc = -EINVAL;
  855. break;
  856. }
  857. if (rc) {
  858. pr_err("%s: set_param fail for param_type %d\n",
  859. __func__, p_info->param_type);
  860. }
  861. return rc;
  862. }
  863. static int msm_lsm_start_lab_buffer(struct lsm_priv *prtd, uint16_t status)
  864. {
  865. struct lsm_client *lsm_client = prtd->lsm_client;
  866. int rc = 0;
  867. if (lsm_client && lsm_client->lab_enable &&
  868. !lsm_client->lab_started &&
  869. status == LSM_VOICE_WAKEUP_STATUS_DETECTED) {
  870. atomic_set(&prtd->read_abort, 0);
  871. atomic_set(&prtd->buf_count, 0);
  872. prtd->appl_cnt = 0;
  873. prtd->dma_write = 0;
  874. rc = msm_lsm_queue_lab_buffer(prtd, 0);
  875. if (rc)
  876. pr_err("%s: Queue buffer failed for lab rc = %d\n",
  877. __func__, rc);
  878. else
  879. prtd->lsm_client->lab_started = true;
  880. }
  881. return rc;
  882. }
  883. static int msm_lsm_ioctl_shared(struct snd_pcm_substream *substream,
  884. unsigned int cmd, void *arg)
  885. {
  886. struct snd_soc_pcm_runtime *rtd;
  887. unsigned long flags;
  888. int ret;
  889. struct snd_lsm_sound_model_v2 snd_model_v2;
  890. struct snd_lsm_session_data session_data;
  891. struct snd_lsm_session_data_v2 ses_data_v2 = {0};
  892. int rc = 0, stage_idx;
  893. int xchg = 0;
  894. struct snd_pcm_runtime *runtime;
  895. struct lsm_priv *prtd;
  896. struct snd_lsm_detection_params det_params;
  897. uint8_t *confidence_level = NULL;
  898. uint32_t max_detection_stages_supported = LSM_MAX_STAGES_PER_SESSION;
  899. if (!substream || !substream->private_data) {
  900. pr_err("%s: Invalid %s\n", __func__,
  901. (!substream) ? "substream" : "private_data");
  902. return -EINVAL;
  903. }
  904. runtime = substream->runtime;
  905. prtd = runtime->private_data;
  906. rtd = substream->private_data;
  907. switch (cmd) {
  908. case SNDRV_LSM_SET_SESSION_DATA:
  909. case SNDRV_LSM_SET_SESSION_DATA_V2:
  910. if (cmd == SNDRV_LSM_SET_SESSION_DATA) {
  911. dev_dbg(rtd->dev, "%s: set session data\n", __func__);
  912. rc = copy_from_user(&session_data, arg, sizeof(session_data));
  913. if (!rc) {
  914. ses_data_v2.app_id = session_data.app_id;
  915. ses_data_v2.num_stages = 1;
  916. }
  917. } else {
  918. dev_dbg(rtd->dev, "%s: set session data_v2\n", __func__);
  919. rc = copy_from_user(&ses_data_v2, arg, sizeof(ses_data_v2));
  920. }
  921. if (rc) {
  922. dev_err(rtd->dev, "%s: %s: copy_from_user failed\n",
  923. __func__, "LSM_SET_SESSION_DATA(_V2)");
  924. return -EFAULT;
  925. }
  926. if (ses_data_v2.app_id != LSM_VOICE_WAKEUP_APP_ID_V2) {
  927. dev_err(rtd->dev,
  928. "%s:Invalid App id %d for Listen client\n",
  929. __func__, session_data.app_id);
  930. rc = -EINVAL;
  931. break;
  932. }
  933. /*
  934. * Before validating num_stages from user argument.
  935. * Check ADSP support for multi-stage session,
  936. * and reset max_detection_stages_supported to "1" if required.
  937. */
  938. if (!q6lsm_adsp_supports_multi_stage_detection()) {
  939. dev_dbg(rtd->dev,
  940. "%s: multi-stage session not supported by adsp\n", __func__);
  941. max_detection_stages_supported = 1;
  942. }
  943. if (ses_data_v2.num_stages <= 0 ||
  944. ses_data_v2.num_stages > max_detection_stages_supported) {
  945. dev_err(rtd->dev,
  946. "%s: Unsupported number of stages req(%d)/max(%d)\n",
  947. __func__, ses_data_v2.num_stages,
  948. max_detection_stages_supported);
  949. rc = -EINVAL;
  950. break;
  951. }
  952. prtd->lsm_client->app_id = ses_data_v2.app_id;
  953. prtd->lsm_client->num_stages = ses_data_v2.num_stages;
  954. for (stage_idx = LSM_STAGE_INDEX_FIRST;
  955. stage_idx < ses_data_v2.num_stages; stage_idx++) {
  956. prtd->lsm_client->stage_cfg[stage_idx].app_type =
  957. ses_data_v2.stage_info[stage_idx].app_type;
  958. prtd->lsm_client->stage_cfg[stage_idx].lpi_enable =
  959. ses_data_v2.stage_info[stage_idx].lpi_enable;
  960. }
  961. ret = q6lsm_open(prtd->lsm_client, ses_data_v2.app_id);
  962. if (ret < 0) {
  963. dev_err(rtd->dev,
  964. "%s: lsm open failed, %d\n",
  965. __func__, ret);
  966. return ret;
  967. }
  968. prtd->lsm_client->opened = true;
  969. dev_dbg(rtd->dev, "%s: Session_ID = %d, APP ID = %d, Num stages %d\n",
  970. __func__,
  971. prtd->lsm_client->session,
  972. prtd->lsm_client->app_id,
  973. prtd->lsm_client->num_stages);
  974. break;
  975. case SNDRV_LSM_REG_SND_MODEL_V2: {
  976. /*
  977. * With multi-stage support sm buff allocation/free usage param info
  978. * to check stage index for which this sound model is being set, and
  979. * to check whether sm data is sent using set param command or not.
  980. * Hence, set param ids to '0' to indicate allocation is for legacy
  981. * reg_sm cmd, where buffer for param header need not be allocated,
  982. * also set stage index to LSM_STAGE_INDEX_FIRST.
  983. */
  984. struct lsm_params_info_v2 p_info = {0};
  985. p_info.stage_idx = LSM_STAGE_INDEX_FIRST;
  986. dev_dbg(rtd->dev, "%s: Registering sound model V2\n",
  987. __func__);
  988. memcpy(&snd_model_v2, arg,
  989. sizeof(struct snd_lsm_sound_model_v2));
  990. if (snd_model_v2.num_confidence_levels >
  991. MAX_NUM_CONFIDENCE) {
  992. dev_err(rtd->dev,
  993. "%s: Invalid conf_levels = %d, maximum allowed = %d\n",
  994. __func__, snd_model_v2.num_confidence_levels,
  995. MAX_NUM_CONFIDENCE);
  996. rc = -EINVAL;
  997. break;
  998. }
  999. rc = q6lsm_snd_model_buf_alloc(prtd->lsm_client,
  1000. snd_model_v2.data_size, &p_info);
  1001. if (rc) {
  1002. dev_err(rtd->dev,
  1003. "%s: q6lsm buffer alloc failed V2, size %d\n",
  1004. __func__, snd_model_v2.data_size);
  1005. break;
  1006. }
  1007. if (copy_from_user(
  1008. prtd->lsm_client->stage_cfg[p_info.stage_idx].sound_model.data,
  1009. snd_model_v2.data, snd_model_v2.data_size)) {
  1010. dev_err(rtd->dev,
  1011. "%s: copy from user data failed\n"
  1012. "data %pK size %d\n", __func__,
  1013. snd_model_v2.data, snd_model_v2.data_size);
  1014. q6lsm_snd_model_buf_free(prtd->lsm_client, &p_info);
  1015. rc = -EFAULT;
  1016. break;
  1017. }
  1018. dev_dbg(rtd->dev, "SND Model Magic no byte[0] %x,\n"
  1019. "byte[1] %x, byte[2] %x byte[3] %x\n",
  1020. snd_model_v2.data[0], snd_model_v2.data[1],
  1021. snd_model_v2.data[2], snd_model_v2.data[3]);
  1022. prtd->lsm_client->num_confidence_levels =
  1023. snd_model_v2.num_confidence_levels;
  1024. rc = msm_lsm_get_conf_levels(prtd->lsm_client,
  1025. snd_model_v2.confidence_level);
  1026. if (rc) {
  1027. dev_err(rtd->dev,
  1028. "%s: get_conf_levels failed, err = %d\n",
  1029. __func__, rc);
  1030. break;
  1031. }
  1032. rc = q6lsm_register_sound_model(prtd->lsm_client,
  1033. snd_model_v2.detection_mode,
  1034. snd_model_v2.detect_failure);
  1035. if (rc < 0) {
  1036. dev_err(rtd->dev,
  1037. "%s: Register snd Model v2 failed =%d\n",
  1038. __func__, rc);
  1039. kfree(confidence_level);
  1040. q6lsm_snd_model_buf_free(prtd->lsm_client, &p_info);
  1041. }
  1042. kfree(prtd->lsm_client->confidence_levels);
  1043. prtd->lsm_client->confidence_levels = NULL;
  1044. break;
  1045. }
  1046. case SNDRV_LSM_SET_PARAMS:
  1047. dev_dbg(rtd->dev, "%s: set_params\n", __func__);
  1048. memcpy(&det_params, arg,
  1049. sizeof(det_params));
  1050. if (det_params.num_confidence_levels >
  1051. MAX_NUM_CONFIDENCE) {
  1052. rc = -EINVAL;
  1053. break;
  1054. }
  1055. prtd->lsm_client->num_confidence_levels =
  1056. det_params.num_confidence_levels;
  1057. rc = msm_lsm_get_conf_levels(prtd->lsm_client,
  1058. det_params.conf_level);
  1059. if (rc) {
  1060. dev_err(rtd->dev,
  1061. "%s: Failed to get conf_levels, err = %d\n",
  1062. __func__, rc);
  1063. break;
  1064. }
  1065. rc = q6lsm_set_data(prtd->lsm_client,
  1066. det_params.detect_mode,
  1067. det_params.detect_failure);
  1068. if (rc)
  1069. dev_err(rtd->dev,
  1070. "%s: Failed to set params, err = %d\n",
  1071. __func__, rc);
  1072. kfree(prtd->lsm_client->confidence_levels);
  1073. prtd->lsm_client->confidence_levels = NULL;
  1074. break;
  1075. case SNDRV_LSM_DEREG_SND_MODEL:
  1076. dev_dbg(rtd->dev, "%s: Deregistering sound model\n",
  1077. __func__);
  1078. rc = q6lsm_deregister_sound_model(prtd->lsm_client);
  1079. if (rc)
  1080. dev_err(rtd->dev,
  1081. "%s: Sound model de-register failed, err = %d\n",
  1082. __func__, rc);
  1083. break;
  1084. case SNDRV_LSM_EVENT_STATUS:
  1085. case SNDRV_LSM_EVENT_STATUS_V3: {
  1086. uint32_t ts_lsw, ts_msw;
  1087. uint16_t status = 0, payload_size = 0;
  1088. dev_dbg(rtd->dev, "%s: Get event status\n", __func__);
  1089. atomic_set(&prtd->event_wait_stop, 0);
  1090. /*
  1091. * Release the api lock before wait to allow
  1092. * other IOCTLs to be invoked while waiting
  1093. * for event
  1094. */
  1095. mutex_unlock(&prtd->lsm_api_lock);
  1096. rc = wait_event_freezable(prtd->event_wait,
  1097. (cmpxchg(&prtd->event_avail, 1, 0) ||
  1098. (xchg = atomic_cmpxchg(&prtd->event_wait_stop,
  1099. 1, 0))));
  1100. mutex_lock(&prtd->lsm_api_lock);
  1101. dev_dbg(rtd->dev, "%s: wait_event_freezable %d event_wait_stop %d\n",
  1102. __func__, rc, xchg);
  1103. if (!rc && !xchg) {
  1104. dev_dbg(rtd->dev, "%s: New event available %ld\n",
  1105. __func__, prtd->event_avail);
  1106. spin_lock_irqsave(&prtd->event_lock, flags);
  1107. if (prtd->event_status) {
  1108. payload_size = prtd->event_status->payload_size;
  1109. ts_lsw = prtd->event_status->timestamp_lsw;
  1110. ts_msw = prtd->event_status->timestamp_msw;
  1111. status = prtd->event_status->status;
  1112. spin_unlock_irqrestore(&prtd->event_lock,
  1113. flags);
  1114. } else {
  1115. spin_unlock_irqrestore(&prtd->event_lock,
  1116. flags);
  1117. rc = -EINVAL;
  1118. dev_err(rtd->dev,
  1119. "%s: prtd->event_status is NULL\n",
  1120. __func__);
  1121. break;
  1122. }
  1123. if (cmd == SNDRV_LSM_EVENT_STATUS) {
  1124. struct snd_lsm_event_status *user = arg;
  1125. if (user->payload_size < payload_size) {
  1126. dev_dbg(rtd->dev,
  1127. "%s: provided %d bytes isn't enough, needs %d bytes\n",
  1128. __func__, user->payload_size,
  1129. payload_size);
  1130. rc = -ENOMEM;
  1131. } else {
  1132. user->status = status;
  1133. user->payload_size = payload_size;
  1134. memcpy(user->payload,
  1135. prtd->event_status->payload,
  1136. payload_size);
  1137. }
  1138. } else {
  1139. struct snd_lsm_event_status_v3 *user_v3 = arg;
  1140. if (user_v3->payload_size < payload_size) {
  1141. dev_dbg(rtd->dev,
  1142. "%s: provided %d bytes isn't enough, needs %d bytes\n",
  1143. __func__, user_v3->payload_size,
  1144. payload_size);
  1145. rc = -ENOMEM;
  1146. } else {
  1147. user_v3->timestamp_lsw = ts_lsw;
  1148. user_v3->timestamp_msw = ts_msw;
  1149. user_v3->status = status;
  1150. user_v3->payload_size = payload_size;
  1151. memcpy(user_v3->payload,
  1152. prtd->event_status->payload,
  1153. payload_size);
  1154. }
  1155. }
  1156. if (!rc)
  1157. rc = msm_lsm_start_lab_buffer(prtd, status);
  1158. } else if (xchg) {
  1159. dev_dbg(rtd->dev, "%s: Wait aborted\n", __func__);
  1160. rc = 0;
  1161. }
  1162. break;
  1163. }
  1164. case SNDRV_LSM_GENERIC_DET_EVENT: {
  1165. struct snd_lsm_event_status *user = arg;
  1166. uint16_t status = 0;
  1167. uint16_t payload_size = 0;
  1168. dev_dbg(rtd->dev,
  1169. "%s: SNDRV_LSM_GENERIC_DET_EVENT\n", __func__);
  1170. atomic_set(&prtd->event_wait_stop, 0);
  1171. /*
  1172. * Release the api lock before wait to allow
  1173. * other IOCTLs to be invoked while waiting
  1174. * for event
  1175. */
  1176. mutex_unlock(&prtd->lsm_api_lock);
  1177. rc = wait_event_freezable(prtd->event_wait,
  1178. (cmpxchg(&prtd->event_avail, 1, 0) ||
  1179. (xchg = atomic_cmpxchg(&prtd->event_wait_stop,
  1180. 1, 0))));
  1181. mutex_lock(&prtd->lsm_api_lock);
  1182. dev_dbg(rtd->dev, "%s: wait_event_freezable %d event_wait_stop %d\n",
  1183. __func__, rc, xchg);
  1184. if (!rc && !xchg) {
  1185. dev_dbg(rtd->dev, "%s: %s: New event available %ld\n",
  1186. __func__, "SNDRV_LSM_GENERIC_DET_EVENT",
  1187. prtd->event_avail);
  1188. spin_lock_irqsave(&prtd->event_lock, flags);
  1189. if (prtd->det_event) {
  1190. payload_size = prtd->det_event->payload_size;
  1191. status = prtd->det_event->status;
  1192. spin_unlock_irqrestore(&prtd->event_lock,
  1193. flags);
  1194. } else {
  1195. spin_unlock_irqrestore(&prtd->event_lock,
  1196. flags);
  1197. dev_err(rtd->dev,
  1198. "%s: %s: prtd->event_status is NULL\n",
  1199. __func__,
  1200. "SNDRV_LSM_GENERIC_DET_EVENT");
  1201. rc = -EINVAL;
  1202. break;
  1203. }
  1204. if (user->payload_size < payload_size) {
  1205. dev_err(rtd->dev,
  1206. "%s: provided %d bytes isn't enough, needs %d bytes\n",
  1207. __func__, user->payload_size,
  1208. payload_size);
  1209. rc = -ENOMEM;
  1210. break;
  1211. }
  1212. user->status = status;
  1213. user->payload_size = payload_size;
  1214. memcpy(user->payload, prtd->det_event->payload,
  1215. payload_size);
  1216. rc = msm_lsm_start_lab_buffer(prtd, status);
  1217. } else if (xchg) {
  1218. dev_dbg(rtd->dev, "%s: %s: Wait aborted\n",
  1219. __func__, "SNDRV_LSM_GENERIC_DET_EVENT");
  1220. rc = 0;
  1221. }
  1222. break;
  1223. }
  1224. case SNDRV_LSM_ABORT_EVENT:
  1225. dev_dbg(rtd->dev, "%s: Aborting event status wait\n",
  1226. __func__);
  1227. atomic_set(&prtd->event_wait_stop, 1);
  1228. wake_up(&prtd->event_wait);
  1229. break;
  1230. case SNDRV_LSM_START:
  1231. dev_dbg(rtd->dev, "%s: Starting LSM client session\n",
  1232. __func__);
  1233. if (!prtd->lsm_client->started) {
  1234. ret = q6lsm_start(prtd->lsm_client, true);
  1235. if (!ret) {
  1236. prtd->lsm_client->started = true;
  1237. dev_dbg(rtd->dev, "%s: LSM client session started\n",
  1238. __func__);
  1239. }
  1240. }
  1241. break;
  1242. case SNDRV_LSM_STOP: {
  1243. dev_dbg(rtd->dev,
  1244. "%s: Stopping LSM client session\n",
  1245. __func__);
  1246. if (prtd->lsm_client->started) {
  1247. if (prtd->lsm_client->lab_enable) {
  1248. atomic_set(&prtd->read_abort, 1);
  1249. if (prtd->lsm_client->lab_started) {
  1250. ret = q6lsm_stop_lab(prtd->lsm_client);
  1251. if (ret)
  1252. dev_err(rtd->dev,
  1253. "%s: stop lab failed ret %d\n",
  1254. __func__, ret);
  1255. prtd->lsm_client->lab_started = false;
  1256. }
  1257. }
  1258. ret = q6lsm_stop(prtd->lsm_client, true);
  1259. if (!ret)
  1260. dev_dbg(rtd->dev,
  1261. "%s: LSM client session stopped %d\n",
  1262. __func__, ret);
  1263. prtd->lsm_client->started = false;
  1264. }
  1265. break;
  1266. }
  1267. case SNDRV_LSM_LAB_CONTROL: {
  1268. u32 enable = 0;
  1269. struct lsm_params_info_v2 p_info = {0};
  1270. if (prtd->lsm_client->num_stages > 1) {
  1271. dev_err(rtd->dev, "%s: %s: not supported for multi stage session\n",
  1272. __func__, "LSM_LAB_CONTROL");
  1273. return -EINVAL;
  1274. }
  1275. if (copy_from_user(&enable, arg, sizeof(enable))) {
  1276. dev_err(rtd->dev, "%s: %s: copy_frm_user failed\n",
  1277. __func__, "LSM_LAB_CONTROL");
  1278. return -EFAULT;
  1279. }
  1280. dev_dbg(rtd->dev, "%s: ioctl %s, enable = %d\n",
  1281. __func__, "SNDRV_LSM_LAB_CONTROL", enable);
  1282. if (prtd->lsm_client->started) {
  1283. dev_err(rtd->dev, "%s: ioctl %s issued after start",
  1284. __func__, "SNDRV_LSM_LAB_CONTROL");
  1285. rc = -EINVAL;
  1286. break;
  1287. }
  1288. /*
  1289. * With multi-stage support lab control needs to set param info
  1290. * specifying stage index for which this lab control is issued,
  1291. * along with values of module/instance ids applicable for the stage.
  1292. * Hence, set param info with default lab module/instance ids, and
  1293. * set stage index to LSM_STAGE_INDEX_FIRST.
  1294. */
  1295. p_info.param_type = LSM_LAB_CONTROL;
  1296. p_info.module_id = LSM_MODULE_ID_LAB;
  1297. p_info.instance_id = INSTANCE_ID_0;
  1298. p_info.stage_idx = LSM_STAGE_INDEX_FIRST;
  1299. p_info.param_size = 0;
  1300. rc = msm_lsm_check_and_set_lab_controls(substream, enable, &p_info);
  1301. break;
  1302. }
  1303. case SNDRV_LSM_STOP_LAB:
  1304. dev_dbg(rtd->dev, "%s: stopping LAB\n", __func__);
  1305. if (prtd->lsm_client->lab_enable &&
  1306. prtd->lsm_client->lab_started) {
  1307. atomic_set(&prtd->read_abort, 1);
  1308. rc = q6lsm_stop_lab(prtd->lsm_client);
  1309. if (rc)
  1310. dev_err(rtd->dev,
  1311. "%s: Lab stop failed for session %d rc %d\n",
  1312. __func__,
  1313. prtd->lsm_client->session, rc);
  1314. prtd->lsm_client->lab_started = false;
  1315. }
  1316. break;
  1317. case SNDRV_LSM_SET_PORT:
  1318. dev_dbg(rtd->dev, "%s: set LSM port\n", __func__);
  1319. rc = q6lsm_set_port_connected(prtd->lsm_client);
  1320. break;
  1321. case SNDRV_LSM_SET_FWK_MODE_CONFIG: {
  1322. u32 mode;
  1323. if (copy_from_user(&mode, arg, sizeof(mode))) {
  1324. dev_err(rtd->dev, "%s: %s: copy_frm_user failed\n",
  1325. __func__, "LSM_SET_FWK_MODE_CONFIG");
  1326. return -EFAULT;
  1327. }
  1328. dev_dbg(rtd->dev, "%s: ioctl %s, enable = %d\n",
  1329. __func__, "SNDRV_LSM_SET_FWK_MODE_CONFIG", mode);
  1330. if (prtd->lsm_client->event_mode == mode) {
  1331. dev_dbg(rtd->dev,
  1332. "%s: mode for %d already set to %d\n",
  1333. __func__, prtd->lsm_client->session, mode);
  1334. rc = 0;
  1335. } else {
  1336. dev_dbg(rtd->dev, "%s: Event mode = %d\n",
  1337. __func__, mode);
  1338. rc = q6lsm_set_fwk_mode_cfg(prtd->lsm_client, mode);
  1339. if (!rc)
  1340. prtd->lsm_client->event_mode = mode;
  1341. else
  1342. dev_err(rtd->dev,
  1343. "%s: set event mode failed %d\n",
  1344. __func__, rc);
  1345. }
  1346. break;
  1347. }
  1348. case SNDRV_LSM_SET_INPUT_HW_PARAMS: {
  1349. struct lsm_hw_params *in_params;
  1350. struct snd_lsm_input_hw_params params;
  1351. if (copy_from_user(&params, arg, sizeof(params))) {
  1352. dev_err(rtd->dev, "%s: %s: copy_from_user failed\n",
  1353. __func__, "LSM_SET_INPUT_HW_PARAMS");
  1354. return -EFAULT;
  1355. }
  1356. in_params = &prtd->lsm_client->in_hw_params;
  1357. in_params->sample_rate = params.sample_rate;
  1358. in_params->sample_size = params.bit_width;
  1359. in_params->num_chs = params.num_channels;
  1360. break;
  1361. }
  1362. default:
  1363. dev_dbg(rtd->dev,
  1364. "%s: Falling into default snd_lib_ioctl cmd 0x%x\n",
  1365. __func__, cmd);
  1366. rc = snd_pcm_lib_ioctl(substream, cmd, arg);
  1367. break;
  1368. }
  1369. if (!rc)
  1370. dev_dbg(rtd->dev, "%s: leave (%d)\n",
  1371. __func__, rc);
  1372. else
  1373. dev_err(rtd->dev, "%s: cmd 0x%x failed %d\n",
  1374. __func__, cmd, rc);
  1375. return rc;
  1376. }
  1377. static int msm_lsm_check_event_type(struct lsm_client *lsm_client,
  1378. unsigned int cmd)
  1379. {
  1380. int err = 0;
  1381. uint32_t event_type = lsm_client->event_type;
  1382. if (cmd == SNDRV_LSM_EVENT_STATUS &&
  1383. event_type != LSM_DET_EVENT_TYPE_LEGACY) {
  1384. pr_err("%s: %s: Invalid event request\n",
  1385. __func__, "SNDRV_LSM_EVENT_STATUS");
  1386. err = -EINVAL;
  1387. } else if (cmd == SNDRV_LSM_GENERIC_DET_EVENT &&
  1388. event_type != LSM_DET_EVENT_TYPE_GENERIC) {
  1389. pr_err("%s: %s: Invalid event request\n",
  1390. __func__, "SNDRV_LSM_GENERIC_DET_EVENT");
  1391. err = -EINVAL;
  1392. }
  1393. return err;
  1394. }
  1395. #ifdef CONFIG_COMPAT
  1396. struct snd_lsm_event_status32 {
  1397. u16 status;
  1398. u16 payload_size;
  1399. u8 payload[0];
  1400. };
  1401. struct snd_lsm_event_status_v3_32 {
  1402. u32 timestamp_lsw;
  1403. u32 timestamp_msw;
  1404. u16 status;
  1405. u16 payload_size;
  1406. u8 payload[0];
  1407. };
  1408. struct snd_lsm_sound_model_v2_32 {
  1409. compat_uptr_t data;
  1410. compat_uptr_t confidence_level;
  1411. u32 data_size;
  1412. enum lsm_detection_mode detection_mode;
  1413. u8 num_confidence_levels;
  1414. bool detect_failure;
  1415. };
  1416. struct snd_lsm_detection_params_32 {
  1417. compat_uptr_t conf_level;
  1418. enum lsm_detection_mode detect_mode;
  1419. u8 num_confidence_levels;
  1420. bool detect_failure;
  1421. };
  1422. struct lsm_params_info_32 {
  1423. u32 module_id;
  1424. u32 param_id;
  1425. u32 param_size;
  1426. compat_uptr_t param_data;
  1427. uint32_t param_type;
  1428. };
  1429. struct lsm_params_info_v2_32 {
  1430. u32 module_id;
  1431. u32 param_id;
  1432. u32 param_size;
  1433. compat_uptr_t param_data;
  1434. uint32_t param_type;
  1435. u16 instance_id;
  1436. u16 stage_idx;
  1437. };
  1438. struct snd_lsm_module_params_32 {
  1439. compat_uptr_t params;
  1440. u32 num_params;
  1441. u32 data_size;
  1442. };
  1443. enum {
  1444. SNDRV_LSM_REG_SND_MODEL_V2_32 =
  1445. _IOW('U', 0x07, struct snd_lsm_sound_model_v2_32),
  1446. SNDRV_LSM_SET_PARAMS_32 =
  1447. _IOW('U', 0x0A, struct snd_lsm_detection_params_32),
  1448. SNDRV_LSM_SET_MODULE_PARAMS_32 =
  1449. _IOW('U', 0x0B, struct snd_lsm_module_params_32),
  1450. SNDRV_LSM_EVENT_STATUS_V3_32 =
  1451. _IOW('U', 0x0F, struct snd_lsm_event_status_v3_32),
  1452. SNDRV_LSM_SET_MODULE_PARAMS_V2_32 =
  1453. _IOW('U', 0x13, struct snd_lsm_module_params_32),
  1454. };
  1455. static int msm_lsm_ioctl_compat(struct snd_pcm_substream *substream,
  1456. unsigned int cmd, void __user *arg)
  1457. {
  1458. struct snd_pcm_runtime *runtime;
  1459. struct lsm_priv *prtd;
  1460. struct snd_soc_pcm_runtime *rtd;
  1461. int err = 0;
  1462. u32 size = 0;
  1463. if (PCM_RUNTIME_CHECK(substream))
  1464. return -ENXIO;
  1465. if (!substream || !substream->private_data) {
  1466. pr_err("%s: Invalid %s\n", __func__,
  1467. (!substream) ? "substream" : "private_data");
  1468. return -EINVAL;
  1469. }
  1470. runtime = substream->runtime;
  1471. rtd = substream->private_data;
  1472. prtd = runtime->private_data;
  1473. mutex_lock(&prtd->lsm_api_lock);
  1474. switch (cmd) {
  1475. case SNDRV_LSM_EVENT_STATUS:
  1476. case SNDRV_LSM_GENERIC_DET_EVENT: {
  1477. struct snd_lsm_event_status userarg32, *user32 = NULL;
  1478. struct snd_lsm_event_status *user = NULL;
  1479. dev_dbg(rtd->dev,
  1480. "%s: %s\n", __func__,
  1481. (cmd == SNDRV_LSM_EVENT_STATUS) ?
  1482. "SNDRV_LSM_EVENT_STATUS" :
  1483. "SNDRV_LSM_GENERIC_DET_EVENT");
  1484. err = msm_lsm_check_event_type(prtd->lsm_client, cmd);
  1485. if (err)
  1486. goto done;
  1487. if (copy_from_user(&userarg32, arg, sizeof(userarg32))) {
  1488. dev_err(rtd->dev, "%s: %s: Failed to copy from user\n",
  1489. __func__, (cmd == SNDRV_LSM_EVENT_STATUS) ?
  1490. "SNDRV_LSM_EVENT_STATUS" :
  1491. "SNDRV_LSM_GENERIC_DET_EVENT");
  1492. err = -EFAULT;
  1493. goto done;
  1494. }
  1495. if (userarg32.payload_size >
  1496. LISTEN_MAX_STATUS_PAYLOAD_SIZE) {
  1497. dev_err(rtd->dev,
  1498. "%s: payload_size %d is invalid, max allowed = %d\n",
  1499. __func__, userarg32.payload_size,
  1500. LISTEN_MAX_STATUS_PAYLOAD_SIZE);
  1501. err = -EINVAL;
  1502. goto done;
  1503. }
  1504. size = sizeof(*user) + userarg32.payload_size;
  1505. user = kzalloc(size, GFP_KERNEL);
  1506. if (!user) {
  1507. err = -ENOMEM;
  1508. goto done;
  1509. }
  1510. user->payload_size = userarg32.payload_size;
  1511. err = msm_lsm_ioctl_shared(substream, cmd, user);
  1512. if (err) {
  1513. dev_err(rtd->dev,
  1514. "%s: msm_lsm_ioctl_shared() failed, err = %d",
  1515. __func__, err);
  1516. kfree(user);
  1517. goto done;
  1518. }
  1519. /* Update size with actual payload size */
  1520. size = sizeof(userarg32) + user->payload_size;
  1521. if (!access_ok(VERIFY_WRITE, arg, size)) {
  1522. dev_err(rtd->dev,
  1523. "%s: Failed to verify write, size = %d\n",
  1524. __func__, size);
  1525. err = -EFAULT;
  1526. kfree(user);
  1527. goto done;
  1528. }
  1529. user32 = kzalloc(size, GFP_KERNEL);
  1530. if (!user32) {
  1531. err = -ENOMEM;
  1532. kfree(user);
  1533. goto done;
  1534. }
  1535. user32->status = user->status;
  1536. user32->payload_size = user->payload_size;
  1537. memcpy(user32->payload, user->payload,
  1538. user32->payload_size);
  1539. if (copy_to_user(arg, user32, size)) {
  1540. dev_err(rtd->dev,
  1541. "%s: Failed to copy payload to user, size = %d",
  1542. __func__, size);
  1543. err = -EFAULT;
  1544. }
  1545. kfree(user);
  1546. kfree(user32);
  1547. break;
  1548. }
  1549. case SNDRV_LSM_EVENT_STATUS_V3_32: {
  1550. struct snd_lsm_event_status_v3_32 userarg32, *user32 = NULL;
  1551. struct snd_lsm_event_status_v3 *user = NULL;
  1552. if (prtd->lsm_client->event_type !=
  1553. LSM_DET_EVENT_TYPE_LEGACY) {
  1554. dev_err(rtd->dev,
  1555. "%s: %s: Invalid event request\n",
  1556. __func__, "SNDRV_LSM_EVENT_STATUS_V3_32");
  1557. err = -EINVAL;
  1558. goto done;
  1559. }
  1560. if (copy_from_user(&userarg32, arg, sizeof(userarg32))) {
  1561. dev_err(rtd->dev, "%s: err copyuser ioctl %s\n",
  1562. __func__, "SNDRV_LSM_EVENT_STATUS_V3_32");
  1563. err = -EFAULT;
  1564. goto done;
  1565. }
  1566. if (userarg32.payload_size >
  1567. LISTEN_MAX_STATUS_PAYLOAD_SIZE) {
  1568. pr_err("%s: payload_size %d is invalid, max allowed = %d\n",
  1569. __func__, userarg32.payload_size,
  1570. LISTEN_MAX_STATUS_PAYLOAD_SIZE);
  1571. err = -EINVAL;
  1572. goto done;
  1573. }
  1574. size = sizeof(*user) + userarg32.payload_size;
  1575. user = kzalloc(size, GFP_KERNEL);
  1576. if (!user) {
  1577. dev_err(rtd->dev,
  1578. "%s: Allocation failed event status size %d\n",
  1579. __func__, size);
  1580. err = -ENOMEM;
  1581. goto done;
  1582. }
  1583. cmd = SNDRV_LSM_EVENT_STATUS_V3;
  1584. user->payload_size = userarg32.payload_size;
  1585. err = msm_lsm_ioctl_shared(substream, cmd, user);
  1586. /* Update size with actual payload size */
  1587. size = sizeof(userarg32) + user->payload_size;
  1588. if (!err && !access_ok(VERIFY_WRITE, arg, size)) {
  1589. dev_err(rtd->dev,
  1590. "%s: write verify failed size %d\n",
  1591. __func__, size);
  1592. err = -EFAULT;
  1593. }
  1594. if (!err) {
  1595. user32 = kzalloc(size, GFP_KERNEL);
  1596. if (!user32) {
  1597. dev_err(rtd->dev,
  1598. "%s: Allocation event user status size %d\n",
  1599. __func__, size);
  1600. err = -EFAULT;
  1601. } else {
  1602. user32->timestamp_lsw = user->timestamp_lsw;
  1603. user32->timestamp_msw = user->timestamp_msw;
  1604. user32->status = user->status;
  1605. user32->payload_size = user->payload_size;
  1606. memcpy(user32->payload,
  1607. user->payload, user32->payload_size);
  1608. }
  1609. }
  1610. if (!err && (copy_to_user(arg, user32, size))) {
  1611. dev_err(rtd->dev, "%s: failed to copy payload %d",
  1612. __func__, size);
  1613. err = -EFAULT;
  1614. }
  1615. kfree(user);
  1616. kfree(user32);
  1617. if (err)
  1618. dev_err(rtd->dev, "%s: lsmevent failed %d",
  1619. __func__, err);
  1620. break;
  1621. }
  1622. case SNDRV_LSM_REG_SND_MODEL_V2_32: {
  1623. struct snd_lsm_sound_model_v2_32 snd_modelv232;
  1624. struct snd_lsm_sound_model_v2 snd_modelv2;
  1625. if (prtd->lsm_client->use_topology) {
  1626. dev_err(rtd->dev,
  1627. "%s: %s: not supported if using topology\n",
  1628. __func__, "REG_SND_MODEL_V2");
  1629. err = -EINVAL;
  1630. goto done;
  1631. }
  1632. if (copy_from_user(&snd_modelv232, arg,
  1633. sizeof(snd_modelv232))) {
  1634. err = -EFAULT;
  1635. dev_err(rtd->dev,
  1636. "%s: copy user failed, size %zd %s\n",
  1637. __func__,
  1638. sizeof(struct snd_lsm_sound_model_v2_32),
  1639. "SNDRV_LSM_REG_SND_MODEL_V2_32");
  1640. } else {
  1641. snd_modelv2.confidence_level =
  1642. compat_ptr(snd_modelv232.confidence_level);
  1643. snd_modelv2.data = compat_ptr(snd_modelv232.data);
  1644. snd_modelv2.data_size = snd_modelv232.data_size;
  1645. snd_modelv2.detect_failure =
  1646. snd_modelv232.detect_failure;
  1647. snd_modelv2.detection_mode =
  1648. snd_modelv232.detection_mode;
  1649. snd_modelv2.num_confidence_levels =
  1650. snd_modelv232.num_confidence_levels;
  1651. cmd = SNDRV_LSM_REG_SND_MODEL_V2;
  1652. err = msm_lsm_ioctl_shared(substream, cmd,
  1653. &snd_modelv2);
  1654. if (err)
  1655. dev_err(rtd->dev,
  1656. "%s: ioctl %s failed\n", __func__,
  1657. "SNDDRV_LSM_REG_SND_MODEL_V2_32");
  1658. }
  1659. break;
  1660. }
  1661. case SNDRV_LSM_SET_PARAMS_32:{
  1662. struct snd_lsm_detection_params_32 det_params32;
  1663. struct snd_lsm_detection_params det_params;
  1664. if (prtd->lsm_client->use_topology) {
  1665. dev_err(rtd->dev,
  1666. "%s: %s: not supported if using topology\n",
  1667. __func__, "SET_PARAMS_32");
  1668. err = -EINVAL;
  1669. }
  1670. if (copy_from_user(&det_params32, arg,
  1671. sizeof(det_params32))) {
  1672. err = -EFAULT;
  1673. dev_err(rtd->dev,
  1674. "%s: %s: copy_from_user failed, size = %zd\n",
  1675. __func__, "SNDRV_LSM_SET_PARAMS_32",
  1676. sizeof(det_params32));
  1677. } else {
  1678. det_params.conf_level =
  1679. compat_ptr(det_params32.conf_level);
  1680. det_params.detect_mode =
  1681. det_params32.detect_mode;
  1682. det_params.num_confidence_levels =
  1683. det_params32.num_confidence_levels;
  1684. det_params.detect_failure =
  1685. det_params32.detect_failure;
  1686. cmd = SNDRV_LSM_SET_PARAMS;
  1687. err = msm_lsm_ioctl_shared(substream, cmd,
  1688. &det_params);
  1689. if (err)
  1690. dev_err(rtd->dev,
  1691. "%s: ioctl %s failed\n", __func__,
  1692. "SNDRV_LSM_SET_PARAMS");
  1693. }
  1694. break;
  1695. }
  1696. case SNDRV_LSM_SET_MODULE_PARAMS_32:
  1697. case SNDRV_LSM_SET_MODULE_PARAMS_V2_32: {
  1698. struct snd_lsm_module_params_32 p_data_32;
  1699. struct snd_lsm_module_params p_data;
  1700. u8 *params32;
  1701. size_t expected_size = 0, count;
  1702. struct lsm_params_info_32 *p_info_32 = NULL;
  1703. struct lsm_params_info_v2_32 *p_info_v2_32 = NULL;
  1704. struct lsm_params_info_v2 p_info;
  1705. if (!prtd->lsm_client->use_topology) {
  1706. dev_err(rtd->dev,
  1707. "%s: %s: not supported if not using topology\n",
  1708. __func__, "SET_MODULE_PARAMS(_V2)_32");
  1709. err = -EINVAL;
  1710. goto done;
  1711. }
  1712. if (copy_from_user(&p_data_32, arg,
  1713. sizeof(p_data_32))) {
  1714. dev_err(rtd->dev,
  1715. "%s: %s: copy_from_user failed, size = %zd\n",
  1716. __func__, "SET_MODULE_PARAMS(_V2)_32",
  1717. sizeof(p_data_32));
  1718. err = -EFAULT;
  1719. goto done;
  1720. }
  1721. p_data.params = compat_ptr(p_data_32.params);
  1722. p_data.num_params = p_data_32.num_params;
  1723. p_data.data_size = p_data_32.data_size;
  1724. if (p_data.num_params > LSM_PARAMS_MAX) {
  1725. dev_err(rtd->dev,
  1726. "%s: %s: Invalid num_params %d\n",
  1727. __func__, "SET_MODULE_PARAMS(_V2)_32",
  1728. p_data.num_params);
  1729. err = -EINVAL;
  1730. goto done;
  1731. }
  1732. expected_size = (cmd == SNDRV_LSM_SET_MODULE_PARAMS_32) ?
  1733. p_data.num_params * sizeof(struct lsm_params_info_32) :
  1734. p_data.num_params * sizeof(struct lsm_params_info_v2_32);
  1735. if (p_data.data_size != expected_size) {
  1736. dev_err(rtd->dev,
  1737. "%s: %s: Invalid size %d\n",
  1738. __func__, "SET_MODULE_PARAMS(_V2)_32",
  1739. p_data.data_size);
  1740. err = -EINVAL;
  1741. goto done;
  1742. }
  1743. params32 = kzalloc(p_data.data_size, GFP_KERNEL);
  1744. if (!params32) {
  1745. err = -ENOMEM;
  1746. goto done;
  1747. }
  1748. if (copy_from_user(params32, p_data.params,
  1749. p_data.data_size)) {
  1750. dev_err(rtd->dev,
  1751. "%s: %s: copy_from_user failed, size = %d\n",
  1752. __func__, "params32", p_data.data_size);
  1753. kfree(params32);
  1754. err = -EFAULT;
  1755. goto done;
  1756. }
  1757. if (cmd == SNDRV_LSM_SET_MODULE_PARAMS_32)
  1758. p_info_32 = (struct lsm_params_info_32 *) params32;
  1759. else
  1760. p_info_v2_32 = (struct lsm_params_info_v2_32 *) params32;
  1761. for (count = 0; count < p_data.num_params; count++) {
  1762. if (cmd == SNDRV_LSM_SET_MODULE_PARAMS_32) {
  1763. p_info.module_id = p_info_32->module_id;
  1764. p_info.param_id = p_info_32->param_id;
  1765. p_info.param_size = p_info_32->param_size;
  1766. p_info.param_data = compat_ptr(p_info_32->param_data);
  1767. p_info.param_type = p_info_32->param_type;
  1768. p_info.instance_id = INSTANCE_ID_0;
  1769. p_info.stage_idx = LSM_STAGE_INDEX_FIRST;
  1770. p_info_32++;
  1771. } else {
  1772. p_info.module_id = p_info_v2_32->module_id;
  1773. p_info.param_id = p_info_v2_32->param_id;
  1774. p_info.param_size = p_info_v2_32->param_size;
  1775. p_info.param_data = compat_ptr(p_info_v2_32->param_data);
  1776. p_info.param_type = p_info_v2_32->param_type;
  1777. p_info.instance_id = p_info_v2_32->instance_id;
  1778. p_info.stage_idx = p_info_v2_32->stage_idx;
  1779. p_info_v2_32++;
  1780. }
  1781. err = msm_lsm_process_params(substream, &p_info);
  1782. if (err)
  1783. dev_err(rtd->dev,
  1784. "%s: Failed to process param, type%d stage=%d err=%d\n",
  1785. __func__, p_info.param_type, p_info.stage_idx, err);
  1786. }
  1787. kfree(params32);
  1788. break;
  1789. }
  1790. case SNDRV_LSM_REG_SND_MODEL_V2:
  1791. case SNDRV_LSM_SET_PARAMS:
  1792. case SNDRV_LSM_SET_MODULE_PARAMS:
  1793. case SNDRV_LSM_SET_MODULE_PARAMS_V2:
  1794. /*
  1795. * In ideal cases, the compat_ioctl should never be called
  1796. * with the above unlocked ioctl commands. Print error
  1797. * and return error if it does.
  1798. */
  1799. dev_err(rtd->dev,
  1800. "%s: Invalid cmd for compat_ioctl\n",
  1801. __func__);
  1802. err = -EINVAL;
  1803. break;
  1804. default:
  1805. err = msm_lsm_ioctl_shared(substream, cmd, arg);
  1806. break;
  1807. }
  1808. done:
  1809. mutex_unlock(&prtd->lsm_api_lock);
  1810. return err;
  1811. }
  1812. #else
  1813. #define msm_lsm_ioctl_compat NULL
  1814. #endif
  1815. static int msm_lsm_ioctl(struct snd_pcm_substream *substream,
  1816. unsigned int cmd, void __user *arg)
  1817. {
  1818. int err = 0;
  1819. u32 size = 0;
  1820. struct snd_pcm_runtime *runtime;
  1821. struct snd_soc_pcm_runtime *rtd;
  1822. struct lsm_priv *prtd;
  1823. if (!substream || !substream->private_data) {
  1824. pr_err("%s: Invalid %s\n", __func__,
  1825. (!substream) ? "substream" : "private_data");
  1826. return -EINVAL;
  1827. }
  1828. runtime = substream->runtime;
  1829. prtd = runtime->private_data;
  1830. rtd = substream->private_data;
  1831. mutex_lock(&prtd->lsm_api_lock);
  1832. switch (cmd) {
  1833. case SNDRV_LSM_REG_SND_MODEL_V2: {
  1834. struct snd_lsm_sound_model_v2 snd_model_v2;
  1835. if (prtd->lsm_client->use_topology) {
  1836. dev_err(rtd->dev,
  1837. "%s: %s: not supported if using topology\n",
  1838. __func__, "REG_SND_MODEL_V2");
  1839. err = -EINVAL;
  1840. goto done;
  1841. }
  1842. if (copy_from_user(&snd_model_v2, arg, sizeof(snd_model_v2))) {
  1843. err = -EFAULT;
  1844. dev_err(rtd->dev,
  1845. "%s: copy from user failed, size %zd\n",
  1846. __func__,
  1847. sizeof(struct snd_lsm_sound_model_v2));
  1848. }
  1849. if (!err)
  1850. err = msm_lsm_ioctl_shared(substream, cmd,
  1851. &snd_model_v2);
  1852. if (err)
  1853. dev_err(rtd->dev,
  1854. "%s REG_SND_MODEL failed err %d\n",
  1855. __func__, err);
  1856. goto done;
  1857. }
  1858. break;
  1859. case SNDRV_LSM_SET_PARAMS: {
  1860. struct snd_lsm_detection_params det_params;
  1861. if (prtd->lsm_client->use_topology) {
  1862. dev_err(rtd->dev,
  1863. "%s: %s: not supported if using topology\n",
  1864. __func__, "SET_PARAMS");
  1865. err = -EINVAL;
  1866. goto done;
  1867. }
  1868. pr_debug("%s: SNDRV_LSM_SET_PARAMS\n", __func__);
  1869. if (copy_from_user(&det_params, arg,
  1870. sizeof(det_params))) {
  1871. dev_err(rtd->dev,
  1872. "%s: %s: copy_from_user failed, size %zd\n",
  1873. __func__, "SNDRV_LSM_SET_PARAMS",
  1874. sizeof(det_params));
  1875. err = -EFAULT;
  1876. }
  1877. if (!err)
  1878. err = msm_lsm_ioctl_shared(substream, cmd,
  1879. &det_params);
  1880. else
  1881. dev_err(rtd->dev,
  1882. "%s: LSM_SET_PARAMS failed, err %d\n",
  1883. __func__, err);
  1884. goto done;
  1885. }
  1886. case SNDRV_LSM_SET_MODULE_PARAMS:
  1887. case SNDRV_LSM_SET_MODULE_PARAMS_V2: {
  1888. struct snd_lsm_module_params p_data;
  1889. struct lsm_params_info *temp_ptr_info = NULL;
  1890. struct lsm_params_info_v2 info_v2;
  1891. struct lsm_params_info_v2 *ptr_info_v2 = NULL, *temp_ptr_info_v2 = NULL;
  1892. size_t p_size = 0, count;
  1893. u8 *params;
  1894. if (!prtd->lsm_client->use_topology) {
  1895. dev_err(rtd->dev,
  1896. "%s: %s: not supported if not using topology\n",
  1897. __func__, "SET_MODULE_PARAMS(_V2)");
  1898. err = -EINVAL;
  1899. goto done;
  1900. }
  1901. if (copy_from_user(&p_data, arg,
  1902. sizeof(p_data))) {
  1903. dev_err(rtd->dev,
  1904. "%s: %s: copy_from_user failed, size = %zd\n",
  1905. __func__, "p_data", sizeof(p_data));
  1906. err = -EFAULT;
  1907. goto done;
  1908. }
  1909. if (p_data.num_params > LSM_PARAMS_MAX) {
  1910. dev_err(rtd->dev,
  1911. "%s: %s: Invalid num_params %d\n",
  1912. __func__, "SET_MODULE_PARAMS(_V2)",
  1913. p_data.num_params);
  1914. err = -EINVAL;
  1915. goto done;
  1916. }
  1917. if (cmd == SNDRV_LSM_SET_MODULE_PARAMS)
  1918. p_size = p_data.num_params * sizeof(struct lsm_params_info);
  1919. else
  1920. p_size = p_data.num_params * sizeof(struct lsm_params_info_v2);
  1921. if (p_data.data_size != p_size) {
  1922. dev_err(rtd->dev,
  1923. "%s: %s: Invalid data_size(%u) against expected(%zd)\n",
  1924. __func__, "SET_MODULE_PARAMS(_V2)",
  1925. p_data.data_size, p_size);
  1926. err = -EFAULT;
  1927. goto done;
  1928. }
  1929. params = kzalloc(p_size, GFP_KERNEL);
  1930. if (!params) {
  1931. err = -ENOMEM;
  1932. goto done;
  1933. }
  1934. if (copy_from_user(params, p_data.params,
  1935. p_data.data_size)) {
  1936. dev_err(rtd->dev,
  1937. "%s: %s: copy_from_user failed, size = %d\n",
  1938. __func__, "set module params", p_data.data_size);
  1939. kfree(params);
  1940. err = -EFAULT;
  1941. goto done;
  1942. }
  1943. if (cmd == SNDRV_LSM_SET_MODULE_PARAMS)
  1944. temp_ptr_info = (struct lsm_params_info *)params;
  1945. else
  1946. temp_ptr_info_v2 = (struct lsm_params_info_v2 *)params;
  1947. for (count = 0; count < p_data.num_params; count++) {
  1948. if (cmd == SNDRV_LSM_SET_MODULE_PARAMS) {
  1949. /* convert to V2 param info struct from legacy param info */
  1950. info_v2.module_id = temp_ptr_info->module_id;
  1951. info_v2.param_id = temp_ptr_info->param_id;
  1952. info_v2.param_size = temp_ptr_info->param_size;
  1953. info_v2.param_data = temp_ptr_info->param_data;
  1954. info_v2.param_type = temp_ptr_info->param_type;
  1955. info_v2.instance_id = INSTANCE_ID_0;
  1956. info_v2.stage_idx = LSM_STAGE_INDEX_FIRST;
  1957. ptr_info_v2 = &info_v2;
  1958. temp_ptr_info++;
  1959. } else {
  1960. /* Just copy the pointer as user already provided v2 params */
  1961. ptr_info_v2 = temp_ptr_info_v2;
  1962. temp_ptr_info_v2++;
  1963. }
  1964. err = msm_lsm_process_params(substream, ptr_info_v2);
  1965. if (err)
  1966. dev_err(rtd->dev,
  1967. "%s: Failed to process param, type%d stage=%d err=%d\n",
  1968. __func__, ptr_info_v2->param_type,
  1969. ptr_info_v2->stage_idx, err);
  1970. }
  1971. kfree(params);
  1972. break;
  1973. }
  1974. case SNDRV_LSM_EVENT_STATUS:
  1975. case SNDRV_LSM_GENERIC_DET_EVENT: {
  1976. struct snd_lsm_event_status *user = NULL;
  1977. struct snd_lsm_event_status userarg;
  1978. dev_dbg(rtd->dev,
  1979. "%s: %s\n", __func__,
  1980. (cmd == SNDRV_LSM_EVENT_STATUS) ?
  1981. "SNDRV_LSM_EVENT_STATUS" :
  1982. "SNDRV_LSM_GENERIC_DET_EVENT");
  1983. err = msm_lsm_check_event_type(prtd->lsm_client, cmd);
  1984. if (err)
  1985. goto done;
  1986. if (copy_from_user(&userarg, arg, sizeof(userarg))) {
  1987. dev_err(rtd->dev,
  1988. "%s: %s: Copy from user failed\n", __func__,
  1989. (cmd == SNDRV_LSM_EVENT_STATUS) ?
  1990. "SNDRV_LSM_EVENT_STATUS" :
  1991. "SNDRV_LSM_GENERIC_DET_EVENT");
  1992. err = -EFAULT;
  1993. goto done;
  1994. }
  1995. if (userarg.payload_size >
  1996. LISTEN_MAX_STATUS_PAYLOAD_SIZE) {
  1997. dev_err(rtd->dev,
  1998. "%s: payload_size %d is invalid, max allowed = %d\n",
  1999. __func__, userarg.payload_size,
  2000. LISTEN_MAX_STATUS_PAYLOAD_SIZE);
  2001. err = -EINVAL;
  2002. goto done;
  2003. }
  2004. size = sizeof(struct snd_lsm_event_status) +
  2005. userarg.payload_size;
  2006. user = kzalloc(size, GFP_KERNEL);
  2007. if (!user) {
  2008. err = -ENOMEM;
  2009. goto done;
  2010. }
  2011. user->payload_size = userarg.payload_size;
  2012. err = msm_lsm_ioctl_shared(substream, cmd, user);
  2013. if (err) {
  2014. dev_err(rtd->dev,
  2015. "%s: msm_lsm_ioctl_shared() failed, err = %d",
  2016. __func__, err);
  2017. kfree(user);
  2018. goto done;
  2019. }
  2020. /* Update size with actual payload size */
  2021. size = sizeof(*user) + user->payload_size;
  2022. if (!access_ok(VERIFY_WRITE, arg, size)) {
  2023. dev_err(rtd->dev,
  2024. "%s: Failed to verify write, size = %d\n",
  2025. __func__, size);
  2026. err = -EFAULT;
  2027. }
  2028. if (!err && copy_to_user(arg, user, size)) {
  2029. dev_err(rtd->dev,
  2030. "%s: Failed to copy payload to user, size = %d\n",
  2031. __func__, size);
  2032. err = -EFAULT;
  2033. }
  2034. kfree(user);
  2035. break;
  2036. }
  2037. case SNDRV_LSM_EVENT_STATUS_V3: {
  2038. struct snd_lsm_event_status_v3 *user = NULL;
  2039. struct snd_lsm_event_status_v3 userarg;
  2040. dev_dbg(rtd->dev,
  2041. "%s: SNDRV_LSM_EVENT_STATUS_V3\n", __func__);
  2042. if (prtd->lsm_client->event_type !=
  2043. LSM_DET_EVENT_TYPE_LEGACY) {
  2044. dev_err(rtd->dev,
  2045. "%s: %s: Invalid event request\n",
  2046. __func__, "SNDRV_LSM_EVENT_STATUS_V3");
  2047. err = -EINVAL;
  2048. goto done;
  2049. }
  2050. if (!arg) {
  2051. dev_err(rtd->dev,
  2052. "%s: Invalid params event_status_v3\n",
  2053. __func__);
  2054. err = -EINVAL;
  2055. goto done;
  2056. }
  2057. if (copy_from_user(&userarg, arg, sizeof(userarg))) {
  2058. dev_err(rtd->dev,
  2059. "%s: err copyuser event_status_v3\n",
  2060. __func__);
  2061. err = -EFAULT;
  2062. goto done;
  2063. }
  2064. if (userarg.payload_size >
  2065. LISTEN_MAX_STATUS_PAYLOAD_SIZE) {
  2066. pr_err("%s: payload_size %d is invalid, max allowed = %d\n",
  2067. __func__, userarg.payload_size,
  2068. LISTEN_MAX_STATUS_PAYLOAD_SIZE);
  2069. err = -EINVAL;
  2070. goto done;
  2071. }
  2072. size = sizeof(struct snd_lsm_event_status_v3) +
  2073. userarg.payload_size;
  2074. user = kzalloc(size, GFP_KERNEL);
  2075. if (!user) {
  2076. dev_err(rtd->dev,
  2077. "%s: Allocation failed event status size %d\n",
  2078. __func__, size);
  2079. err = -EFAULT;
  2080. goto done;
  2081. }
  2082. user->payload_size = userarg.payload_size;
  2083. err = msm_lsm_ioctl_shared(substream, cmd, user);
  2084. /* Update size with actual payload size */
  2085. size = sizeof(*user) + user->payload_size;
  2086. if (!err && !access_ok(VERIFY_WRITE, arg, size)) {
  2087. dev_err(rtd->dev,
  2088. "%s: write verify failed size %d\n",
  2089. __func__, size);
  2090. err = -EFAULT;
  2091. }
  2092. if (!err && (copy_to_user(arg, user, size))) {
  2093. dev_err(rtd->dev,
  2094. "%s: failed to copy payload %d",
  2095. __func__, size);
  2096. err = -EFAULT;
  2097. }
  2098. kfree(user);
  2099. if (err)
  2100. dev_err(rtd->dev,
  2101. "%s: lsm_event_v3 failed %d", __func__, err);
  2102. break;
  2103. }
  2104. default:
  2105. err = msm_lsm_ioctl_shared(substream, cmd, arg);
  2106. break;
  2107. }
  2108. done:
  2109. mutex_unlock(&prtd->lsm_api_lock);
  2110. return err;
  2111. }
  2112. static int msm_lsm_open(struct snd_pcm_substream *substream)
  2113. {
  2114. struct snd_pcm_runtime *runtime = substream->runtime;
  2115. struct lsm_priv *prtd;
  2116. int ret = 0;
  2117. pr_debug("%s\n", __func__);
  2118. prtd = kzalloc(sizeof(struct lsm_priv), GFP_KERNEL);
  2119. if (!prtd) {
  2120. pr_err("%s: Failed to allocate memory for lsm_priv\n",
  2121. __func__);
  2122. return -ENOMEM;
  2123. }
  2124. mutex_init(&prtd->lsm_api_lock);
  2125. spin_lock_init(&prtd->event_lock);
  2126. init_waitqueue_head(&prtd->event_wait);
  2127. init_waitqueue_head(&prtd->period_wait);
  2128. prtd->substream = substream;
  2129. runtime->private_data = prtd;
  2130. runtime->hw = msm_pcm_hardware_capture;
  2131. ret = snd_pcm_hw_constraint_list(runtime, 0,
  2132. SNDRV_PCM_HW_PARAM_RATE,
  2133. &constraints_sample_rates);
  2134. if (ret < 0)
  2135. pr_info("%s: snd_pcm_hw_constraint_list failed ret %d\n",
  2136. __func__, ret);
  2137. /* Ensure that buffer size is a multiple of period size */
  2138. ret = snd_pcm_hw_constraint_integer(runtime,
  2139. SNDRV_PCM_HW_PARAM_PERIODS);
  2140. if (ret < 0)
  2141. pr_info("%s: snd_pcm_hw_constraint_integer failed ret %d\n",
  2142. __func__, ret);
  2143. ret = snd_pcm_hw_constraint_minmax(runtime,
  2144. SNDRV_PCM_HW_PARAM_BUFFER_BYTES,
  2145. CAPTURE_MIN_NUM_PERIODS * CAPTURE_MIN_PERIOD_SIZE,
  2146. CAPTURE_MAX_NUM_PERIODS * CAPTURE_MAX_PERIOD_SIZE);
  2147. if (ret < 0)
  2148. pr_info("%s: constraint for buffer bytes min max ret = %d\n",
  2149. __func__, ret);
  2150. ret = snd_pcm_hw_constraint_step(runtime, 0,
  2151. SNDRV_PCM_HW_PARAM_PERIOD_BYTES, 32);
  2152. if (ret < 0) {
  2153. pr_info("%s: constraint for period bytes step ret = %d\n",
  2154. __func__, ret);
  2155. }
  2156. ret = snd_pcm_hw_constraint_step(runtime, 0,
  2157. SNDRV_PCM_HW_PARAM_BUFFER_BYTES, 32);
  2158. if (ret < 0)
  2159. pr_info("%s: constraint for buffer bytes step ret = %d\n",
  2160. __func__, ret);
  2161. prtd->lsm_client = q6lsm_client_alloc(
  2162. lsm_event_handler, prtd);
  2163. if (!prtd->lsm_client) {
  2164. pr_err("%s: Could not allocate memory\n", __func__);
  2165. kfree(prtd);
  2166. runtime->private_data = NULL;
  2167. return -ENOMEM;
  2168. }
  2169. prtd->lsm_client->opened = false;
  2170. prtd->lsm_client->session_state = IDLE;
  2171. prtd->lsm_client->poll_enable = true;
  2172. prtd->lsm_client->perf_mode = 0;
  2173. prtd->lsm_client->event_mode = LSM_EVENT_NON_TIME_STAMP_MODE;
  2174. prtd->lsm_client->event_type = LSM_DET_EVENT_TYPE_LEGACY;
  2175. return 0;
  2176. }
  2177. static int msm_lsm_send_ch_mix_config(struct snd_pcm_substream *substream)
  2178. {
  2179. struct snd_pcm_runtime *runtime = substream->runtime;
  2180. struct lsm_priv *prtd = runtime->private_data;
  2181. struct snd_soc_pcm_runtime *rtd;
  2182. struct lsm_hw_params *in_params;
  2183. int pp_ch_cnt;
  2184. int *ch_wght_coeff;
  2185. int ret = 0, i, idx;
  2186. /*
  2187. * The output channels from channel mixer is the input to LSM (stream)
  2188. * side and is read from in_params->num_chs.
  2189. *
  2190. * The input channels to channel mixer are the output channels from
  2191. * the device side (routing) and is obtained by reading the
  2192. * pp_ch_cnt.
  2193. *
  2194. * For LSM to be functional, only unity channel mixing is allowed.
  2195. */
  2196. in_params = &prtd->lsm_client->in_hw_params;
  2197. rtd = prtd->substream->private_data;
  2198. pp_ch_cnt = msm_pcm_routing_get_pp_ch_cnt(rtd->dai_link->id,
  2199. SESSION_TYPE_TX);
  2200. if (pp_ch_cnt < 0 ||
  2201. pp_ch_cnt > LSM_V3P0_MAX_NUM_CHANNELS ||
  2202. in_params->num_chs > LSM_V3P0_MAX_NUM_CHANNELS) {
  2203. dev_err(rtd->dev,
  2204. "%s: invalid ch cnt, pp_ch_cnt %d in_ch_cnt %d\n",
  2205. __func__, pp_ch_cnt, in_params->num_chs);
  2206. return -EINVAL;
  2207. }
  2208. if (!pp_ch_cnt ||
  2209. (pp_ch_cnt == in_params->num_chs)) {
  2210. dev_dbg(rtd->dev,
  2211. "%s: Skip ch mixing, pp_ch_cnt %d in_ch_cnt %d\n",
  2212. __func__, pp_ch_cnt, in_params->num_chs);
  2213. return 0;
  2214. }
  2215. ch_wght_coeff = kzalloc(in_params->num_chs * pp_ch_cnt * sizeof(int),
  2216. GFP_KERNEL);
  2217. if (!ch_wght_coeff)
  2218. return -ENOMEM;
  2219. /*
  2220. * channel weight co-efficients is a m X n array, where
  2221. * m = number of input channels to ch mixer (pp_ch_cnt)
  2222. * n = number of output channels from ch mixer (in_params->num_chs)
  2223. */
  2224. for (i = 0; i < in_params->num_chs; i++) {
  2225. idx = (i * pp_ch_cnt) + i;
  2226. ch_wght_coeff[idx] = 1;
  2227. }
  2228. ret = msm_pcm_routing_send_chmix_cfg(rtd->dai_link->id,
  2229. pp_ch_cnt, in_params->num_chs,
  2230. ch_wght_coeff,
  2231. SESSION_TYPE_TX, STREAM_TYPE_LSM);
  2232. if (ret)
  2233. dev_err(rtd->dev,
  2234. "%s: Failed to configure channel mixer err %d\n",
  2235. __func__, ret);
  2236. kfree(ch_wght_coeff);
  2237. return ret;
  2238. }
  2239. static int msm_lsm_prepare(struct snd_pcm_substream *substream)
  2240. {
  2241. struct snd_pcm_runtime *runtime = substream->runtime;
  2242. struct lsm_priv *prtd = runtime->private_data;
  2243. struct snd_soc_pcm_runtime *rtd;
  2244. int ret = 0;
  2245. if (!substream->private_data) {
  2246. pr_err("%s: Invalid private_data", __func__);
  2247. return -EINVAL;
  2248. }
  2249. rtd = prtd->substream->private_data;
  2250. if (!prtd->lsm_client) {
  2251. dev_err(rtd->dev,
  2252. "%s: LSM client data ptr is NULL\n", __func__);
  2253. return -EINVAL;
  2254. }
  2255. if (q6lsm_set_media_fmt_v2_params(prtd->lsm_client))
  2256. dev_dbg(rtd->dev,
  2257. "%s: failed to set lsm media fmt params\n", __func__);
  2258. if (prtd->lsm_client->session_state == IDLE) {
  2259. ret = msm_pcm_routing_reg_phy_compr_stream(
  2260. rtd->dai_link->id,
  2261. prtd->lsm_client->perf_mode,
  2262. prtd->lsm_client->session,
  2263. SNDRV_PCM_STREAM_CAPTURE,
  2264. LISTEN);
  2265. if (ret) {
  2266. dev_err(rtd->dev,
  2267. "%s: register phy compr stream failed %d\n",
  2268. __func__, ret);
  2269. return ret;
  2270. }
  2271. ret = msm_lsm_send_ch_mix_config(substream);
  2272. if (ret) {
  2273. msm_pcm_routing_dereg_phy_stream(rtd->dai_link->id,
  2274. SNDRV_PCM_STREAM_CAPTURE);
  2275. return ret;
  2276. }
  2277. }
  2278. prtd->lsm_client->session_state = RUNNING;
  2279. prtd->lsm_client->started = false;
  2280. runtime->private_data = prtd;
  2281. return ret;
  2282. }
  2283. static int msm_lsm_close(struct snd_pcm_substream *substream)
  2284. {
  2285. unsigned long flags;
  2286. struct snd_pcm_runtime *runtime = substream->runtime;
  2287. struct lsm_priv *prtd = runtime->private_data;
  2288. struct snd_soc_pcm_runtime *rtd;
  2289. int ret = 0;
  2290. if (!substream->private_data) {
  2291. pr_err("%s: Invalid private_data", __func__);
  2292. return -EINVAL;
  2293. }
  2294. if (!prtd || !prtd->lsm_client) {
  2295. pr_err("%s: No LSM session active\n", __func__);
  2296. return -EINVAL;
  2297. }
  2298. rtd = substream->private_data;
  2299. dev_dbg(rtd->dev, "%s\n", __func__);
  2300. if (prtd->lsm_client->started) {
  2301. ret = q6lsm_stop(prtd->lsm_client, true);
  2302. if (ret)
  2303. dev_err(rtd->dev,
  2304. "%s: session stop failed, err = %d\n",
  2305. __func__, ret);
  2306. else
  2307. dev_dbg(rtd->dev,
  2308. "%s: LSM client session stopped %d\n",
  2309. __func__, ret);
  2310. /*
  2311. * Go Ahead and try de-register sound model,
  2312. * even if stop failed
  2313. */
  2314. prtd->lsm_client->started = false;
  2315. ret = q6lsm_deregister_sound_model(prtd->lsm_client);
  2316. if (ret)
  2317. dev_err(rtd->dev,
  2318. "%s: dereg_snd_model failed, err = %d\n",
  2319. __func__, ret);
  2320. else
  2321. dev_dbg(rtd->dev, "%s: dereg_snd_model successful\n",
  2322. __func__);
  2323. }
  2324. msm_pcm_routing_dereg_phy_stream(rtd->dai_link->id,
  2325. SNDRV_PCM_STREAM_CAPTURE);
  2326. if (prtd->lsm_client->opened) {
  2327. q6lsm_close(prtd->lsm_client);
  2328. prtd->lsm_client->opened = false;
  2329. }
  2330. q6lsm_client_free(prtd->lsm_client);
  2331. spin_lock_irqsave(&prtd->event_lock, flags);
  2332. kfree(prtd->event_status);
  2333. prtd->event_status = NULL;
  2334. kfree(prtd->det_event);
  2335. prtd->det_event = NULL;
  2336. spin_unlock_irqrestore(&prtd->event_lock, flags);
  2337. mutex_destroy(&prtd->lsm_api_lock);
  2338. kfree(prtd);
  2339. runtime->private_data = NULL;
  2340. return 0;
  2341. }
  2342. static int msm_lsm_hw_params(struct snd_pcm_substream *substream,
  2343. struct snd_pcm_hw_params *params)
  2344. {
  2345. struct snd_pcm_runtime *runtime = substream->runtime;
  2346. struct lsm_priv *prtd = runtime->private_data;
  2347. struct lsm_hw_params *out_hw_params = NULL;
  2348. struct lsm_hw_params *in_hw_params = NULL;
  2349. struct snd_soc_pcm_runtime *rtd;
  2350. if (!substream->private_data) {
  2351. pr_err("%s: Invalid private_data", __func__);
  2352. return -EINVAL;
  2353. }
  2354. rtd = substream->private_data;
  2355. if (!prtd || !params) {
  2356. dev_err(rtd->dev,
  2357. "%s: invalid params prtd %pK params %pK",
  2358. __func__, prtd, params);
  2359. return -EINVAL;
  2360. }
  2361. in_hw_params = &prtd->lsm_client->in_hw_params;
  2362. out_hw_params = &prtd->lsm_client->out_hw_params;
  2363. out_hw_params->num_chs = params_channels(params);
  2364. out_hw_params->period_count = params_periods(params);
  2365. out_hw_params->sample_rate = params_rate(params);
  2366. if (((out_hw_params->sample_rate != 16000) &&
  2367. (out_hw_params->sample_rate != 48000)) ||
  2368. (out_hw_params->period_count == 0)) {
  2369. dev_err(rtd->dev,
  2370. "%s: Invalid Params sample rate %d period count %d\n",
  2371. __func__, out_hw_params->sample_rate,
  2372. out_hw_params->period_count);
  2373. return -EINVAL;
  2374. }
  2375. if (params_format(params) == SNDRV_PCM_FORMAT_S16_LE) {
  2376. out_hw_params->sample_size = 16;
  2377. } else if (params_format(params) == SNDRV_PCM_FORMAT_S24_LE) {
  2378. out_hw_params->sample_size = 24;
  2379. } else {
  2380. dev_err(rtd->dev, "%s: Invalid Format 0x%x\n",
  2381. __func__, params_format(params));
  2382. return -EINVAL;
  2383. }
  2384. out_hw_params->buf_sz = params_buffer_bytes(params) /
  2385. out_hw_params->period_count;
  2386. dev_dbg(rtd->dev,
  2387. "%s: channels %d sample rate %d sample size %d buffer size %d period count %d\n",
  2388. __func__, out_hw_params->num_chs, out_hw_params->sample_rate,
  2389. out_hw_params->sample_size, out_hw_params->buf_sz,
  2390. out_hw_params->period_count);
  2391. /*
  2392. * copy the out_hw_params to in_hw_params. in_hw_params will be
  2393. * over-written with LSM_SET_INPUT_HW_PARAMS ioctl from userspace.
  2394. * If this ioctl is not set, then it is assumed that input and
  2395. * output hw params for LSM are the same.
  2396. * Currently the period_count and buf_sz are unused for input params.
  2397. */
  2398. memcpy(in_hw_params, out_hw_params,
  2399. sizeof(struct lsm_hw_params));
  2400. return 0;
  2401. }
  2402. static snd_pcm_uframes_t msm_lsm_pcm_pointer(
  2403. struct snd_pcm_substream *substream)
  2404. {
  2405. struct snd_pcm_runtime *runtime = substream->runtime;
  2406. struct lsm_priv *prtd = runtime->private_data;
  2407. struct snd_soc_pcm_runtime *rtd;
  2408. if (!substream->private_data) {
  2409. pr_err("%s: Invalid private_data", __func__);
  2410. return -EINVAL;
  2411. }
  2412. rtd = substream->private_data;
  2413. if (!prtd) {
  2414. dev_err(rtd->dev,
  2415. "%s: Invalid param %pK\n", __func__, prtd);
  2416. return 0;
  2417. }
  2418. if (prtd->dma_write >= snd_pcm_lib_buffer_bytes(substream))
  2419. prtd->dma_write = 0;
  2420. dev_dbg(rtd->dev,
  2421. "%s: dma post = %d\n", __func__, prtd->dma_write);
  2422. return bytes_to_frames(runtime, prtd->dma_write);
  2423. }
  2424. static int msm_lsm_pcm_copy(struct snd_pcm_substream *substream, int ch,
  2425. unsigned long hwoff, void __user *buf, unsigned long fbytes)
  2426. {
  2427. struct snd_pcm_runtime *runtime = substream->runtime;
  2428. struct lsm_priv *prtd = runtime->private_data;
  2429. char *pcm_buf = NULL;
  2430. int rc = 0;
  2431. struct snd_soc_pcm_runtime *rtd;
  2432. if (!substream->private_data) {
  2433. pr_err("%s: Invalid private_data", __func__);
  2434. return -EINVAL;
  2435. }
  2436. rtd = substream->private_data;
  2437. if (!prtd) {
  2438. dev_err(rtd->dev,
  2439. "%s: Invalid param %pK\n", __func__, prtd);
  2440. return -EINVAL;
  2441. }
  2442. if (runtime->status->state == SNDRV_PCM_STATE_XRUN ||
  2443. runtime->status->state == SNDRV_PCM_STATE_PREPARED) {
  2444. dev_err(rtd->dev,
  2445. "%s: runtime state incorrect %d", __func__,
  2446. runtime->status->state);
  2447. return 0;
  2448. }
  2449. rc = wait_event_timeout(prtd->period_wait,
  2450. (atomic_read(&prtd->buf_count) |
  2451. atomic_read(&prtd->read_abort)), (2 * HZ));
  2452. if (!rc) {
  2453. dev_err(rtd->dev,
  2454. "%s: timeout for read retry\n", __func__);
  2455. return -EAGAIN;
  2456. }
  2457. if (atomic_read(&prtd->read_abort)) {
  2458. dev_err(rtd->dev,
  2459. "%s: Read abort received\n", __func__);
  2460. return -EIO;
  2461. }
  2462. prtd->appl_cnt = prtd->appl_cnt %
  2463. prtd->lsm_client->out_hw_params.period_count;
  2464. pcm_buf = prtd->lsm_client->lab_buffer[prtd->appl_cnt].data;
  2465. dev_dbg(rtd->dev,
  2466. "%s: copy the pcm data size %lu\n",
  2467. __func__, fbytes);
  2468. if (pcm_buf) {
  2469. if (copy_to_user(buf, pcm_buf, fbytes)) {
  2470. dev_err(rtd->dev,
  2471. "%s: failed to copy bytes %lu\n",
  2472. __func__, fbytes);
  2473. return -EINVAL;
  2474. }
  2475. } else {
  2476. dev_err(rtd->dev,
  2477. "%s: Invalid pcm buffer\n", __func__);
  2478. return -EINVAL;
  2479. }
  2480. prtd->appl_cnt = (prtd->appl_cnt + 1) %
  2481. prtd->lsm_client->out_hw_params.period_count;
  2482. atomic_dec(&prtd->buf_count);
  2483. return 0;
  2484. }
  2485. static int msm_lsm_app_type_cfg_ctl_put(struct snd_kcontrol *kcontrol,
  2486. struct snd_ctl_elem_value *ucontrol)
  2487. {
  2488. u64 fe_id = kcontrol->private_value;
  2489. int session_type = SESSION_TYPE_TX;
  2490. int be_id = ucontrol->value.integer.value[3];
  2491. struct msm_pcm_stream_app_type_cfg cfg_data = {0};
  2492. int ret = 0;
  2493. cfg_data.app_type = ucontrol->value.integer.value[0];
  2494. cfg_data.acdb_dev_id = ucontrol->value.integer.value[1];
  2495. cfg_data.sample_rate = ucontrol->value.integer.value[2];
  2496. pr_debug("%s: fe_id- %llu session_type- %d be_id- %d app_type- %d acdb_dev_id- %d sample_rate- %d\n",
  2497. __func__, fe_id, session_type, be_id,
  2498. cfg_data.app_type, cfg_data.acdb_dev_id, cfg_data.sample_rate);
  2499. ret = msm_pcm_routing_reg_stream_app_type_cfg(fe_id, session_type,
  2500. be_id, &cfg_data);
  2501. if (ret < 0)
  2502. pr_err("%s: msm_pcm_routing_reg_stream_app_type_cfg failed returned %d\n",
  2503. __func__, ret);
  2504. return 0;
  2505. }
  2506. static int msm_lsm_app_type_cfg_ctl_get(struct snd_kcontrol *kcontrol,
  2507. struct snd_ctl_elem_value *ucontrol)
  2508. {
  2509. u64 fe_id = kcontrol->private_value;
  2510. int session_type = SESSION_TYPE_TX;
  2511. int be_id = 0;
  2512. struct msm_pcm_stream_app_type_cfg cfg_data = {0};
  2513. int ret = 0;
  2514. ret = msm_pcm_routing_get_stream_app_type_cfg(fe_id, session_type,
  2515. &be_id, &cfg_data);
  2516. if (ret < 0) {
  2517. pr_err("%s: msm_pcm_routing_get_stream_app_type_cfg failed returned %d\n",
  2518. __func__, ret);
  2519. goto done;
  2520. }
  2521. ucontrol->value.integer.value[0] = cfg_data.app_type;
  2522. ucontrol->value.integer.value[1] = cfg_data.acdb_dev_id;
  2523. ucontrol->value.integer.value[2] = cfg_data.sample_rate;
  2524. ucontrol->value.integer.value[3] = be_id;
  2525. pr_debug("%s: fedai_id %llu, session_type %d, be_id %d, app_type %d, acdb_dev_id %d, sample_rate %d\n",
  2526. __func__, fe_id, session_type, be_id,
  2527. cfg_data.app_type, cfg_data.acdb_dev_id, cfg_data.sample_rate);
  2528. done:
  2529. return ret;
  2530. }
  2531. static int msm_lsm_add_app_type_controls(struct snd_soc_pcm_runtime *rtd)
  2532. {
  2533. struct snd_pcm *pcm = rtd->pcm;
  2534. struct snd_pcm_usr *app_type_info;
  2535. struct snd_kcontrol *kctl;
  2536. const char *mixer_ctl_name = "Listen Stream";
  2537. const char *deviceNo = "NN";
  2538. const char *suffix = "App Type Cfg";
  2539. int ctl_len, ret = 0;
  2540. ctl_len = strlen(mixer_ctl_name) + 1 +
  2541. strlen(deviceNo) + 1 + strlen(suffix) + 1;
  2542. pr_debug("%s: Listen app type cntrl add\n", __func__);
  2543. ret = snd_pcm_add_usr_ctls(pcm, SNDRV_PCM_STREAM_CAPTURE,
  2544. NULL, 1, ctl_len, rtd->dai_link->id,
  2545. &app_type_info);
  2546. if (ret < 0) {
  2547. pr_err("%s: Listen app type cntrl add failed: %d\n",
  2548. __func__, ret);
  2549. return ret;
  2550. }
  2551. kctl = app_type_info->kctl;
  2552. snprintf(kctl->id.name, ctl_len, "%s %d %s",
  2553. mixer_ctl_name, rtd->pcm->device, suffix);
  2554. kctl->put = msm_lsm_app_type_cfg_ctl_put;
  2555. kctl->get = msm_lsm_app_type_cfg_ctl_get;
  2556. return 0;
  2557. }
  2558. static int msm_lsm_add_controls(struct snd_soc_pcm_runtime *rtd)
  2559. {
  2560. int ret = 0;
  2561. ret = msm_lsm_add_app_type_controls(rtd);
  2562. if (ret)
  2563. pr_err("%s, add app type controls failed:%d\n", __func__, ret);
  2564. return ret;
  2565. }
  2566. static const struct snd_pcm_ops msm_lsm_ops = {
  2567. .open = msm_lsm_open,
  2568. .close = msm_lsm_close,
  2569. .ioctl = msm_lsm_ioctl,
  2570. .prepare = msm_lsm_prepare,
  2571. .compat_ioctl = msm_lsm_ioctl_compat,
  2572. .hw_params = msm_lsm_hw_params,
  2573. .copy_user = msm_lsm_pcm_copy,
  2574. .pointer = msm_lsm_pcm_pointer,
  2575. };
  2576. static int msm_asoc_lsm_new(struct snd_soc_pcm_runtime *rtd)
  2577. {
  2578. struct snd_card *card = rtd->card->snd_card;
  2579. int ret = 0;
  2580. if (!card->dev->coherent_dma_mask)
  2581. card->dev->coherent_dma_mask = DMA_BIT_MASK(32);
  2582. ret = msm_lsm_add_controls(rtd);
  2583. if (ret)
  2584. pr_err("%s, kctl add failed:%d\n", __func__, ret);
  2585. return ret;
  2586. }
  2587. static int msm_asoc_lsm_probe(struct snd_soc_platform *platform)
  2588. {
  2589. pr_debug("enter %s\n", __func__);
  2590. return 0;
  2591. }
  2592. static struct snd_soc_platform_driver msm_soc_platform = {
  2593. .ops = &msm_lsm_ops,
  2594. .pcm_new = msm_asoc_lsm_new,
  2595. .probe = msm_asoc_lsm_probe,
  2596. };
  2597. static int msm_lsm_probe(struct platform_device *pdev)
  2598. {
  2599. return snd_soc_register_platform(&pdev->dev, &msm_soc_platform);
  2600. }
  2601. static int msm_lsm_remove(struct platform_device *pdev)
  2602. {
  2603. snd_soc_unregister_platform(&pdev->dev);
  2604. return 0;
  2605. }
  2606. static const struct of_device_id msm_lsm_client_dt_match[] = {
  2607. {.compatible = "qcom,msm-lsm-client" },
  2608. { }
  2609. };
  2610. static struct platform_driver msm_lsm_driver = {
  2611. .driver = {
  2612. .name = "msm-lsm-client",
  2613. .owner = THIS_MODULE,
  2614. .of_match_table = of_match_ptr(msm_lsm_client_dt_match),
  2615. },
  2616. .probe = msm_lsm_probe,
  2617. .remove = msm_lsm_remove,
  2618. };
  2619. int __init msm_lsm_client_init(void)
  2620. {
  2621. return platform_driver_register(&msm_lsm_driver);
  2622. }
  2623. void msm_lsm_client_exit(void)
  2624. {
  2625. platform_driver_unregister(&msm_lsm_driver);
  2626. }
  2627. MODULE_DESCRIPTION("LSM client platform driver");
  2628. MODULE_DEVICE_TABLE(of, msm_lsm_client_dt_match);
  2629. MODULE_LICENSE("GPL v2");