sdca_functions.c 71 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324
  1. // SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause)
  2. // Copyright(c) 2024 Intel Corporation
  3. /*
  4. * The MIPI SDCA specification is available for public downloads at
  5. * https://www.mipi.org/mipi-sdca-v1-0-download
  6. */
  7. #include <linux/acpi.h>
  8. #include <linux/byteorder/generic.h>
  9. #include <linux/cleanup.h>
  10. #include <linux/device.h>
  11. #include <linux/dev_printk.h>
  12. #include <linux/module.h>
  13. #include <linux/property.h>
  14. #include <linux/soundwire/sdw.h>
  15. #include <linux/string.h>
  16. #include <linux/types.h>
  17. #include <sound/sdca.h>
  18. #include <sound/sdca_function.h>
  19. #include <sound/sdca_hid.h>
  20. /*
  21. * Should be long enough to encompass all the MIPI DisCo properties.
  22. */
  23. #define SDCA_PROPERTY_LENGTH 64
  24. static int patch_sdca_function_type(u32 interface_revision, u32 *function_type)
  25. {
  26. /*
  27. * Unfortunately early SDCA specifications used different indices for Functions,
  28. * for backwards compatibility we have to reorder the values found.
  29. */
  30. if (interface_revision < 0x0801) {
  31. switch (*function_type) {
  32. case 1:
  33. *function_type = SDCA_FUNCTION_TYPE_SMART_AMP;
  34. break;
  35. case 2:
  36. *function_type = SDCA_FUNCTION_TYPE_SMART_MIC;
  37. break;
  38. case 3:
  39. *function_type = SDCA_FUNCTION_TYPE_SPEAKER_MIC;
  40. break;
  41. case 4:
  42. *function_type = SDCA_FUNCTION_TYPE_UAJ;
  43. break;
  44. case 5:
  45. *function_type = SDCA_FUNCTION_TYPE_RJ;
  46. break;
  47. case 6:
  48. *function_type = SDCA_FUNCTION_TYPE_HID;
  49. break;
  50. default:
  51. return -EINVAL;
  52. }
  53. }
  54. return 0;
  55. }
  56. static const char *get_sdca_function_name(u32 function_type)
  57. {
  58. switch (function_type) {
  59. case SDCA_FUNCTION_TYPE_SMART_AMP:
  60. return SDCA_FUNCTION_TYPE_SMART_AMP_NAME;
  61. case SDCA_FUNCTION_TYPE_SMART_MIC:
  62. return SDCA_FUNCTION_TYPE_SMART_MIC_NAME;
  63. case SDCA_FUNCTION_TYPE_UAJ:
  64. return SDCA_FUNCTION_TYPE_UAJ_NAME;
  65. case SDCA_FUNCTION_TYPE_HID:
  66. return SDCA_FUNCTION_TYPE_HID_NAME;
  67. case SDCA_FUNCTION_TYPE_SIMPLE_AMP:
  68. return SDCA_FUNCTION_TYPE_SIMPLE_AMP_NAME;
  69. case SDCA_FUNCTION_TYPE_SIMPLE_MIC:
  70. return SDCA_FUNCTION_TYPE_SIMPLE_MIC_NAME;
  71. case SDCA_FUNCTION_TYPE_SPEAKER_MIC:
  72. return SDCA_FUNCTION_TYPE_SPEAKER_MIC_NAME;
  73. case SDCA_FUNCTION_TYPE_RJ:
  74. return SDCA_FUNCTION_TYPE_RJ_NAME;
  75. case SDCA_FUNCTION_TYPE_COMPANION_AMP:
  76. return SDCA_FUNCTION_TYPE_COMPANION_AMP_NAME;
  77. case SDCA_FUNCTION_TYPE_IMP_DEF:
  78. return SDCA_FUNCTION_TYPE_IMP_DEF_NAME;
  79. default:
  80. return NULL;
  81. }
  82. }
  83. static int find_sdca_function(struct acpi_device *adev, void *data)
  84. {
  85. struct fwnode_handle *function_node = acpi_fwnode_handle(adev);
  86. struct sdca_device_data *sdca_data = data;
  87. struct sdw_slave *slave = container_of(sdca_data, struct sdw_slave, sdca_data);
  88. struct device *dev = &adev->dev;
  89. struct fwnode_handle *control5; /* used to identify function type */
  90. const char *function_name;
  91. u32 function_type;
  92. int function_index;
  93. u64 addr;
  94. int ret;
  95. if (sdca_data->num_functions >= SDCA_MAX_FUNCTION_COUNT) {
  96. dev_err(dev, "maximum number of functions exceeded\n");
  97. return -EINVAL;
  98. }
  99. ret = acpi_get_local_u64_address(adev->handle, &addr);
  100. if (ret < 0)
  101. return ret;
  102. if (!addr || addr > 0x7) {
  103. dev_err(dev, "invalid addr: 0x%llx\n", addr);
  104. return -ENODEV;
  105. }
  106. /*
  107. * Extracting the topology type for an SDCA function is a
  108. * convoluted process.
  109. * The Function type is only visible as a result of a read
  110. * from a control. In theory this would mean reading from the hardware,
  111. * but the SDCA/DisCo specs defined the notion of "DC value" - a constant
  112. * represented with a DSD subproperty.
  113. * Drivers have to query the properties for the control
  114. * SDCA_CONTROL_ENTITY_0_FUNCTION_TOPOLOGY (0x05)
  115. */
  116. control5 = fwnode_get_named_child_node(function_node,
  117. "mipi-sdca-control-0x5-subproperties");
  118. if (!control5)
  119. return -ENODEV;
  120. ret = fwnode_property_read_u32(control5, "mipi-sdca-control-dc-value",
  121. &function_type);
  122. fwnode_handle_put(control5);
  123. if (ret < 0) {
  124. dev_err(dev, "function type only supported as DisCo constant\n");
  125. return ret;
  126. }
  127. if (!sdca_device_quirk_match(slave, SDCA_QUIRKS_SKIP_FUNC_TYPE_PATCHING)) {
  128. ret = patch_sdca_function_type(sdca_data->interface_revision, &function_type);
  129. if (ret < 0) {
  130. dev_err(dev, "SDCA version %#x invalid function type %d\n",
  131. sdca_data->interface_revision, function_type);
  132. return ret;
  133. }
  134. }
  135. function_name = get_sdca_function_name(function_type);
  136. if (!function_name) {
  137. dev_err(dev, "invalid SDCA function type %d\n", function_type);
  138. return -EINVAL;
  139. }
  140. dev_info(dev, "SDCA function %s (type %d) at 0x%llx\n",
  141. function_name, function_type, addr);
  142. /* store results */
  143. function_index = sdca_data->num_functions;
  144. sdca_data->function[function_index].adr = addr;
  145. sdca_data->function[function_index].type = function_type;
  146. sdca_data->function[function_index].name = function_name;
  147. sdca_data->function[function_index].node = function_node;
  148. sdca_data->num_functions++;
  149. return 0;
  150. }
  151. /**
  152. * sdca_lookup_functions - Parse sdca_device_desc for each Function
  153. * @slave: SoundWire slave device to be processed.
  154. *
  155. * Iterate through the available SDCA Functions and fill in a short
  156. * descriptor (struct sdca_function_desc) for each function, this
  157. * information is stored along with the SoundWire slave device and
  158. * used for adding drivers and quirks before the devices have fully
  159. * probed.
  160. */
  161. void sdca_lookup_functions(struct sdw_slave *slave)
  162. {
  163. struct device *sdev = &slave->dev;
  164. struct acpi_device *adev = to_acpi_device_node(sdev->fwnode);
  165. if (!adev) {
  166. dev_info(sdev, "no matching ACPI device found, ignoring peripheral\n");
  167. return;
  168. }
  169. acpi_dev_for_each_child(adev, find_sdca_function, &slave->sdca_data);
  170. }
  171. EXPORT_SYMBOL_NS(sdca_lookup_functions, "SND_SOC_SDCA");
  172. struct raw_init_write {
  173. __le32 addr;
  174. u8 val;
  175. } __packed;
  176. static int find_sdca_init_table(struct device *dev,
  177. struct fwnode_handle *function_node,
  178. struct sdca_function_data *function)
  179. {
  180. struct raw_init_write *raw __free(kfree) = NULL;
  181. struct sdca_init_write *init_write;
  182. int i, num_init_writes;
  183. num_init_writes = fwnode_property_count_u8(function_node,
  184. "mipi-sdca-function-initialization-table");
  185. if (!num_init_writes || num_init_writes == -EINVAL) {
  186. return 0;
  187. } else if (num_init_writes < 0) {
  188. dev_err(dev, "%pfwP: failed to read initialization table: %d\n",
  189. function_node, num_init_writes);
  190. return num_init_writes;
  191. } else if (num_init_writes % sizeof(*raw) != 0) {
  192. dev_err(dev, "%pfwP: init table size invalid\n", function_node);
  193. return -EINVAL;
  194. }
  195. raw = kzalloc(num_init_writes, GFP_KERNEL);
  196. if (!raw)
  197. return -ENOMEM;
  198. fwnode_property_read_u8_array(function_node,
  199. "mipi-sdca-function-initialization-table",
  200. (u8 *)raw, num_init_writes);
  201. num_init_writes /= sizeof(*raw);
  202. init_write = devm_kcalloc(dev, num_init_writes, sizeof(*init_write), GFP_KERNEL);
  203. if (!init_write)
  204. return -ENOMEM;
  205. for (i = 0; i < num_init_writes; i++) {
  206. init_write[i].addr = le32_to_cpu(raw[i].addr);
  207. init_write[i].val = raw[i].val;
  208. }
  209. function->num_init_table = num_init_writes;
  210. function->init_table = init_write;
  211. return 0;
  212. }
  213. static const char *find_sdca_control_label(struct device *dev,
  214. const struct sdca_entity *entity,
  215. const struct sdca_control *control)
  216. {
  217. switch (SDCA_CTL_TYPE(entity->type, control->sel)) {
  218. case SDCA_CTL_TYPE_S(IT, MIC_BIAS):
  219. return SDCA_CTL_MIC_BIAS_NAME;
  220. case SDCA_CTL_TYPE_S(IT, USAGE):
  221. case SDCA_CTL_TYPE_S(OT, USAGE):
  222. return SDCA_CTL_USAGE_NAME;
  223. case SDCA_CTL_TYPE_S(IT, LATENCY):
  224. case SDCA_CTL_TYPE_S(OT, LATENCY):
  225. case SDCA_CTL_TYPE_S(MU, LATENCY):
  226. case SDCA_CTL_TYPE_S(SU, LATENCY):
  227. case SDCA_CTL_TYPE_S(FU, LATENCY):
  228. case SDCA_CTL_TYPE_S(XU, LATENCY):
  229. case SDCA_CTL_TYPE_S(CRU, LATENCY):
  230. case SDCA_CTL_TYPE_S(UDMPU, LATENCY):
  231. case SDCA_CTL_TYPE_S(MFPU, LATENCY):
  232. case SDCA_CTL_TYPE_S(SMPU, LATENCY):
  233. case SDCA_CTL_TYPE_S(SAPU, LATENCY):
  234. case SDCA_CTL_TYPE_S(PPU, LATENCY):
  235. return SDCA_CTL_LATENCY_NAME;
  236. case SDCA_CTL_TYPE_S(IT, CLUSTERINDEX):
  237. case SDCA_CTL_TYPE_S(CRU, CLUSTERINDEX):
  238. case SDCA_CTL_TYPE_S(UDMPU, CLUSTERINDEX):
  239. case SDCA_CTL_TYPE_S(MFPU, CLUSTERINDEX):
  240. return SDCA_CTL_CLUSTERINDEX_NAME;
  241. case SDCA_CTL_TYPE_S(IT, DATAPORT_SELECTOR):
  242. case SDCA_CTL_TYPE_S(OT, DATAPORT_SELECTOR):
  243. return SDCA_CTL_DATAPORT_SELECTOR_NAME;
  244. case SDCA_CTL_TYPE_S(IT, MATCHING_GUID):
  245. case SDCA_CTL_TYPE_S(OT, MATCHING_GUID):
  246. case SDCA_CTL_TYPE_S(ENTITY_0, MATCHING_GUID):
  247. return SDCA_CTL_MATCHING_GUID_NAME;
  248. case SDCA_CTL_TYPE_S(IT, KEEP_ALIVE):
  249. case SDCA_CTL_TYPE_S(OT, KEEP_ALIVE):
  250. return SDCA_CTL_KEEP_ALIVE_NAME;
  251. case SDCA_CTL_TYPE_S(IT, NDAI_STREAM):
  252. case SDCA_CTL_TYPE_S(OT, NDAI_STREAM):
  253. return SDCA_CTL_NDAI_STREAM_NAME;
  254. case SDCA_CTL_TYPE_S(IT, NDAI_CATEGORY):
  255. case SDCA_CTL_TYPE_S(OT, NDAI_CATEGORY):
  256. return SDCA_CTL_NDAI_CATEGORY_NAME;
  257. case SDCA_CTL_TYPE_S(IT, NDAI_CODINGTYPE):
  258. case SDCA_CTL_TYPE_S(OT, NDAI_CODINGTYPE):
  259. return SDCA_CTL_NDAI_CODINGTYPE_NAME;
  260. case SDCA_CTL_TYPE_S(IT, NDAI_PACKETTYPE):
  261. case SDCA_CTL_TYPE_S(OT, NDAI_PACKETTYPE):
  262. return SDCA_CTL_NDAI_PACKETTYPE_NAME;
  263. case SDCA_CTL_TYPE_S(MU, MIXER):
  264. return SDCA_CTL_MIXER_NAME;
  265. case SDCA_CTL_TYPE_S(SU, SELECTOR):
  266. return SDCA_CTL_SELECTOR_NAME;
  267. case SDCA_CTL_TYPE_S(FU, MUTE):
  268. return SDCA_CTL_MUTE_NAME;
  269. case SDCA_CTL_TYPE_S(FU, CHANNEL_VOLUME):
  270. return SDCA_CTL_CHANNEL_VOLUME_NAME;
  271. case SDCA_CTL_TYPE_S(FU, AGC):
  272. return SDCA_CTL_AGC_NAME;
  273. case SDCA_CTL_TYPE_S(FU, BASS_BOOST):
  274. return SDCA_CTL_BASS_BOOST_NAME;
  275. case SDCA_CTL_TYPE_S(FU, LOUDNESS):
  276. return SDCA_CTL_LOUDNESS_NAME;
  277. case SDCA_CTL_TYPE_S(FU, GAIN):
  278. return SDCA_CTL_GAIN_NAME;
  279. case SDCA_CTL_TYPE_S(XU, BYPASS):
  280. case SDCA_CTL_TYPE_S(MFPU, BYPASS):
  281. return SDCA_CTL_BYPASS_NAME;
  282. case SDCA_CTL_TYPE_S(XU, XU_ID):
  283. return SDCA_CTL_XU_ID_NAME;
  284. case SDCA_CTL_TYPE_S(XU, XU_VERSION):
  285. return SDCA_CTL_XU_VERSION_NAME;
  286. case SDCA_CTL_TYPE_S(XU, FDL_CURRENTOWNER):
  287. return SDCA_CTL_FDL_CURRENTOWNER_NAME;
  288. case SDCA_CTL_TYPE_S(XU, FDL_MESSAGEOFFSET):
  289. return SDCA_CTL_FDL_MESSAGEOFFSET_NAME;
  290. case SDCA_CTL_TYPE_S(XU, FDL_MESSAGELENGTH):
  291. return SDCA_CTL_FDL_MESSAGELENGTH_NAME;
  292. case SDCA_CTL_TYPE_S(XU, FDL_STATUS):
  293. return SDCA_CTL_FDL_STATUS_NAME;
  294. case SDCA_CTL_TYPE_S(XU, FDL_SET_INDEX):
  295. return SDCA_CTL_FDL_SET_INDEX_NAME;
  296. case SDCA_CTL_TYPE_S(XU, FDL_HOST_REQUEST):
  297. return SDCA_CTL_FDL_HOST_REQUEST_NAME;
  298. case SDCA_CTL_TYPE_S(CS, CLOCK_VALID):
  299. return SDCA_CTL_CLOCK_VALID_NAME;
  300. case SDCA_CTL_TYPE_S(CS, SAMPLERATEINDEX):
  301. return SDCA_CTL_SAMPLERATEINDEX_NAME;
  302. case SDCA_CTL_TYPE_S(CX, CLOCK_SELECT):
  303. return SDCA_CTL_CLOCK_SELECT_NAME;
  304. case SDCA_CTL_TYPE_S(PDE, REQUESTED_PS):
  305. return SDCA_CTL_REQUESTED_PS_NAME;
  306. case SDCA_CTL_TYPE_S(PDE, ACTUAL_PS):
  307. return SDCA_CTL_ACTUAL_PS_NAME;
  308. case SDCA_CTL_TYPE_S(GE, SELECTED_MODE):
  309. return SDCA_CTL_SELECTED_MODE_NAME;
  310. case SDCA_CTL_TYPE_S(GE, DETECTED_MODE):
  311. return SDCA_CTL_DETECTED_MODE_NAME;
  312. case SDCA_CTL_TYPE_S(SPE, PRIVATE):
  313. return SDCA_CTL_PRIVATE_NAME;
  314. case SDCA_CTL_TYPE_S(SPE, PRIVACY_POLICY):
  315. return SDCA_CTL_PRIVACY_POLICY_NAME;
  316. case SDCA_CTL_TYPE_S(SPE, PRIVACY_LOCKSTATE):
  317. return SDCA_CTL_PRIVACY_LOCKSTATE_NAME;
  318. case SDCA_CTL_TYPE_S(SPE, PRIVACY_OWNER):
  319. return SDCA_CTL_PRIVACY_OWNER_NAME;
  320. case SDCA_CTL_TYPE_S(SPE, AUTHTX_CURRENTOWNER):
  321. return SDCA_CTL_AUTHTX_CURRENTOWNER_NAME;
  322. case SDCA_CTL_TYPE_S(SPE, AUTHTX_MESSAGEOFFSET):
  323. return SDCA_CTL_AUTHTX_MESSAGEOFFSET_NAME;
  324. case SDCA_CTL_TYPE_S(SPE, AUTHTX_MESSAGELENGTH):
  325. return SDCA_CTL_AUTHTX_MESSAGELENGTH_NAME;
  326. case SDCA_CTL_TYPE_S(SPE, AUTHRX_CURRENTOWNER):
  327. return SDCA_CTL_AUTHRX_CURRENTOWNER_NAME;
  328. case SDCA_CTL_TYPE_S(SPE, AUTHRX_MESSAGEOFFSET):
  329. return SDCA_CTL_AUTHRX_MESSAGEOFFSET_NAME;
  330. case SDCA_CTL_TYPE_S(SPE, AUTHRX_MESSAGELENGTH):
  331. return SDCA_CTL_AUTHRX_MESSAGELENGTH_NAME;
  332. case SDCA_CTL_TYPE_S(UDMPU, ACOUSTIC_ENERGY_LEVEL_MONITOR):
  333. return SDCA_CTL_ACOUSTIC_ENERGY_LEVEL_MONITOR_NAME;
  334. case SDCA_CTL_TYPE_S(UDMPU, ULTRASOUND_LOOP_GAIN):
  335. return SDCA_CTL_ULTRASOUND_LOOP_GAIN_NAME;
  336. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_0):
  337. return SDCA_CTL_OPAQUESET_0_NAME;
  338. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_1):
  339. return SDCA_CTL_OPAQUESET_1_NAME;
  340. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_2):
  341. return SDCA_CTL_OPAQUESET_2_NAME;
  342. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_3):
  343. return SDCA_CTL_OPAQUESET_3_NAME;
  344. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_4):
  345. return SDCA_CTL_OPAQUESET_4_NAME;
  346. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_5):
  347. return SDCA_CTL_OPAQUESET_5_NAME;
  348. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_6):
  349. return SDCA_CTL_OPAQUESET_6_NAME;
  350. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_7):
  351. return SDCA_CTL_OPAQUESET_7_NAME;
  352. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_8):
  353. return SDCA_CTL_OPAQUESET_8_NAME;
  354. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_9):
  355. return SDCA_CTL_OPAQUESET_9_NAME;
  356. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_10):
  357. return SDCA_CTL_OPAQUESET_10_NAME;
  358. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_11):
  359. return SDCA_CTL_OPAQUESET_11_NAME;
  360. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_12):
  361. return SDCA_CTL_OPAQUESET_12_NAME;
  362. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_13):
  363. return SDCA_CTL_OPAQUESET_13_NAME;
  364. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_14):
  365. return SDCA_CTL_OPAQUESET_14_NAME;
  366. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_15):
  367. return SDCA_CTL_OPAQUESET_15_NAME;
  368. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_16):
  369. return SDCA_CTL_OPAQUESET_16_NAME;
  370. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_17):
  371. return SDCA_CTL_OPAQUESET_17_NAME;
  372. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_18):
  373. return SDCA_CTL_OPAQUESET_18_NAME;
  374. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_19):
  375. return SDCA_CTL_OPAQUESET_19_NAME;
  376. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_20):
  377. return SDCA_CTL_OPAQUESET_20_NAME;
  378. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_21):
  379. return SDCA_CTL_OPAQUESET_21_NAME;
  380. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_22):
  381. return SDCA_CTL_OPAQUESET_22_NAME;
  382. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_23):
  383. return SDCA_CTL_OPAQUESET_23_NAME;
  384. case SDCA_CTL_TYPE_S(MFPU, ALGORITHM_READY):
  385. return SDCA_CTL_ALGORITHM_READY_NAME;
  386. case SDCA_CTL_TYPE_S(MFPU, ALGORITHM_ENABLE):
  387. return SDCA_CTL_ALGORITHM_ENABLE_NAME;
  388. case SDCA_CTL_TYPE_S(MFPU, ALGORITHM_PREPARE):
  389. return SDCA_CTL_ALGORITHM_PREPARE_NAME;
  390. case SDCA_CTL_TYPE_S(MFPU, CENTER_FREQUENCY_INDEX):
  391. return SDCA_CTL_CENTER_FREQUENCY_INDEX_NAME;
  392. case SDCA_CTL_TYPE_S(MFPU, ULTRASOUND_LEVEL):
  393. return SDCA_CTL_ULTRASOUND_LEVEL_NAME;
  394. case SDCA_CTL_TYPE_S(MFPU, AE_NUMBER):
  395. return SDCA_CTL_AE_NUMBER_NAME;
  396. case SDCA_CTL_TYPE_S(MFPU, AE_CURRENTOWNER):
  397. return SDCA_CTL_AE_CURRENTOWNER_NAME;
  398. case SDCA_CTL_TYPE_S(MFPU, AE_MESSAGEOFFSET):
  399. return SDCA_CTL_AE_MESSAGEOFFSET_NAME;
  400. case SDCA_CTL_TYPE_S(MFPU, AE_MESSAGELENGTH):
  401. return SDCA_CTL_AE_MESSAGELENGTH_NAME;
  402. case SDCA_CTL_TYPE_S(SMPU, TRIGGER_ENABLE):
  403. return SDCA_CTL_TRIGGER_ENABLE_NAME;
  404. case SDCA_CTL_TYPE_S(SMPU, TRIGGER_STATUS):
  405. return SDCA_CTL_TRIGGER_STATUS_NAME;
  406. case SDCA_CTL_TYPE_S(SMPU, HIST_BUFFER_MODE):
  407. return SDCA_CTL_HIST_BUFFER_MODE_NAME;
  408. case SDCA_CTL_TYPE_S(SMPU, HIST_BUFFER_PREAMBLE):
  409. return SDCA_CTL_HIST_BUFFER_PREAMBLE_NAME;
  410. case SDCA_CTL_TYPE_S(SMPU, HIST_ERROR):
  411. return SDCA_CTL_HIST_ERROR_NAME;
  412. case SDCA_CTL_TYPE_S(SMPU, TRIGGER_EXTENSION):
  413. return SDCA_CTL_TRIGGER_EXTENSION_NAME;
  414. case SDCA_CTL_TYPE_S(SMPU, TRIGGER_READY):
  415. return SDCA_CTL_TRIGGER_READY_NAME;
  416. case SDCA_CTL_TYPE_S(SMPU, HIST_CURRENTOWNER):
  417. return SDCA_CTL_HIST_CURRENTOWNER_NAME;
  418. case SDCA_CTL_TYPE_S(SMPU, HIST_MESSAGEOFFSET):
  419. return SDCA_CTL_HIST_MESSAGEOFFSET_NAME;
  420. case SDCA_CTL_TYPE_S(SMPU, HIST_MESSAGELENGTH):
  421. return SDCA_CTL_HIST_MESSAGELENGTH_NAME;
  422. case SDCA_CTL_TYPE_S(SMPU, DTODTX_CURRENTOWNER):
  423. return SDCA_CTL_DTODTX_CURRENTOWNER_NAME;
  424. case SDCA_CTL_TYPE_S(SMPU, DTODTX_MESSAGEOFFSET):
  425. return SDCA_CTL_DTODTX_MESSAGEOFFSET_NAME;
  426. case SDCA_CTL_TYPE_S(SMPU, DTODTX_MESSAGELENGTH):
  427. return SDCA_CTL_DTODTX_MESSAGELENGTH_NAME;
  428. case SDCA_CTL_TYPE_S(SMPU, DTODRX_CURRENTOWNER):
  429. return SDCA_CTL_DTODRX_CURRENTOWNER_NAME;
  430. case SDCA_CTL_TYPE_S(SMPU, DTODRX_MESSAGEOFFSET):
  431. return SDCA_CTL_DTODRX_MESSAGEOFFSET_NAME;
  432. case SDCA_CTL_TYPE_S(SMPU, DTODRX_MESSAGELENGTH):
  433. return SDCA_CTL_DTODRX_MESSAGELENGTH_NAME;
  434. case SDCA_CTL_TYPE_S(SAPU, PROTECTION_MODE):
  435. return SDCA_CTL_PROTECTION_MODE_NAME;
  436. case SDCA_CTL_TYPE_S(SAPU, PROTECTION_STATUS):
  437. return SDCA_CTL_PROTECTION_STATUS_NAME;
  438. case SDCA_CTL_TYPE_S(SAPU, OPAQUESETREQ_INDEX):
  439. return SDCA_CTL_OPAQUESETREQ_INDEX_NAME;
  440. case SDCA_CTL_TYPE_S(SAPU, DTODTX_CURRENTOWNER):
  441. return SDCA_CTL_DTODTX_CURRENTOWNER_NAME;
  442. case SDCA_CTL_TYPE_S(SAPU, DTODTX_MESSAGEOFFSET):
  443. return SDCA_CTL_DTODTX_MESSAGEOFFSET_NAME;
  444. case SDCA_CTL_TYPE_S(SAPU, DTODTX_MESSAGELENGTH):
  445. return SDCA_CTL_DTODTX_MESSAGELENGTH_NAME;
  446. case SDCA_CTL_TYPE_S(SAPU, DTODRX_CURRENTOWNER):
  447. return SDCA_CTL_DTODRX_CURRENTOWNER_NAME;
  448. case SDCA_CTL_TYPE_S(SAPU, DTODRX_MESSAGEOFFSET):
  449. return SDCA_CTL_DTODRX_MESSAGEOFFSET_NAME;
  450. case SDCA_CTL_TYPE_S(SAPU, DTODRX_MESSAGELENGTH):
  451. return SDCA_CTL_DTODRX_MESSAGELENGTH_NAME;
  452. case SDCA_CTL_TYPE_S(PPU, POSTURENUMBER):
  453. return SDCA_CTL_POSTURENUMBER_NAME;
  454. case SDCA_CTL_TYPE_S(PPU, POSTUREEXTENSION):
  455. return SDCA_CTL_POSTUREEXTENSION_NAME;
  456. case SDCA_CTL_TYPE_S(PPU, HORIZONTALBALANCE):
  457. return SDCA_CTL_HORIZONTALBALANCE_NAME;
  458. case SDCA_CTL_TYPE_S(PPU, VERTICALBALANCE):
  459. return SDCA_CTL_VERTICALBALANCE_NAME;
  460. case SDCA_CTL_TYPE_S(TG, TONE_DIVIDER):
  461. return SDCA_CTL_TONE_DIVIDER_NAME;
  462. case SDCA_CTL_TYPE_S(HIDE, HIDTX_CURRENTOWNER):
  463. return SDCA_CTL_HIDTX_CURRENTOWNER_NAME;
  464. case SDCA_CTL_TYPE_S(HIDE, HIDTX_MESSAGEOFFSET):
  465. return SDCA_CTL_HIDTX_MESSAGEOFFSET_NAME;
  466. case SDCA_CTL_TYPE_S(HIDE, HIDTX_MESSAGELENGTH):
  467. return SDCA_CTL_HIDTX_MESSAGELENGTH_NAME;
  468. case SDCA_CTL_TYPE_S(HIDE, HIDRX_CURRENTOWNER):
  469. return SDCA_CTL_HIDRX_CURRENTOWNER_NAME;
  470. case SDCA_CTL_TYPE_S(HIDE, HIDRX_MESSAGEOFFSET):
  471. return SDCA_CTL_HIDRX_MESSAGEOFFSET_NAME;
  472. case SDCA_CTL_TYPE_S(HIDE, HIDRX_MESSAGELENGTH):
  473. return SDCA_CTL_HIDRX_MESSAGELENGTH_NAME;
  474. case SDCA_CTL_TYPE_S(ENTITY_0, COMMIT_GROUP_MASK):
  475. return SDCA_CTL_COMMIT_GROUP_MASK_NAME;
  476. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_SDCA_VERSION):
  477. return SDCA_CTL_FUNCTION_SDCA_VERSION_NAME;
  478. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_TYPE):
  479. return SDCA_CTL_FUNCTION_TYPE_NAME;
  480. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_MANUFACTURER_ID):
  481. return SDCA_CTL_FUNCTION_MANUFACTURER_ID_NAME;
  482. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_ID):
  483. return SDCA_CTL_FUNCTION_ID_NAME;
  484. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_VERSION):
  485. return SDCA_CTL_FUNCTION_VERSION_NAME;
  486. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_EXTENSION_ID):
  487. return SDCA_CTL_FUNCTION_EXTENSION_ID_NAME;
  488. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_EXTENSION_VERSION):
  489. return SDCA_CTL_FUNCTION_EXTENSION_VERSION_NAME;
  490. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_STATUS):
  491. return SDCA_CTL_FUNCTION_STATUS_NAME;
  492. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_ACTION):
  493. return SDCA_CTL_FUNCTION_ACTION_NAME;
  494. case SDCA_CTL_TYPE_S(ENTITY_0, DEVICE_MANUFACTURER_ID):
  495. return SDCA_CTL_DEVICE_MANUFACTURER_ID_NAME;
  496. case SDCA_CTL_TYPE_S(ENTITY_0, DEVICE_PART_ID):
  497. return SDCA_CTL_DEVICE_PART_ID_NAME;
  498. case SDCA_CTL_TYPE_S(ENTITY_0, DEVICE_VERSION):
  499. return SDCA_CTL_DEVICE_VERSION_NAME;
  500. case SDCA_CTL_TYPE_S(ENTITY_0, DEVICE_SDCA_VERSION):
  501. return SDCA_CTL_DEVICE_SDCA_VERSION_NAME;
  502. default:
  503. return devm_kasprintf(dev, GFP_KERNEL, "Imp-Def %#x", control->sel);
  504. }
  505. }
  506. static unsigned int find_sdca_control_bits(const struct sdca_entity *entity,
  507. const struct sdca_control *control)
  508. {
  509. switch (SDCA_CTL_TYPE(entity->type, control->sel)) {
  510. case SDCA_CTL_TYPE_S(IT, LATENCY):
  511. case SDCA_CTL_TYPE_S(OT, LATENCY):
  512. case SDCA_CTL_TYPE_S(MU, LATENCY):
  513. case SDCA_CTL_TYPE_S(SU, LATENCY):
  514. case SDCA_CTL_TYPE_S(FU, LATENCY):
  515. case SDCA_CTL_TYPE_S(XU, LATENCY):
  516. case SDCA_CTL_TYPE_S(XU, FDL_MESSAGEOFFSET):
  517. case SDCA_CTL_TYPE_S(XU, FDL_MESSAGELENGTH):
  518. case SDCA_CTL_TYPE_S(SPE, AUTHTX_MESSAGEOFFSET):
  519. case SDCA_CTL_TYPE_S(SPE, AUTHTX_MESSAGELENGTH):
  520. case SDCA_CTL_TYPE_S(SPE, AUTHRX_MESSAGEOFFSET):
  521. case SDCA_CTL_TYPE_S(SPE, AUTHRX_MESSAGELENGTH):
  522. case SDCA_CTL_TYPE_S(CRU, LATENCY):
  523. case SDCA_CTL_TYPE_S(UDMPU, LATENCY):
  524. case SDCA_CTL_TYPE_S(MFPU, LATENCY):
  525. case SDCA_CTL_TYPE_S(MFPU, AE_MESSAGEOFFSET):
  526. case SDCA_CTL_TYPE_S(MFPU, AE_MESSAGELENGTH):
  527. case SDCA_CTL_TYPE_S(SMPU, LATENCY):
  528. case SDCA_CTL_TYPE_S(SMPU, HIST_MESSAGEOFFSET):
  529. case SDCA_CTL_TYPE_S(SMPU, HIST_MESSAGELENGTH):
  530. case SDCA_CTL_TYPE_S(SMPU, DTODTX_MESSAGEOFFSET):
  531. case SDCA_CTL_TYPE_S(SMPU, DTODTX_MESSAGELENGTH):
  532. case SDCA_CTL_TYPE_S(SMPU, DTODRX_MESSAGEOFFSET):
  533. case SDCA_CTL_TYPE_S(SMPU, DTODRX_MESSAGELENGTH):
  534. case SDCA_CTL_TYPE_S(SAPU, LATENCY):
  535. case SDCA_CTL_TYPE_S(SAPU, DTODTX_MESSAGEOFFSET):
  536. case SDCA_CTL_TYPE_S(SAPU, DTODTX_MESSAGELENGTH):
  537. case SDCA_CTL_TYPE_S(SAPU, DTODRX_MESSAGEOFFSET):
  538. case SDCA_CTL_TYPE_S(SAPU, DTODRX_MESSAGELENGTH):
  539. case SDCA_CTL_TYPE_S(PPU, LATENCY):
  540. case SDCA_CTL_TYPE_S(HIDE, HIDTX_MESSAGEOFFSET):
  541. case SDCA_CTL_TYPE_S(HIDE, HIDTX_MESSAGELENGTH):
  542. case SDCA_CTL_TYPE_S(HIDE, HIDRX_MESSAGEOFFSET):
  543. case SDCA_CTL_TYPE_S(HIDE, HIDRX_MESSAGELENGTH):
  544. return 32;
  545. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_MANUFACTURER_ID):
  546. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_ID):
  547. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_EXTENSION_ID):
  548. case SDCA_CTL_TYPE_S(ENTITY_0, DEVICE_MANUFACTURER_ID):
  549. case SDCA_CTL_TYPE_S(ENTITY_0, DEVICE_PART_ID):
  550. case SDCA_CTL_TYPE_S(IT, DATAPORT_SELECTOR):
  551. case SDCA_CTL_TYPE_S(OT, DATAPORT_SELECTOR):
  552. case SDCA_CTL_TYPE_S(MU, MIXER):
  553. case SDCA_CTL_TYPE_S(FU, CHANNEL_VOLUME):
  554. case SDCA_CTL_TYPE_S(FU, GAIN):
  555. case SDCA_CTL_TYPE_S(XU, XU_ID):
  556. case SDCA_CTL_TYPE_S(UDMPU, ACOUSTIC_ENERGY_LEVEL_MONITOR):
  557. case SDCA_CTL_TYPE_S(UDMPU, ULTRASOUND_LOOP_GAIN):
  558. case SDCA_CTL_TYPE_S(MFPU, ULTRASOUND_LEVEL):
  559. case SDCA_CTL_TYPE_S(PPU, HORIZONTALBALANCE):
  560. case SDCA_CTL_TYPE_S(PPU, VERTICALBALANCE):
  561. return 16;
  562. case SDCA_CTL_TYPE_S(FU, MUTE):
  563. case SDCA_CTL_TYPE_S(FU, AGC):
  564. case SDCA_CTL_TYPE_S(FU, BASS_BOOST):
  565. case SDCA_CTL_TYPE_S(FU, LOUDNESS):
  566. case SDCA_CTL_TYPE_S(XU, BYPASS):
  567. case SDCA_CTL_TYPE_S(MFPU, BYPASS):
  568. return 1;
  569. default:
  570. return 8;
  571. }
  572. }
  573. static enum sdca_control_datatype
  574. find_sdca_control_datatype(const struct sdca_entity *entity,
  575. const struct sdca_control *control)
  576. {
  577. switch (SDCA_CTL_TYPE(entity->type, control->sel)) {
  578. case SDCA_CTL_TYPE_S(XU, BYPASS):
  579. case SDCA_CTL_TYPE_S(MFPU, BYPASS):
  580. case SDCA_CTL_TYPE_S(FU, MUTE):
  581. case SDCA_CTL_TYPE_S(FU, AGC):
  582. case SDCA_CTL_TYPE_S(FU, BASS_BOOST):
  583. case SDCA_CTL_TYPE_S(FU, LOUDNESS):
  584. return SDCA_CTL_DATATYPE_ONEBIT;
  585. case SDCA_CTL_TYPE_S(IT, LATENCY):
  586. case SDCA_CTL_TYPE_S(OT, LATENCY):
  587. case SDCA_CTL_TYPE_S(MU, LATENCY):
  588. case SDCA_CTL_TYPE_S(SU, LATENCY):
  589. case SDCA_CTL_TYPE_S(FU, LATENCY):
  590. case SDCA_CTL_TYPE_S(XU, LATENCY):
  591. case SDCA_CTL_TYPE_S(CRU, LATENCY):
  592. case SDCA_CTL_TYPE_S(UDMPU, LATENCY):
  593. case SDCA_CTL_TYPE_S(MFPU, LATENCY):
  594. case SDCA_CTL_TYPE_S(SMPU, LATENCY):
  595. case SDCA_CTL_TYPE_S(SAPU, LATENCY):
  596. case SDCA_CTL_TYPE_S(PPU, LATENCY):
  597. case SDCA_CTL_TYPE_S(SU, SELECTOR):
  598. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_0):
  599. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_1):
  600. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_2):
  601. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_3):
  602. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_4):
  603. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_5):
  604. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_6):
  605. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_7):
  606. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_8):
  607. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_9):
  608. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_10):
  609. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_11):
  610. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_12):
  611. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_13):
  612. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_14):
  613. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_15):
  614. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_16):
  615. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_17):
  616. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_18):
  617. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_19):
  618. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_20):
  619. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_21):
  620. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_22):
  621. case SDCA_CTL_TYPE_S(UDMPU, OPAQUESET_23):
  622. case SDCA_CTL_TYPE_S(SAPU, PROTECTION_MODE):
  623. case SDCA_CTL_TYPE_S(SMPU, HIST_BUFFER_PREAMBLE):
  624. case SDCA_CTL_TYPE_S(XU, FDL_HOST_REQUEST):
  625. case SDCA_CTL_TYPE_S(XU, XU_ID):
  626. case SDCA_CTL_TYPE_S(CX, CLOCK_SELECT):
  627. case SDCA_CTL_TYPE_S(TG, TONE_DIVIDER):
  628. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_MANUFACTURER_ID):
  629. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_ID):
  630. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_EXTENSION_ID):
  631. case SDCA_CTL_TYPE_S(ENTITY_0, DEVICE_MANUFACTURER_ID):
  632. case SDCA_CTL_TYPE_S(ENTITY_0, DEVICE_PART_ID):
  633. case SDCA_CTL_TYPE_S(XU, FDL_MESSAGEOFFSET):
  634. case SDCA_CTL_TYPE_S(XU, FDL_MESSAGELENGTH):
  635. case SDCA_CTL_TYPE_S(SPE, AUTHTX_MESSAGEOFFSET):
  636. case SDCA_CTL_TYPE_S(SPE, AUTHTX_MESSAGELENGTH):
  637. case SDCA_CTL_TYPE_S(SPE, AUTHRX_MESSAGEOFFSET):
  638. case SDCA_CTL_TYPE_S(SPE, AUTHRX_MESSAGELENGTH):
  639. case SDCA_CTL_TYPE_S(MFPU, AE_MESSAGEOFFSET):
  640. case SDCA_CTL_TYPE_S(MFPU, AE_MESSAGELENGTH):
  641. case SDCA_CTL_TYPE_S(SMPU, HIST_MESSAGEOFFSET):
  642. case SDCA_CTL_TYPE_S(SMPU, HIST_MESSAGELENGTH):
  643. case SDCA_CTL_TYPE_S(SMPU, DTODTX_MESSAGEOFFSET):
  644. case SDCA_CTL_TYPE_S(SMPU, DTODTX_MESSAGELENGTH):
  645. case SDCA_CTL_TYPE_S(SMPU, DTODRX_MESSAGEOFFSET):
  646. case SDCA_CTL_TYPE_S(SMPU, DTODRX_MESSAGELENGTH):
  647. case SDCA_CTL_TYPE_S(SAPU, DTODTX_MESSAGEOFFSET):
  648. case SDCA_CTL_TYPE_S(SAPU, DTODTX_MESSAGELENGTH):
  649. case SDCA_CTL_TYPE_S(SAPU, DTODRX_MESSAGEOFFSET):
  650. case SDCA_CTL_TYPE_S(SAPU, DTODRX_MESSAGELENGTH):
  651. case SDCA_CTL_TYPE_S(HIDE, HIDTX_MESSAGEOFFSET):
  652. case SDCA_CTL_TYPE_S(HIDE, HIDTX_MESSAGELENGTH):
  653. case SDCA_CTL_TYPE_S(HIDE, HIDRX_MESSAGEOFFSET):
  654. case SDCA_CTL_TYPE_S(HIDE, HIDRX_MESSAGELENGTH):
  655. return SDCA_CTL_DATATYPE_INTEGER;
  656. case SDCA_CTL_TYPE_S(IT, MIC_BIAS):
  657. case SDCA_CTL_TYPE_S(SMPU, HIST_BUFFER_MODE):
  658. case SDCA_CTL_TYPE_S(PDE, REQUESTED_PS):
  659. case SDCA_CTL_TYPE_S(PDE, ACTUAL_PS):
  660. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_TYPE):
  661. return SDCA_CTL_DATATYPE_SPEC_ENCODED_VALUE;
  662. case SDCA_CTL_TYPE_S(XU, XU_VERSION):
  663. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_SDCA_VERSION):
  664. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_VERSION):
  665. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_EXTENSION_VERSION):
  666. case SDCA_CTL_TYPE_S(ENTITY_0, DEVICE_VERSION):
  667. case SDCA_CTL_TYPE_S(ENTITY_0, DEVICE_SDCA_VERSION):
  668. return SDCA_CTL_DATATYPE_BCD;
  669. case SDCA_CTL_TYPE_S(FU, CHANNEL_VOLUME):
  670. case SDCA_CTL_TYPE_S(FU, GAIN):
  671. case SDCA_CTL_TYPE_S(MU, MIXER):
  672. case SDCA_CTL_TYPE_S(PPU, HORIZONTALBALANCE):
  673. case SDCA_CTL_TYPE_S(PPU, VERTICALBALANCE):
  674. case SDCA_CTL_TYPE_S(MFPU, ULTRASOUND_LEVEL):
  675. case SDCA_CTL_TYPE_S(UDMPU, ACOUSTIC_ENERGY_LEVEL_MONITOR):
  676. case SDCA_CTL_TYPE_S(UDMPU, ULTRASOUND_LOOP_GAIN):
  677. return SDCA_CTL_DATATYPE_Q7P8DB;
  678. case SDCA_CTL_TYPE_S(IT, USAGE):
  679. case SDCA_CTL_TYPE_S(OT, USAGE):
  680. case SDCA_CTL_TYPE_S(IT, CLUSTERINDEX):
  681. case SDCA_CTL_TYPE_S(CRU, CLUSTERINDEX):
  682. case SDCA_CTL_TYPE_S(UDMPU, CLUSTERINDEX):
  683. case SDCA_CTL_TYPE_S(MFPU, CLUSTERINDEX):
  684. case SDCA_CTL_TYPE_S(MFPU, CENTER_FREQUENCY_INDEX):
  685. case SDCA_CTL_TYPE_S(MFPU, AE_NUMBER):
  686. case SDCA_CTL_TYPE_S(SAPU, OPAQUESETREQ_INDEX):
  687. case SDCA_CTL_TYPE_S(XU, FDL_SET_INDEX):
  688. case SDCA_CTL_TYPE_S(CS, SAMPLERATEINDEX):
  689. case SDCA_CTL_TYPE_S(GE, SELECTED_MODE):
  690. case SDCA_CTL_TYPE_S(GE, DETECTED_MODE):
  691. return SDCA_CTL_DATATYPE_BYTEINDEX;
  692. case SDCA_CTL_TYPE_S(PPU, POSTURENUMBER):
  693. return SDCA_CTL_DATATYPE_POSTURENUMBER;
  694. case SDCA_CTL_TYPE_S(IT, DATAPORT_SELECTOR):
  695. case SDCA_CTL_TYPE_S(OT, DATAPORT_SELECTOR):
  696. return SDCA_CTL_DATATYPE_DP_INDEX;
  697. case SDCA_CTL_TYPE_S(MFPU, ALGORITHM_READY):
  698. case SDCA_CTL_TYPE_S(MFPU, ALGORITHM_ENABLE):
  699. case SDCA_CTL_TYPE_S(MFPU, ALGORITHM_PREPARE):
  700. case SDCA_CTL_TYPE_S(SAPU, PROTECTION_STATUS):
  701. case SDCA_CTL_TYPE_S(SMPU, TRIGGER_ENABLE):
  702. case SDCA_CTL_TYPE_S(SMPU, TRIGGER_STATUS):
  703. case SDCA_CTL_TYPE_S(SMPU, TRIGGER_READY):
  704. case SDCA_CTL_TYPE_S(SPE, PRIVACY_POLICY):
  705. case SDCA_CTL_TYPE_S(SPE, PRIVACY_OWNER):
  706. return SDCA_CTL_DATATYPE_BITINDEX;
  707. case SDCA_CTL_TYPE_S(IT, KEEP_ALIVE):
  708. case SDCA_CTL_TYPE_S(OT, KEEP_ALIVE):
  709. case SDCA_CTL_TYPE_S(IT, NDAI_STREAM):
  710. case SDCA_CTL_TYPE_S(OT, NDAI_STREAM):
  711. case SDCA_CTL_TYPE_S(IT, NDAI_CATEGORY):
  712. case SDCA_CTL_TYPE_S(OT, NDAI_CATEGORY):
  713. case SDCA_CTL_TYPE_S(IT, NDAI_CODINGTYPE):
  714. case SDCA_CTL_TYPE_S(OT, NDAI_CODINGTYPE):
  715. case SDCA_CTL_TYPE_S(IT, NDAI_PACKETTYPE):
  716. case SDCA_CTL_TYPE_S(OT, NDAI_PACKETTYPE):
  717. case SDCA_CTL_TYPE_S(SMPU, HIST_ERROR):
  718. case SDCA_CTL_TYPE_S(XU, FDL_STATUS):
  719. case SDCA_CTL_TYPE_S(CS, CLOCK_VALID):
  720. case SDCA_CTL_TYPE_S(SPE, PRIVACY_LOCKSTATE):
  721. case SDCA_CTL_TYPE_S(ENTITY_0, COMMIT_GROUP_MASK):
  722. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_STATUS):
  723. case SDCA_CTL_TYPE_S(ENTITY_0, FUNCTION_ACTION):
  724. case SDCA_CTL_TYPE_S(XU, FDL_CURRENTOWNER):
  725. case SDCA_CTL_TYPE_S(SPE, AUTHTX_CURRENTOWNER):
  726. case SDCA_CTL_TYPE_S(SPE, AUTHRX_CURRENTOWNER):
  727. case SDCA_CTL_TYPE_S(MFPU, AE_CURRENTOWNER):
  728. case SDCA_CTL_TYPE_S(SMPU, HIST_CURRENTOWNER):
  729. case SDCA_CTL_TYPE_S(SMPU, DTODTX_CURRENTOWNER):
  730. case SDCA_CTL_TYPE_S(SMPU, DTODRX_CURRENTOWNER):
  731. case SDCA_CTL_TYPE_S(SAPU, DTODTX_CURRENTOWNER):
  732. case SDCA_CTL_TYPE_S(SAPU, DTODRX_CURRENTOWNER):
  733. case SDCA_CTL_TYPE_S(HIDE, HIDTX_CURRENTOWNER):
  734. case SDCA_CTL_TYPE_S(HIDE, HIDRX_CURRENTOWNER):
  735. return SDCA_CTL_DATATYPE_BITMAP;
  736. case SDCA_CTL_TYPE_S(IT, MATCHING_GUID):
  737. case SDCA_CTL_TYPE_S(OT, MATCHING_GUID):
  738. case SDCA_CTL_TYPE_S(ENTITY_0, MATCHING_GUID):
  739. return SDCA_CTL_DATATYPE_GUID;
  740. default:
  741. return SDCA_CTL_DATATYPE_IMPDEF;
  742. }
  743. }
  744. static bool find_sdca_control_volatile(const struct sdca_entity *entity,
  745. const struct sdca_control *control)
  746. {
  747. switch (control->mode) {
  748. case SDCA_ACCESS_MODE_DC:
  749. return false;
  750. case SDCA_ACCESS_MODE_RO:
  751. case SDCA_ACCESS_MODE_RW1S:
  752. case SDCA_ACCESS_MODE_RW1C:
  753. return true;
  754. default:
  755. break;
  756. }
  757. switch (SDCA_CTL_TYPE(entity->type, control->sel)) {
  758. case SDCA_CTL_TYPE_S(XU, FDL_CURRENTOWNER):
  759. case SDCA_CTL_TYPE_S(XU, FDL_MESSAGEOFFSET):
  760. case SDCA_CTL_TYPE_S(XU, FDL_MESSAGELENGTH):
  761. case SDCA_CTL_TYPE_S(XU, FDL_STATUS):
  762. case SDCA_CTL_TYPE_S(XU, FDL_HOST_REQUEST):
  763. case SDCA_CTL_TYPE_S(SPE, AUTHTX_CURRENTOWNER):
  764. case SDCA_CTL_TYPE_S(SPE, AUTHTX_MESSAGEOFFSET):
  765. case SDCA_CTL_TYPE_S(SPE, AUTHTX_MESSAGELENGTH):
  766. case SDCA_CTL_TYPE_S(SPE, AUTHRX_CURRENTOWNER):
  767. case SDCA_CTL_TYPE_S(SPE, AUTHRX_MESSAGEOFFSET):
  768. case SDCA_CTL_TYPE_S(SPE, AUTHRX_MESSAGELENGTH):
  769. case SDCA_CTL_TYPE_S(MFPU, AE_CURRENTOWNER):
  770. case SDCA_CTL_TYPE_S(MFPU, AE_MESSAGEOFFSET):
  771. case SDCA_CTL_TYPE_S(MFPU, AE_MESSAGELENGTH):
  772. case SDCA_CTL_TYPE_S(SMPU, HIST_CURRENTOWNER):
  773. case SDCA_CTL_TYPE_S(SMPU, HIST_MESSAGEOFFSET):
  774. case SDCA_CTL_TYPE_S(SMPU, HIST_MESSAGELENGTH):
  775. case SDCA_CTL_TYPE_S(SMPU, DTODTX_CURRENTOWNER):
  776. case SDCA_CTL_TYPE_S(SMPU, DTODTX_MESSAGEOFFSET):
  777. case SDCA_CTL_TYPE_S(SMPU, DTODTX_MESSAGELENGTH):
  778. case SDCA_CTL_TYPE_S(SMPU, DTODRX_CURRENTOWNER):
  779. case SDCA_CTL_TYPE_S(SMPU, DTODRX_MESSAGEOFFSET):
  780. case SDCA_CTL_TYPE_S(SMPU, DTODRX_MESSAGELENGTH):
  781. case SDCA_CTL_TYPE_S(SAPU, DTODTX_CURRENTOWNER):
  782. case SDCA_CTL_TYPE_S(SAPU, DTODTX_MESSAGEOFFSET):
  783. case SDCA_CTL_TYPE_S(SAPU, DTODTX_MESSAGELENGTH):
  784. case SDCA_CTL_TYPE_S(SAPU, DTODRX_CURRENTOWNER):
  785. case SDCA_CTL_TYPE_S(SAPU, DTODRX_MESSAGEOFFSET):
  786. case SDCA_CTL_TYPE_S(SAPU, DTODRX_MESSAGELENGTH):
  787. case SDCA_CTL_TYPE_S(HIDE, HIDTX_CURRENTOWNER):
  788. case SDCA_CTL_TYPE_S(HIDE, HIDTX_MESSAGEOFFSET):
  789. case SDCA_CTL_TYPE_S(HIDE, HIDTX_MESSAGELENGTH):
  790. case SDCA_CTL_TYPE_S(HIDE, HIDRX_CURRENTOWNER):
  791. case SDCA_CTL_TYPE_S(HIDE, HIDRX_MESSAGEOFFSET):
  792. case SDCA_CTL_TYPE_S(HIDE, HIDRX_MESSAGELENGTH):
  793. return true;
  794. default:
  795. return false;
  796. }
  797. }
  798. static int find_sdca_control_range(struct device *dev,
  799. struct fwnode_handle *control_node,
  800. struct sdca_control_range *range)
  801. {
  802. u8 *range_list;
  803. int num_range;
  804. u16 *limits;
  805. int i;
  806. num_range = fwnode_property_count_u8(control_node, "mipi-sdca-control-range");
  807. if (!num_range || num_range == -EINVAL)
  808. return 0;
  809. else if (num_range < 0)
  810. return num_range;
  811. range_list = devm_kcalloc(dev, num_range, sizeof(*range_list), GFP_KERNEL);
  812. if (!range_list)
  813. return -ENOMEM;
  814. fwnode_property_read_u8_array(control_node, "mipi-sdca-control-range",
  815. range_list, num_range);
  816. limits = (u16 *)range_list;
  817. range->cols = le16_to_cpu(limits[0]);
  818. range->rows = le16_to_cpu(limits[1]);
  819. range->data = (u32 *)&limits[2];
  820. num_range = (num_range - (2 * sizeof(*limits))) / sizeof(*range->data);
  821. if (num_range != range->cols * range->rows)
  822. return -EINVAL;
  823. for (i = 0; i < num_range; i++)
  824. range->data[i] = le32_to_cpu(range->data[i]);
  825. return 0;
  826. }
  827. static int find_sdca_control_value(struct device *dev, struct sdca_entity *entity,
  828. struct fwnode_handle *control_node,
  829. struct sdca_control *control,
  830. const char * const label)
  831. {
  832. char property[SDCA_PROPERTY_LENGTH];
  833. bool global = true;
  834. int ret, cn, i;
  835. u32 tmp;
  836. snprintf(property, sizeof(property), "mipi-sdca-control-%s", label);
  837. ret = fwnode_property_read_u32(control_node, property, &tmp);
  838. if (ret == -EINVAL)
  839. global = false;
  840. else if (ret)
  841. return ret;
  842. i = 0;
  843. for_each_set_bit(cn, (unsigned long *)&control->cn_list,
  844. BITS_PER_TYPE(control->cn_list)) {
  845. if (!global) {
  846. snprintf(property, sizeof(property),
  847. "mipi-sdca-control-cn-%d-%s", cn, label);
  848. ret = fwnode_property_read_u32(control_node, property, &tmp);
  849. if (ret)
  850. return ret;
  851. }
  852. control->values[i] = tmp;
  853. i++;
  854. }
  855. return 0;
  856. }
  857. static int find_sdca_control_reset(const struct sdca_entity *entity,
  858. struct sdca_control *control)
  859. {
  860. switch (SDCA_CTL_TYPE(entity->type, control->sel)) {
  861. case SDCA_CTL_TYPE_S(FU, AGC):
  862. case SDCA_CTL_TYPE_S(FU, BASS_BOOST):
  863. case SDCA_CTL_TYPE_S(FU, LOUDNESS):
  864. case SDCA_CTL_TYPE_S(SMPU, TRIGGER_ENABLE):
  865. case SDCA_CTL_TYPE_S(GE, SELECTED_MODE):
  866. case SDCA_CTL_TYPE_S(TG, TONE_DIVIDER):
  867. case SDCA_CTL_TYPE_S(ENTITY_0, COMMIT_GROUP_MASK):
  868. control->has_reset = true;
  869. control->reset = 0;
  870. break;
  871. case SDCA_CTL_TYPE_S(XU, BYPASS):
  872. case SDCA_CTL_TYPE_S(MFPU, BYPASS):
  873. case SDCA_CTL_TYPE_S(FU, MUTE):
  874. case SDCA_CTL_TYPE_S(CX, CLOCK_SELECT):
  875. control->has_reset = true;
  876. control->reset = 1;
  877. break;
  878. case SDCA_CTL_TYPE_S(PDE, REQUESTED_PS):
  879. control->has_reset = true;
  880. control->reset = 3;
  881. break;
  882. default:
  883. break;
  884. }
  885. return 0;
  886. }
  887. static int find_sdca_entity_control(struct device *dev, struct sdca_entity *entity,
  888. struct fwnode_handle *control_node,
  889. struct sdca_control *control)
  890. {
  891. u32 tmp;
  892. int ret;
  893. ret = fwnode_property_read_u32(control_node, "mipi-sdca-control-access-mode", &tmp);
  894. if (ret) {
  895. dev_err(dev, "%s: control %#x: access mode missing: %d\n",
  896. entity->label, control->sel, ret);
  897. return ret;
  898. }
  899. control->mode = tmp;
  900. ret = fwnode_property_read_u32(control_node, "mipi-sdca-control-access-layer", &tmp);
  901. if (ret) {
  902. dev_err(dev, "%s: control %#x: access layer missing: %d\n",
  903. entity->label, control->sel, ret);
  904. return ret;
  905. }
  906. control->layers = tmp;
  907. ret = fwnode_property_read_u64(control_node, "mipi-sdca-control-cn-list",
  908. &control->cn_list);
  909. if (ret == -EINVAL) {
  910. /* Spec allows not specifying cn-list if only the first number is used */
  911. control->cn_list = 0x1;
  912. } else if (ret || !control->cn_list) {
  913. dev_err(dev, "%s: control %#x: cn list missing: %d\n",
  914. entity->label, control->sel, ret);
  915. return ret;
  916. }
  917. control->values = devm_kcalloc(dev, hweight64(control->cn_list),
  918. sizeof(*control->values), GFP_KERNEL);
  919. if (!control->values)
  920. return -ENOMEM;
  921. switch (control->mode) {
  922. case SDCA_ACCESS_MODE_DC:
  923. ret = find_sdca_control_value(dev, entity, control_node, control,
  924. "dc-value");
  925. if (ret) {
  926. dev_err(dev, "%s: control %#x: dc value missing: %d\n",
  927. entity->label, control->sel, ret);
  928. return ret;
  929. }
  930. control->has_fixed = true;
  931. break;
  932. case SDCA_ACCESS_MODE_RW:
  933. case SDCA_ACCESS_MODE_DUAL:
  934. ret = find_sdca_control_value(dev, entity, control_node, control,
  935. "default-value");
  936. if (!ret)
  937. control->has_default = true;
  938. ret = find_sdca_control_value(dev, entity, control_node, control,
  939. "fixed-value");
  940. if (!ret)
  941. control->has_fixed = true;
  942. fallthrough;
  943. case SDCA_ACCESS_MODE_RO:
  944. control->deferrable = fwnode_property_read_bool(control_node,
  945. "mipi-sdca-control-deferrable");
  946. break;
  947. default:
  948. break;
  949. }
  950. control->is_volatile = find_sdca_control_volatile(entity, control);
  951. ret = find_sdca_control_reset(entity, control);
  952. if (ret)
  953. return ret;
  954. ret = find_sdca_control_range(dev, control_node, &control->range);
  955. if (ret) {
  956. dev_err(dev, "%s: control %#x: range missing: %d\n",
  957. entity->label, control->sel, ret);
  958. return ret;
  959. }
  960. ret = fwnode_property_read_u32(control_node,
  961. "mipi-sdca-control-interrupt-position",
  962. &tmp);
  963. if (!ret)
  964. control->interrupt_position = tmp;
  965. else
  966. control->interrupt_position = SDCA_NO_INTERRUPT;
  967. control->label = find_sdca_control_label(dev, entity, control);
  968. if (!control->label)
  969. return -ENOMEM;
  970. control->type = find_sdca_control_datatype(entity, control);
  971. control->nbits = find_sdca_control_bits(entity, control);
  972. dev_dbg(dev, "%s: %s: control %#x mode %#x layers %#x cn %#llx int %d %s\n",
  973. entity->label, control->label, control->sel,
  974. control->mode, control->layers, control->cn_list,
  975. control->interrupt_position, control->deferrable ? "deferrable" : "");
  976. return 0;
  977. }
  978. static int find_sdca_entity_controls(struct device *dev,
  979. struct fwnode_handle *entity_node,
  980. struct sdca_entity *entity)
  981. {
  982. struct sdca_control *controls;
  983. int num_controls;
  984. u64 control_list;
  985. int control_sel;
  986. int i, ret;
  987. ret = fwnode_property_read_u64(entity_node, "mipi-sdca-control-list", &control_list);
  988. if (ret == -EINVAL) {
  989. /* Allow missing control lists, assume no controls. */
  990. dev_warn(dev, "%s: missing control list\n", entity->label);
  991. return 0;
  992. } else if (ret) {
  993. dev_err(dev, "%s: failed to read control list: %d\n", entity->label, ret);
  994. return ret;
  995. } else if (!control_list) {
  996. return 0;
  997. }
  998. num_controls = hweight64(control_list);
  999. controls = devm_kcalloc(dev, num_controls, sizeof(*controls), GFP_KERNEL);
  1000. if (!controls)
  1001. return -ENOMEM;
  1002. i = 0;
  1003. for_each_set_bit(control_sel, (unsigned long *)&control_list,
  1004. BITS_PER_TYPE(control_list)) {
  1005. struct fwnode_handle *control_node;
  1006. char control_property[SDCA_PROPERTY_LENGTH];
  1007. /* DisCo uses upper-case for hex numbers */
  1008. snprintf(control_property, sizeof(control_property),
  1009. "mipi-sdca-control-0x%X-subproperties", control_sel);
  1010. control_node = fwnode_get_named_child_node(entity_node, control_property);
  1011. if (!control_node) {
  1012. dev_err(dev, "%s: control node %s not found\n",
  1013. entity->label, control_property);
  1014. return -EINVAL;
  1015. }
  1016. controls[i].sel = control_sel;
  1017. ret = find_sdca_entity_control(dev, entity, control_node, &controls[i]);
  1018. fwnode_handle_put(control_node);
  1019. if (ret)
  1020. return ret;
  1021. i++;
  1022. }
  1023. entity->num_controls = num_controls;
  1024. entity->controls = controls;
  1025. return 0;
  1026. }
  1027. static bool find_sdca_iot_dataport(struct sdca_entity_iot *terminal)
  1028. {
  1029. switch (terminal->type) {
  1030. case SDCA_TERM_TYPE_GENERIC:
  1031. case SDCA_TERM_TYPE_ULTRASOUND:
  1032. case SDCA_TERM_TYPE_CAPTURE_DIRECT_PCM_MIC:
  1033. case SDCA_TERM_TYPE_RAW_PDM_MIC:
  1034. case SDCA_TERM_TYPE_SPEECH:
  1035. case SDCA_TERM_TYPE_VOICE:
  1036. case SDCA_TERM_TYPE_SECONDARY_PCM_MIC:
  1037. case SDCA_TERM_TYPE_ACOUSTIC_CONTEXT_AWARENESS:
  1038. case SDCA_TERM_TYPE_DTOD_STREAM:
  1039. case SDCA_TERM_TYPE_REFERENCE_STREAM:
  1040. case SDCA_TERM_TYPE_SENSE_CAPTURE:
  1041. case SDCA_TERM_TYPE_STREAMING_MIC:
  1042. case SDCA_TERM_TYPE_OPTIMIZATION_STREAM:
  1043. case SDCA_TERM_TYPE_PDM_RENDER_STREAM:
  1044. case SDCA_TERM_TYPE_COMPANION_DATA:
  1045. return true;
  1046. default:
  1047. return false;
  1048. }
  1049. }
  1050. static int find_sdca_entity_iot(struct device *dev,
  1051. struct fwnode_handle *entity_node,
  1052. struct sdca_entity *entity)
  1053. {
  1054. struct sdca_entity_iot *terminal = &entity->iot;
  1055. u32 tmp;
  1056. int ret;
  1057. ret = fwnode_property_read_u32(entity_node, "mipi-sdca-terminal-type", &tmp);
  1058. if (ret) {
  1059. dev_err(dev, "%s: terminal type missing: %d\n", entity->label, ret);
  1060. return ret;
  1061. }
  1062. terminal->type = tmp;
  1063. terminal->is_dataport = find_sdca_iot_dataport(terminal);
  1064. if (!terminal->is_dataport) {
  1065. const char *type_name = sdca_find_terminal_name(terminal->type);
  1066. if (type_name) {
  1067. entity->label = devm_kasprintf(dev, GFP_KERNEL, "%s %s",
  1068. entity->label, type_name);
  1069. if (!entity->label)
  1070. return -ENOMEM;
  1071. }
  1072. }
  1073. ret = fwnode_property_read_u32(entity_node,
  1074. "mipi-sdca-terminal-reference-number", &tmp);
  1075. if (!ret)
  1076. terminal->reference = tmp;
  1077. ret = fwnode_property_read_u32(entity_node,
  1078. "mipi-sdca-terminal-connector-type", &tmp);
  1079. if (!ret)
  1080. terminal->connector = tmp;
  1081. ret = fwnode_property_read_u32(entity_node,
  1082. "mipi-sdca-terminal-transducer-count", &tmp);
  1083. if (!ret)
  1084. terminal->num_transducer = tmp;
  1085. dev_dbg(dev, "%s: terminal type %#x ref %#x conn %#x count %d\n",
  1086. entity->label, terminal->type, terminal->reference,
  1087. terminal->connector, terminal->num_transducer);
  1088. return 0;
  1089. }
  1090. static int find_sdca_entity_cs(struct device *dev,
  1091. struct fwnode_handle *entity_node,
  1092. struct sdca_entity *entity)
  1093. {
  1094. struct sdca_entity_cs *clock = &entity->cs;
  1095. u32 tmp;
  1096. int ret;
  1097. ret = fwnode_property_read_u32(entity_node, "mipi-sdca-cs-type", &tmp);
  1098. if (ret) {
  1099. dev_err(dev, "%s: clock type missing: %d\n", entity->label, ret);
  1100. return ret;
  1101. }
  1102. clock->type = tmp;
  1103. ret = fwnode_property_read_u32(entity_node,
  1104. "mipi-sdca-clock-valid-max-delay", &tmp);
  1105. if (!ret)
  1106. clock->max_delay = tmp;
  1107. dev_dbg(dev, "%s: clock type %#x delay %d\n", entity->label,
  1108. clock->type, clock->max_delay);
  1109. return 0;
  1110. }
  1111. static int find_sdca_entity_pde(struct device *dev,
  1112. struct fwnode_handle *entity_node,
  1113. struct sdca_entity *entity)
  1114. {
  1115. static const int mult_delay = 3;
  1116. struct sdca_entity_pde *power = &entity->pde;
  1117. struct sdca_pde_delay *delays;
  1118. int num_delays;
  1119. int i, j;
  1120. num_delays = fwnode_property_count_u32(entity_node,
  1121. "mipi-sdca-powerdomain-transition-max-delay");
  1122. if (num_delays <= 0) {
  1123. dev_err(dev, "%s: max delay list missing: %d\n",
  1124. entity->label, num_delays);
  1125. return -EINVAL;
  1126. } else if (num_delays % mult_delay != 0) {
  1127. dev_err(dev, "%s: delays not multiple of %d\n",
  1128. entity->label, mult_delay);
  1129. return -EINVAL;
  1130. } else if (num_delays > SDCA_MAX_DELAY_COUNT) {
  1131. dev_err(dev, "%s: maximum number of transition delays exceeded\n",
  1132. entity->label);
  1133. return -EINVAL;
  1134. }
  1135. u32 *delay_list __free(kfree) = kcalloc(num_delays, sizeof(*delay_list),
  1136. GFP_KERNEL);
  1137. if (!delay_list)
  1138. return -ENOMEM;
  1139. fwnode_property_read_u32_array(entity_node,
  1140. "mipi-sdca-powerdomain-transition-max-delay",
  1141. delay_list, num_delays);
  1142. num_delays /= mult_delay;
  1143. delays = devm_kcalloc(dev, num_delays, sizeof(*delays), GFP_KERNEL);
  1144. if (!delays)
  1145. return -ENOMEM;
  1146. for (i = 0, j = 0; i < num_delays; i++) {
  1147. delays[i].from_ps = delay_list[j++];
  1148. delays[i].to_ps = delay_list[j++];
  1149. delays[i].us = delay_list[j++];
  1150. dev_dbg(dev, "%s: from %#x to %#x delay %dus\n", entity->label,
  1151. delays[i].from_ps, delays[i].to_ps, delays[i].us);
  1152. }
  1153. power->num_max_delay = num_delays;
  1154. power->max_delay = delays;
  1155. return 0;
  1156. }
  1157. struct raw_ge_mode {
  1158. u8 val;
  1159. u8 num_controls;
  1160. struct {
  1161. u8 id;
  1162. u8 sel;
  1163. u8 cn;
  1164. __le32 val;
  1165. } __packed controls[] __counted_by(num_controls);
  1166. } __packed;
  1167. static int find_sdca_entity_ge(struct device *dev,
  1168. struct fwnode_handle *entity_node,
  1169. struct sdca_entity *entity)
  1170. {
  1171. struct sdca_entity_ge *group = &entity->ge;
  1172. u8 *affected_iter;
  1173. int num_affected;
  1174. int i, j;
  1175. num_affected = fwnode_property_count_u8(entity_node,
  1176. "mipi-sdca-ge-selectedmode-controls-affected");
  1177. if (!num_affected) {
  1178. return 0;
  1179. } else if (num_affected < 0) {
  1180. dev_err(dev, "%s: failed to read affected controls: %d\n",
  1181. entity->label, num_affected);
  1182. return num_affected;
  1183. } else if (num_affected > SDCA_MAX_AFFECTED_COUNT) {
  1184. dev_err(dev, "%s: maximum affected controls size exceeded\n",
  1185. entity->label);
  1186. return -EINVAL;
  1187. }
  1188. u8 *affected_list __free(kfree) = kcalloc(num_affected, sizeof(*affected_list),
  1189. GFP_KERNEL);
  1190. if (!affected_list)
  1191. return -ENOMEM;
  1192. fwnode_property_read_u8_array(entity_node,
  1193. "mipi-sdca-ge-selectedmode-controls-affected",
  1194. affected_list, num_affected);
  1195. group->num_modes = *affected_list;
  1196. affected_iter = affected_list + 1;
  1197. group->modes = devm_kcalloc(dev, group->num_modes, sizeof(*group->modes),
  1198. GFP_KERNEL);
  1199. if (!group->modes)
  1200. return -ENOMEM;
  1201. for (i = 0; i < group->num_modes; i++) {
  1202. struct raw_ge_mode *raw = (struct raw_ge_mode *)affected_iter;
  1203. struct sdca_ge_mode *mode = &group->modes[i];
  1204. affected_iter += sizeof(*raw);
  1205. if (affected_iter > affected_list + num_affected)
  1206. goto bad_list;
  1207. mode->val = raw->val;
  1208. mode->num_controls = raw->num_controls;
  1209. affected_iter += mode->num_controls * sizeof(raw->controls[0]);
  1210. if (affected_iter > affected_list + num_affected)
  1211. goto bad_list;
  1212. mode->controls = devm_kcalloc(dev, mode->num_controls,
  1213. sizeof(*mode->controls), GFP_KERNEL);
  1214. if (!mode->controls)
  1215. return -ENOMEM;
  1216. for (j = 0; j < mode->num_controls; j++) {
  1217. mode->controls[j].id = raw->controls[j].id;
  1218. mode->controls[j].sel = raw->controls[j].sel;
  1219. mode->controls[j].cn = raw->controls[j].cn;
  1220. mode->controls[j].val = le32_to_cpu(raw->controls[j].val);
  1221. }
  1222. }
  1223. return 0;
  1224. bad_list:
  1225. dev_err(dev, "%s: malformed affected controls list\n", entity->label);
  1226. return -EINVAL;
  1227. }
  1228. static int
  1229. find_sdca_entity_hide(struct device *dev, struct sdw_slave *sdw,
  1230. struct fwnode_handle *function_node,
  1231. struct fwnode_handle *entity_node, struct sdca_entity *entity)
  1232. {
  1233. struct sdca_entity_hide *hide = &entity->hide;
  1234. unsigned int delay, *af_list = hide->af_number_list;
  1235. int nval, ret;
  1236. unsigned char *report_desc = NULL;
  1237. ret = fwnode_property_read_u32(entity_node,
  1238. "mipi-sdca-RxUMP-ownership-transition-max-delay", &delay);
  1239. if (!ret)
  1240. hide->max_delay = delay;
  1241. nval = fwnode_property_count_u32(entity_node, "mipi-sdca-HIDTx-supported-report-ids");
  1242. if (nval > 0) {
  1243. hide->num_hidtx_ids = nval;
  1244. hide->hidtx_ids = devm_kcalloc(dev, hide->num_hidtx_ids,
  1245. sizeof(*hide->hidtx_ids), GFP_KERNEL);
  1246. if (!hide->hidtx_ids)
  1247. return -ENOMEM;
  1248. ret = fwnode_property_read_u32_array(entity_node,
  1249. "mipi-sdca-HIDTx-supported-report-ids",
  1250. hide->hidtx_ids,
  1251. hide->num_hidtx_ids);
  1252. if (ret < 0)
  1253. return ret;
  1254. }
  1255. nval = fwnode_property_count_u32(entity_node, "mipi-sdca-HIDRx-supported-report-ids");
  1256. if (nval > 0) {
  1257. hide->num_hidrx_ids = nval;
  1258. hide->hidrx_ids = devm_kcalloc(dev, hide->num_hidrx_ids,
  1259. sizeof(*hide->hidrx_ids), GFP_KERNEL);
  1260. if (!hide->hidrx_ids)
  1261. return -ENOMEM;
  1262. ret = fwnode_property_read_u32_array(entity_node,
  1263. "mipi-sdca-HIDRx-supported-report-ids",
  1264. hide->hidrx_ids,
  1265. hide->num_hidrx_ids);
  1266. if (ret < 0)
  1267. return ret;
  1268. }
  1269. nval = fwnode_property_count_u32(entity_node, "mipi-sdca-hide-related-audio-function-list");
  1270. if (nval <= 0) {
  1271. dev_err(dev, "%pfwP: audio function numbers list missing: %d\n",
  1272. entity_node, nval);
  1273. return -EINVAL;
  1274. } else if (nval > SDCA_MAX_FUNCTION_COUNT) {
  1275. dev_err(dev, "%pfwP: maximum number of audio function exceeded\n", entity_node);
  1276. return -EINVAL;
  1277. }
  1278. hide->hide_reside_function_num = nval;
  1279. fwnode_property_read_u32_array(entity_node,
  1280. "mipi-sdca-hide-related-audio-function-list", af_list, nval);
  1281. nval = fwnode_property_count_u8(function_node, "mipi-sdca-hid-descriptor");
  1282. if (nval)
  1283. fwnode_property_read_u8_array(function_node, "mipi-sdca-hid-descriptor",
  1284. (u8 *)&hide->hid_desc, nval);
  1285. if (hide->hid_desc.bNumDescriptors) {
  1286. nval = fwnode_property_count_u8(function_node, "mipi-sdca-report-descriptor");
  1287. if (nval) {
  1288. report_desc = devm_kzalloc(dev, nval, GFP_KERNEL);
  1289. if (!report_desc)
  1290. return -ENOMEM;
  1291. hide->hid_report_desc = report_desc;
  1292. fwnode_property_read_u8_array(function_node, "mipi-sdca-report-descriptor",
  1293. report_desc, nval);
  1294. /* add HID device */
  1295. ret = sdca_add_hid_device(dev, sdw, entity);
  1296. if (ret) {
  1297. dev_err(dev, "%pfwP: failed to add HID device: %d\n", entity_node, ret);
  1298. return ret;
  1299. }
  1300. }
  1301. }
  1302. return 0;
  1303. }
  1304. static int find_sdca_entity_xu(struct device *dev,
  1305. struct fwnode_handle *entity_node,
  1306. struct sdca_entity *entity)
  1307. {
  1308. struct sdca_entity_xu *xu = &entity->xu;
  1309. u32 tmp;
  1310. int ret;
  1311. ret = fwnode_property_read_u32(entity_node,
  1312. "mipi-sdca-RxUMP-ownership-transition-max-delay",
  1313. &tmp);
  1314. if (!ret)
  1315. xu->max_delay = tmp;
  1316. ret = fwnode_property_read_u32(entity_node, "mipi-sdca-FDL-reset-mechanism",
  1317. &tmp);
  1318. if (!ret)
  1319. xu->reset_mechanism = tmp;
  1320. return 0;
  1321. }
  1322. static int find_sdca_entity(struct device *dev, struct sdw_slave *sdw,
  1323. struct fwnode_handle *function_node,
  1324. struct fwnode_handle *entity_node,
  1325. struct sdca_entity *entity)
  1326. {
  1327. u32 tmp;
  1328. int ret;
  1329. ret = fwnode_property_read_string(entity_node, "mipi-sdca-entity-label",
  1330. &entity->label);
  1331. if (ret) {
  1332. dev_err(dev, "%pfwP: entity %#x: label missing: %d\n",
  1333. function_node, entity->id, ret);
  1334. return ret;
  1335. }
  1336. ret = fwnode_property_read_u32(entity_node, "mipi-sdca-entity-type", &tmp);
  1337. if (ret) {
  1338. dev_err(dev, "%s: type missing: %d\n", entity->label, ret);
  1339. return ret;
  1340. }
  1341. entity->type = tmp;
  1342. dev_dbg(dev, "%s: entity %#x type %#x\n",
  1343. entity->label, entity->id, entity->type);
  1344. switch (entity->type) {
  1345. case SDCA_ENTITY_TYPE_IT:
  1346. case SDCA_ENTITY_TYPE_OT:
  1347. ret = find_sdca_entity_iot(dev, entity_node, entity);
  1348. break;
  1349. case SDCA_ENTITY_TYPE_XU:
  1350. ret = find_sdca_entity_xu(dev, entity_node, entity);
  1351. break;
  1352. case SDCA_ENTITY_TYPE_CS:
  1353. ret = find_sdca_entity_cs(dev, entity_node, entity);
  1354. break;
  1355. case SDCA_ENTITY_TYPE_PDE:
  1356. ret = find_sdca_entity_pde(dev, entity_node, entity);
  1357. break;
  1358. case SDCA_ENTITY_TYPE_GE:
  1359. ret = find_sdca_entity_ge(dev, entity_node, entity);
  1360. break;
  1361. case SDCA_ENTITY_TYPE_HIDE:
  1362. ret = find_sdca_entity_hide(dev, sdw, function_node,
  1363. entity_node, entity);
  1364. break;
  1365. default:
  1366. break;
  1367. }
  1368. if (ret)
  1369. return ret;
  1370. ret = find_sdca_entity_controls(dev, entity_node, entity);
  1371. if (ret)
  1372. return ret;
  1373. return 0;
  1374. }
  1375. static int find_sdca_entities(struct device *dev, struct sdw_slave *sdw,
  1376. struct fwnode_handle *function_node,
  1377. struct sdca_function_data *function)
  1378. {
  1379. struct sdca_entity *entities;
  1380. int num_entities;
  1381. int i, ret;
  1382. num_entities = fwnode_property_count_u32(function_node,
  1383. "mipi-sdca-entity-id-list");
  1384. if (num_entities <= 0) {
  1385. dev_err(dev, "%pfwP: entity id list missing: %d\n",
  1386. function_node, num_entities);
  1387. return -EINVAL;
  1388. } else if (num_entities > SDCA_MAX_ENTITY_COUNT) {
  1389. dev_err(dev, "%pfwP: maximum number of entities exceeded\n",
  1390. function_node);
  1391. return -EINVAL;
  1392. }
  1393. /* Add 1 to make space for Entity 0 */
  1394. entities = devm_kcalloc(dev, num_entities + 1, sizeof(*entities), GFP_KERNEL);
  1395. if (!entities)
  1396. return -ENOMEM;
  1397. u32 *entity_list __free(kfree) = kcalloc(num_entities, sizeof(*entity_list),
  1398. GFP_KERNEL);
  1399. if (!entity_list)
  1400. return -ENOMEM;
  1401. fwnode_property_read_u32_array(function_node, "mipi-sdca-entity-id-list",
  1402. entity_list, num_entities);
  1403. for (i = 0; i < num_entities; i++)
  1404. entities[i].id = entity_list[i];
  1405. /* now read subproperties */
  1406. for (i = 0; i < num_entities; i++) {
  1407. char entity_property[SDCA_PROPERTY_LENGTH];
  1408. struct fwnode_handle *entity_node;
  1409. /* DisCo uses upper-case for hex numbers */
  1410. snprintf(entity_property, sizeof(entity_property),
  1411. "mipi-sdca-entity-id-0x%X-subproperties", entities[i].id);
  1412. entity_node = fwnode_get_named_child_node(function_node, entity_property);
  1413. if (!entity_node) {
  1414. dev_err(dev, "%pfwP: entity node %s not found\n",
  1415. function_node, entity_property);
  1416. return -EINVAL;
  1417. }
  1418. ret = find_sdca_entity(dev, sdw, function_node,
  1419. entity_node, &entities[i]);
  1420. fwnode_handle_put(entity_node);
  1421. if (ret)
  1422. return ret;
  1423. }
  1424. /*
  1425. * Add Entity 0 at end of the array, makes it easy to skip during
  1426. * all the Entity searches involved in creating connections.
  1427. */
  1428. entities[num_entities].label = "entity0";
  1429. ret = find_sdca_entity_controls(dev, function_node, &entities[num_entities]);
  1430. if (ret)
  1431. return ret;
  1432. function->num_entities = num_entities + 1;
  1433. function->entities = entities;
  1434. return 0;
  1435. }
  1436. static struct sdca_entity *find_sdca_entity_by_label(struct sdca_function_data *function,
  1437. const char *entity_label)
  1438. {
  1439. struct sdca_entity *entity = NULL;
  1440. int i;
  1441. for (i = 0; i < function->num_entities; i++) {
  1442. entity = &function->entities[i];
  1443. /* check whole string first*/
  1444. if (!strcmp(entity->label, entity_label))
  1445. return entity;
  1446. }
  1447. for (i = 0; i < function->num_entities; i++) {
  1448. entity = &function->entities[i];
  1449. if (!strncmp(entity->label, entity_label, strlen(entity_label)))
  1450. return entity;
  1451. }
  1452. return NULL;
  1453. }
  1454. static struct sdca_entity *find_sdca_entity_by_id(struct sdca_function_data *function,
  1455. const int id)
  1456. {
  1457. int i;
  1458. for (i = 0; i < function->num_entities; i++) {
  1459. struct sdca_entity *entity = &function->entities[i];
  1460. if (entity->id == id)
  1461. return entity;
  1462. }
  1463. return NULL;
  1464. }
  1465. static int find_sdca_entity_connection_iot(struct device *dev,
  1466. struct sdca_function_data *function,
  1467. struct fwnode_handle *entity_node,
  1468. struct sdca_entity *entity)
  1469. {
  1470. struct sdca_entity_iot *terminal = &entity->iot;
  1471. struct fwnode_handle *clock_node;
  1472. struct sdca_entity *clock_entity;
  1473. const char *clock_label;
  1474. int ret;
  1475. clock_node = fwnode_get_named_child_node(entity_node,
  1476. "mipi-sdca-terminal-clock-connection");
  1477. if (!clock_node)
  1478. return 0;
  1479. ret = fwnode_property_read_string(clock_node, "mipi-sdca-entity-label",
  1480. &clock_label);
  1481. if (ret) {
  1482. dev_err(dev, "%s: clock label missing: %d\n", entity->label, ret);
  1483. fwnode_handle_put(clock_node);
  1484. return ret;
  1485. }
  1486. clock_entity = find_sdca_entity_by_label(function, clock_label);
  1487. if (!clock_entity) {
  1488. dev_err(dev, "%s: failed to find clock with label %s\n",
  1489. entity->label, clock_label);
  1490. fwnode_handle_put(clock_node);
  1491. return -EINVAL;
  1492. }
  1493. terminal->clock = clock_entity;
  1494. dev_dbg(dev, "%s -> %s\n", clock_entity->label, entity->label);
  1495. fwnode_handle_put(clock_node);
  1496. return 0;
  1497. }
  1498. static int find_sdca_entity_connection_pde(struct device *dev,
  1499. struct sdca_function_data *function,
  1500. struct fwnode_handle *entity_node,
  1501. struct sdca_entity *entity)
  1502. {
  1503. struct sdca_entity_pde *power = &entity->pde;
  1504. struct sdca_entity **managed;
  1505. int num_managed;
  1506. int i;
  1507. num_managed = fwnode_property_count_u32(entity_node,
  1508. "mipi-sdca-powerdomain-managed-list");
  1509. if (!num_managed) {
  1510. return 0;
  1511. } else if (num_managed < 0) {
  1512. dev_err(dev, "%s: managed list missing: %d\n", entity->label, num_managed);
  1513. return num_managed;
  1514. } else if (num_managed > SDCA_MAX_ENTITY_COUNT) {
  1515. dev_err(dev, "%s: maximum number of managed entities exceeded\n",
  1516. entity->label);
  1517. return -EINVAL;
  1518. }
  1519. managed = devm_kcalloc(dev, num_managed, sizeof(*managed), GFP_KERNEL);
  1520. if (!managed)
  1521. return -ENOMEM;
  1522. u32 *managed_list __free(kfree) = kcalloc(num_managed, sizeof(*managed_list),
  1523. GFP_KERNEL);
  1524. if (!managed_list)
  1525. return -ENOMEM;
  1526. fwnode_property_read_u32_array(entity_node,
  1527. "mipi-sdca-powerdomain-managed-list",
  1528. managed_list, num_managed);
  1529. for (i = 0; i < num_managed; i++) {
  1530. managed[i] = find_sdca_entity_by_id(function, managed_list[i]);
  1531. if (!managed[i]) {
  1532. dev_err(dev, "%s: failed to find entity with id %#x\n",
  1533. entity->label, managed_list[i]);
  1534. return -EINVAL;
  1535. }
  1536. dev_dbg(dev, "%s -> %s\n", managed[i]->label, entity->label);
  1537. }
  1538. power->num_managed = num_managed;
  1539. power->managed = managed;
  1540. return 0;
  1541. }
  1542. static int find_sdca_entity_connection_ge(struct device *dev,
  1543. struct sdca_function_data *function,
  1544. struct fwnode_handle *entity_node,
  1545. struct sdca_entity *entity)
  1546. {
  1547. int i, j;
  1548. for (i = 0; i < entity->ge.num_modes; i++) {
  1549. struct sdca_ge_mode *mode = &entity->ge.modes[i];
  1550. for (j = 0; j < mode->num_controls; j++) {
  1551. struct sdca_ge_control *affected = &mode->controls[j];
  1552. struct sdca_entity *managed;
  1553. managed = find_sdca_entity_by_id(function, affected->id);
  1554. if (!managed) {
  1555. dev_err(dev, "%s: failed to find entity with id %#x\n",
  1556. entity->label, affected->id);
  1557. return -EINVAL;
  1558. }
  1559. if (managed->group && managed->group != entity) {
  1560. dev_err(dev,
  1561. "%s: entity controlled by two groups %s, %s\n",
  1562. managed->label, managed->group->label,
  1563. entity->label);
  1564. return -EINVAL;
  1565. }
  1566. managed->group = entity;
  1567. }
  1568. }
  1569. return 0;
  1570. }
  1571. static int find_sdca_entity_connection(struct device *dev,
  1572. struct sdca_function_data *function,
  1573. struct fwnode_handle *entity_node,
  1574. struct sdca_entity *entity)
  1575. {
  1576. struct sdca_entity **pins;
  1577. int num_pins, pin;
  1578. u64 pin_list;
  1579. int i, ret;
  1580. switch (entity->type) {
  1581. case SDCA_ENTITY_TYPE_IT:
  1582. case SDCA_ENTITY_TYPE_OT:
  1583. ret = find_sdca_entity_connection_iot(dev, function,
  1584. entity_node, entity);
  1585. break;
  1586. case SDCA_ENTITY_TYPE_PDE:
  1587. ret = find_sdca_entity_connection_pde(dev, function,
  1588. entity_node, entity);
  1589. break;
  1590. case SDCA_ENTITY_TYPE_GE:
  1591. ret = find_sdca_entity_connection_ge(dev, function,
  1592. entity_node, entity);
  1593. break;
  1594. default:
  1595. ret = 0;
  1596. break;
  1597. }
  1598. if (ret)
  1599. return ret;
  1600. ret = fwnode_property_read_u64(entity_node, "mipi-sdca-input-pin-list", &pin_list);
  1601. if (ret == -EINVAL) {
  1602. /* Allow missing pin lists, assume no pins. */
  1603. return 0;
  1604. } else if (ret) {
  1605. dev_err(dev, "%s: failed to read pin list: %d\n", entity->label, ret);
  1606. return ret;
  1607. } else if (pin_list & BIT(0)) {
  1608. /*
  1609. * Each bit set in the pin-list refers to an entity_id in this
  1610. * Function. Entity 0 is an illegal connection since it is used
  1611. * for Function-level configurations.
  1612. */
  1613. dev_err(dev, "%s: pin 0 used as input\n", entity->label);
  1614. return -EINVAL;
  1615. } else if (!pin_list) {
  1616. return 0;
  1617. }
  1618. num_pins = hweight64(pin_list);
  1619. pins = devm_kcalloc(dev, num_pins, sizeof(*pins), GFP_KERNEL);
  1620. if (!pins)
  1621. return -ENOMEM;
  1622. i = 0;
  1623. for_each_set_bit(pin, (unsigned long *)&pin_list, BITS_PER_TYPE(pin_list)) {
  1624. char pin_property[SDCA_PROPERTY_LENGTH];
  1625. struct fwnode_handle *connected_node;
  1626. struct sdca_entity *connected_entity;
  1627. const char *connected_label;
  1628. snprintf(pin_property, sizeof(pin_property), "mipi-sdca-input-pin-%d", pin);
  1629. connected_node = fwnode_get_named_child_node(entity_node, pin_property);
  1630. if (!connected_node) {
  1631. dev_err(dev, "%s: pin node %s not found\n",
  1632. entity->label, pin_property);
  1633. return -EINVAL;
  1634. }
  1635. ret = fwnode_property_read_string(connected_node, "mipi-sdca-entity-label",
  1636. &connected_label);
  1637. if (ret) {
  1638. dev_err(dev, "%s: pin %d label missing: %d\n",
  1639. entity->label, pin, ret);
  1640. fwnode_handle_put(connected_node);
  1641. return ret;
  1642. }
  1643. connected_entity = find_sdca_entity_by_label(function, connected_label);
  1644. if (!connected_entity) {
  1645. dev_err(dev, "%s: failed to find entity with label %s\n",
  1646. entity->label, connected_label);
  1647. fwnode_handle_put(connected_node);
  1648. return -EINVAL;
  1649. }
  1650. pins[i] = connected_entity;
  1651. dev_dbg(dev, "%s -> %s\n", connected_entity->label, entity->label);
  1652. i++;
  1653. fwnode_handle_put(connected_node);
  1654. }
  1655. entity->num_sources = num_pins;
  1656. entity->sources = pins;
  1657. return 0;
  1658. }
  1659. static int find_sdca_connections(struct device *dev,
  1660. struct fwnode_handle *function_node,
  1661. struct sdca_function_data *function)
  1662. {
  1663. int i;
  1664. /* Entity 0 cannot have connections */
  1665. for (i = 0; i < function->num_entities - 1; i++) {
  1666. struct sdca_entity *entity = &function->entities[i];
  1667. char entity_property[SDCA_PROPERTY_LENGTH];
  1668. struct fwnode_handle *entity_node;
  1669. int ret;
  1670. /* DisCo uses upper-case for hex numbers */
  1671. snprintf(entity_property, sizeof(entity_property),
  1672. "mipi-sdca-entity-id-0x%X-subproperties",
  1673. entity->id);
  1674. entity_node = fwnode_get_named_child_node(function_node, entity_property);
  1675. if (!entity_node) {
  1676. dev_err(dev, "%pfwP: entity node %s not found\n",
  1677. function_node, entity_property);
  1678. return -EINVAL;
  1679. }
  1680. ret = find_sdca_entity_connection(dev, function, entity_node, entity);
  1681. fwnode_handle_put(entity_node);
  1682. if (ret)
  1683. return ret;
  1684. }
  1685. return 0;
  1686. }
  1687. static int find_sdca_cluster_channel(struct device *dev,
  1688. struct sdca_cluster *cluster,
  1689. struct fwnode_handle *channel_node,
  1690. struct sdca_channel *channel)
  1691. {
  1692. u32 tmp;
  1693. int ret;
  1694. ret = fwnode_property_read_u32(channel_node, "mipi-sdca-cluster-channel-id", &tmp);
  1695. if (ret) {
  1696. dev_err(dev, "cluster %#x: missing channel id: %d\n",
  1697. cluster->id, ret);
  1698. return ret;
  1699. }
  1700. channel->id = tmp;
  1701. ret = fwnode_property_read_u32(channel_node,
  1702. "mipi-sdca-cluster-channel-purpose",
  1703. &tmp);
  1704. if (ret) {
  1705. dev_err(dev, "cluster %#x: channel %#x: missing purpose: %d\n",
  1706. cluster->id, channel->id, ret);
  1707. return ret;
  1708. }
  1709. channel->purpose = tmp;
  1710. ret = fwnode_property_read_u32(channel_node,
  1711. "mipi-sdca-cluster-channel-relationship",
  1712. &tmp);
  1713. if (ret) {
  1714. dev_err(dev, "cluster %#x: channel %#x: missing relationship: %d\n",
  1715. cluster->id, channel->id, ret);
  1716. return ret;
  1717. }
  1718. channel->relationship = tmp;
  1719. dev_dbg(dev, "cluster %#x: channel id %#x purpose %#x relationship %#x\n",
  1720. cluster->id, channel->id, channel->purpose, channel->relationship);
  1721. return 0;
  1722. }
  1723. static int find_sdca_cluster_channels(struct device *dev,
  1724. struct fwnode_handle *cluster_node,
  1725. struct sdca_cluster *cluster)
  1726. {
  1727. struct sdca_channel *channels;
  1728. u32 num_channels;
  1729. int i, ret;
  1730. ret = fwnode_property_read_u32(cluster_node, "mipi-sdca-channel-count",
  1731. &num_channels);
  1732. if (ret < 0) {
  1733. dev_err(dev, "cluster %#x: failed to read channel list: %d\n",
  1734. cluster->id, ret);
  1735. return ret;
  1736. } else if (num_channels > SDCA_MAX_CHANNEL_COUNT) {
  1737. dev_err(dev, "cluster %#x: maximum number of channels exceeded\n",
  1738. cluster->id);
  1739. return -EINVAL;
  1740. }
  1741. channels = devm_kcalloc(dev, num_channels, sizeof(*channels), GFP_KERNEL);
  1742. if (!channels)
  1743. return -ENOMEM;
  1744. for (i = 0; i < num_channels; i++) {
  1745. char channel_property[SDCA_PROPERTY_LENGTH];
  1746. struct fwnode_handle *channel_node;
  1747. /* DisCo uses upper-case for hex numbers */
  1748. snprintf(channel_property, sizeof(channel_property),
  1749. "mipi-sdca-channel-%d-subproperties", i + 1);
  1750. channel_node = fwnode_get_named_child_node(cluster_node, channel_property);
  1751. if (!channel_node) {
  1752. dev_err(dev, "cluster %#x: channel node %s not found\n",
  1753. cluster->id, channel_property);
  1754. return -EINVAL;
  1755. }
  1756. ret = find_sdca_cluster_channel(dev, cluster, channel_node, &channels[i]);
  1757. fwnode_handle_put(channel_node);
  1758. if (ret)
  1759. return ret;
  1760. }
  1761. cluster->num_channels = num_channels;
  1762. cluster->channels = channels;
  1763. return 0;
  1764. }
  1765. static int find_sdca_clusters(struct device *dev,
  1766. struct fwnode_handle *function_node,
  1767. struct sdca_function_data *function)
  1768. {
  1769. struct sdca_cluster *clusters;
  1770. int num_clusters;
  1771. int i, ret;
  1772. num_clusters = fwnode_property_count_u32(function_node, "mipi-sdca-cluster-id-list");
  1773. if (!num_clusters || num_clusters == -EINVAL) {
  1774. return 0;
  1775. } else if (num_clusters < 0) {
  1776. dev_err(dev, "%pfwP: failed to read cluster id list: %d\n",
  1777. function_node, num_clusters);
  1778. return num_clusters;
  1779. } else if (num_clusters > SDCA_MAX_CLUSTER_COUNT) {
  1780. dev_err(dev, "%pfwP: maximum number of clusters exceeded\n", function_node);
  1781. return -EINVAL;
  1782. }
  1783. clusters = devm_kcalloc(dev, num_clusters, sizeof(*clusters), GFP_KERNEL);
  1784. if (!clusters)
  1785. return -ENOMEM;
  1786. u32 *cluster_list __free(kfree) = kcalloc(num_clusters, sizeof(*cluster_list),
  1787. GFP_KERNEL);
  1788. if (!cluster_list)
  1789. return -ENOMEM;
  1790. fwnode_property_read_u32_array(function_node, "mipi-sdca-cluster-id-list",
  1791. cluster_list, num_clusters);
  1792. for (i = 0; i < num_clusters; i++)
  1793. clusters[i].id = cluster_list[i];
  1794. /* now read subproperties */
  1795. for (i = 0; i < num_clusters; i++) {
  1796. char cluster_property[SDCA_PROPERTY_LENGTH];
  1797. struct fwnode_handle *cluster_node;
  1798. /* DisCo uses upper-case for hex numbers */
  1799. snprintf(cluster_property, sizeof(cluster_property),
  1800. "mipi-sdca-cluster-id-0x%X-subproperties", clusters[i].id);
  1801. cluster_node = fwnode_get_named_child_node(function_node, cluster_property);
  1802. if (!cluster_node) {
  1803. dev_err(dev, "%pfwP: cluster node %s not found\n",
  1804. function_node, cluster_property);
  1805. return -EINVAL;
  1806. }
  1807. ret = find_sdca_cluster_channels(dev, cluster_node, &clusters[i]);
  1808. fwnode_handle_put(cluster_node);
  1809. if (ret)
  1810. return ret;
  1811. }
  1812. function->num_clusters = num_clusters;
  1813. function->clusters = clusters;
  1814. return 0;
  1815. }
  1816. static int find_sdca_filesets(struct device *dev, struct sdw_slave *sdw,
  1817. struct fwnode_handle *function_node,
  1818. struct sdca_function_data *function)
  1819. {
  1820. static const int mult_fileset = 3;
  1821. char fileset_name[SDCA_PROPERTY_LENGTH];
  1822. struct sdca_fdl_set *sets;
  1823. int num_sets;
  1824. int i, j;
  1825. num_sets = fwnode_property_count_u32(function_node,
  1826. "mipi-sdca-file-set-id-list");
  1827. if (num_sets == 0 || num_sets == -EINVAL) {
  1828. dev_dbg(dev, "%pfwP: file set id list missing\n", function_node);
  1829. return 0;
  1830. } else if (num_sets < 0) {
  1831. dev_err(dev, "%pfwP: failed to read file set list: %d\n",
  1832. function_node, num_sets);
  1833. return num_sets;
  1834. }
  1835. u32 *filesets_list __free(kfree) = kcalloc(num_sets, sizeof(u32),
  1836. GFP_KERNEL);
  1837. if (!filesets_list)
  1838. return -ENOMEM;
  1839. fwnode_property_read_u32_array(function_node, "mipi-sdca-file-set-id-list",
  1840. filesets_list, num_sets);
  1841. sets = devm_kcalloc(dev, num_sets, sizeof(*sets), GFP_KERNEL);
  1842. if (!sets)
  1843. return -ENOMEM;
  1844. for (i = 0; i < num_sets; i++) {
  1845. struct sdca_fdl_set *set = &sets[i];
  1846. struct sdca_fdl_file *files;
  1847. int num_files, num_entries;
  1848. snprintf(fileset_name, sizeof(fileset_name),
  1849. "mipi-sdca-file-set-id-0x%X", filesets_list[i]);
  1850. num_entries = fwnode_property_count_u32(function_node, fileset_name);
  1851. if (num_entries <= 0) {
  1852. dev_err(dev, "%pfwP: file set %d missing entries: %d\n",
  1853. function_node, filesets_list[i], num_entries);
  1854. return -EINVAL;
  1855. } else if (num_entries % mult_fileset != 0) {
  1856. dev_err(dev, "%pfwP: file set %d files not multiple of %d\n",
  1857. function_node, filesets_list[i], mult_fileset);
  1858. return -EINVAL;
  1859. }
  1860. dev_dbg(dev, "fileset: %#x\n", filesets_list[i]);
  1861. files = devm_kcalloc(dev, num_entries / mult_fileset,
  1862. sizeof(*files), GFP_KERNEL);
  1863. if (!files)
  1864. return -ENOMEM;
  1865. u32 *fileset_entries __free(kfree) = kcalloc(num_entries, sizeof(u32),
  1866. GFP_KERNEL);
  1867. if (!fileset_entries)
  1868. return -ENOMEM;
  1869. fwnode_property_read_u32_array(function_node, fileset_name,
  1870. fileset_entries, num_entries);
  1871. for (j = 0, num_files = 0; j < num_entries; num_files++) {
  1872. struct sdca_fdl_file *file = &files[num_files];
  1873. file->vendor_id = fileset_entries[j++];
  1874. file->file_id = fileset_entries[j++];
  1875. file->fdl_offset = fileset_entries[j++];
  1876. dev_dbg(dev, "file: %#x, vendor: %#x, offset: %#x\n",
  1877. file->file_id, file->vendor_id, file->fdl_offset);
  1878. }
  1879. set->id = filesets_list[i];
  1880. set->num_files = num_files;
  1881. set->files = files;
  1882. }
  1883. function->fdl_data.swft = sdw->sdca_data.swft;
  1884. function->fdl_data.num_sets = num_sets;
  1885. function->fdl_data.sets = sets;
  1886. return 0;
  1887. }
  1888. /**
  1889. * sdca_parse_function - parse ACPI DisCo for a Function
  1890. * @dev: Pointer to device against which function data will be allocated.
  1891. * @sdw: SoundWire slave device to be processed.
  1892. * @function_desc: Pointer to the Function short descriptor.
  1893. * @function: Pointer to the Function information, to be populated.
  1894. *
  1895. * Return: Returns 0 for success.
  1896. */
  1897. int sdca_parse_function(struct device *dev, struct sdw_slave *sdw,
  1898. struct sdca_function_desc *function_desc,
  1899. struct sdca_function_data *function)
  1900. {
  1901. u32 tmp;
  1902. int ret;
  1903. function->desc = function_desc;
  1904. ret = fwnode_property_read_u32(function_desc->node,
  1905. "mipi-sdca-function-busy-max-delay", &tmp);
  1906. if (!ret)
  1907. function->busy_max_delay = tmp;
  1908. ret = fwnode_property_read_u32(function_desc->node,
  1909. "mipi-sdca-function-reset-max-delay", &tmp);
  1910. if (!ret)
  1911. function->reset_max_delay = tmp;
  1912. dev_dbg(dev, "%pfwP: name %s busy delay %dus reset delay %dus\n",
  1913. function->desc->node, function->desc->name,
  1914. function->busy_max_delay, function->reset_max_delay);
  1915. ret = find_sdca_init_table(dev, function_desc->node, function);
  1916. if (ret)
  1917. return ret;
  1918. ret = find_sdca_entities(dev, sdw, function_desc->node, function);
  1919. if (ret)
  1920. return ret;
  1921. ret = find_sdca_connections(dev, function_desc->node, function);
  1922. if (ret)
  1923. return ret;
  1924. ret = find_sdca_clusters(dev, function_desc->node, function);
  1925. if (ret < 0)
  1926. return ret;
  1927. ret = find_sdca_filesets(dev, sdw, function_desc->node, function);
  1928. if (ret)
  1929. return ret;
  1930. return 0;
  1931. }
  1932. EXPORT_SYMBOL_NS(sdca_parse_function, "SND_SOC_SDCA");
  1933. const char *sdca_find_terminal_name(enum sdca_terminal_type type)
  1934. {
  1935. switch (type) {
  1936. case SDCA_TERM_TYPE_LINEIN_STEREO:
  1937. return SDCA_TERM_TYPE_LINEIN_STEREO_NAME;
  1938. case SDCA_TERM_TYPE_LINEIN_FRONT_LR:
  1939. return SDCA_TERM_TYPE_LINEIN_FRONT_LR_NAME;
  1940. case SDCA_TERM_TYPE_LINEIN_CENTER_LFE:
  1941. return SDCA_TERM_TYPE_LINEIN_CENTER_LFE_NAME;
  1942. case SDCA_TERM_TYPE_LINEIN_SURROUND_LR:
  1943. return SDCA_TERM_TYPE_LINEIN_SURROUND_LR_NAME;
  1944. case SDCA_TERM_TYPE_LINEIN_REAR_LR:
  1945. return SDCA_TERM_TYPE_LINEIN_REAR_LR_NAME;
  1946. case SDCA_TERM_TYPE_LINEOUT_STEREO:
  1947. return SDCA_TERM_TYPE_LINEOUT_STEREO_NAME;
  1948. case SDCA_TERM_TYPE_LINEOUT_FRONT_LR:
  1949. return SDCA_TERM_TYPE_LINEOUT_FRONT_LR_NAME;
  1950. case SDCA_TERM_TYPE_LINEOUT_CENTER_LFE:
  1951. return SDCA_TERM_TYPE_LINEOUT_CENTER_LFE_NAME;
  1952. case SDCA_TERM_TYPE_LINEOUT_SURROUND_LR:
  1953. return SDCA_TERM_TYPE_LINEOUT_SURROUND_LR_NAME;
  1954. case SDCA_TERM_TYPE_LINEOUT_REAR_LR:
  1955. return SDCA_TERM_TYPE_LINEOUT_REAR_LR_NAME;
  1956. case SDCA_TERM_TYPE_MIC_JACK:
  1957. return SDCA_TERM_TYPE_MIC_JACK_NAME;
  1958. case SDCA_TERM_TYPE_STEREO_JACK:
  1959. return SDCA_TERM_TYPE_STEREO_JACK_NAME;
  1960. case SDCA_TERM_TYPE_FRONT_LR_JACK:
  1961. return SDCA_TERM_TYPE_FRONT_LR_JACK_NAME;
  1962. case SDCA_TERM_TYPE_CENTER_LFE_JACK:
  1963. return SDCA_TERM_TYPE_CENTER_LFE_JACK_NAME;
  1964. case SDCA_TERM_TYPE_SURROUND_LR_JACK:
  1965. return SDCA_TERM_TYPE_SURROUND_LR_JACK_NAME;
  1966. case SDCA_TERM_TYPE_REAR_LR_JACK:
  1967. return SDCA_TERM_TYPE_REAR_LR_JACK_NAME;
  1968. case SDCA_TERM_TYPE_HEADPHONE_JACK:
  1969. return SDCA_TERM_TYPE_HEADPHONE_JACK_NAME;
  1970. case SDCA_TERM_TYPE_HEADSET_JACK:
  1971. return SDCA_TERM_TYPE_HEADSET_JACK_NAME;
  1972. default:
  1973. return NULL;
  1974. }
  1975. }
  1976. EXPORT_SYMBOL_NS(sdca_find_terminal_name, "SND_SOC_SDCA");
  1977. struct sdca_control *sdca_selector_find_control(struct device *dev,
  1978. struct sdca_entity *entity,
  1979. const int sel)
  1980. {
  1981. int i;
  1982. for (i = 0; i < entity->num_controls; i++) {
  1983. struct sdca_control *control = &entity->controls[i];
  1984. if (control->sel == sel)
  1985. return control;
  1986. }
  1987. dev_err(dev, "%s: control %#x: missing\n", entity->label, sel);
  1988. return NULL;
  1989. }
  1990. EXPORT_SYMBOL_NS(sdca_selector_find_control, "SND_SOC_SDCA");
  1991. struct sdca_control_range *sdca_control_find_range(struct device *dev,
  1992. struct sdca_entity *entity,
  1993. struct sdca_control *control,
  1994. int cols, int rows)
  1995. {
  1996. struct sdca_control_range *range = &control->range;
  1997. if ((cols && range->cols != cols) || (rows && range->rows != rows) ||
  1998. !range->data) {
  1999. dev_err(dev, "%s: control %#x: ranges invalid (%d,%d)\n",
  2000. entity->label, control->sel, range->cols, range->rows);
  2001. return NULL;
  2002. }
  2003. return range;
  2004. }
  2005. EXPORT_SYMBOL_NS(sdca_control_find_range, "SND_SOC_SDCA");
  2006. struct sdca_control_range *sdca_selector_find_range(struct device *dev,
  2007. struct sdca_entity *entity,
  2008. int sel, int cols, int rows)
  2009. {
  2010. struct sdca_control *control;
  2011. control = sdca_selector_find_control(dev, entity, sel);
  2012. if (!control)
  2013. return NULL;
  2014. return sdca_control_find_range(dev, entity, control, cols, rows);
  2015. }
  2016. EXPORT_SYMBOL_NS(sdca_selector_find_range, "SND_SOC_SDCA");
  2017. struct sdca_cluster *sdca_id_find_cluster(struct device *dev,
  2018. struct sdca_function_data *function,
  2019. const int id)
  2020. {
  2021. int i;
  2022. for (i = 0; i < function->num_clusters; i++) {
  2023. struct sdca_cluster *cluster = &function->clusters[i];
  2024. if (cluster->id == id)
  2025. return cluster;
  2026. }
  2027. dev_err(dev, "%s: cluster %#x: missing\n", function->desc->name, id);
  2028. return NULL;
  2029. }
  2030. EXPORT_SYMBOL_NS(sdca_id_find_cluster, "SND_SOC_SDCA");
  2031. MODULE_LICENSE("Dual BSD/GPL");
  2032. MODULE_DESCRIPTION("SDCA library");