soc-dapm.c 38 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538
  1. /*
  2. * soc-dapm.c -- ALSA SoC Dynamic Audio Power Management
  3. *
  4. * Copyright 2005 Wolfson Microelectronics PLC.
  5. * Author: Liam Girdwood
  6. * liam.girdwood@wolfsonmicro.com or linux@wolfsonmicro.com
  7. *
  8. * This program is free software; you can redistribute it and/or modify it
  9. * under the terms of the GNU General Public License as published by the
  10. * Free Software Foundation; either version 2 of the License, or (at your
  11. * option) any later version.
  12. *
  13. * Features:
  14. * o Changes power status of internal codec blocks depending on the
  15. * dynamic configuration of codec internal audio paths and active
  16. * DAC's/ADC's.
  17. * o Platform power domain - can support external components i.e. amps and
  18. * mic/meadphone insertion events.
  19. * o Automatic Mic Bias support
  20. * o Jack insertion power event initiation - e.g. hp insertion will enable
  21. * sinks, dacs, etc
  22. * o Delayed powerdown of audio susbsystem to reduce pops between a quick
  23. * device reopen.
  24. *
  25. * Todo:
  26. * o DAPM power change sequencing - allow for configurable per
  27. * codec sequences.
  28. * o Support for analogue bias optimisation.
  29. * o Support for reduced codec oversampling rates.
  30. * o Support for reduced codec bias currents.
  31. */
  32. #include <linux/module.h>
  33. #include <linux/moduleparam.h>
  34. #include <linux/init.h>
  35. #include <linux/delay.h>
  36. #include <linux/pm.h>
  37. #include <linux/bitops.h>
  38. #include <linux/platform_device.h>
  39. #include <linux/jiffies.h>
  40. #include <sound/core.h>
  41. #include <sound/pcm.h>
  42. #include <sound/pcm_params.h>
  43. #include <sound/soc-dapm.h>
  44. #include <sound/initval.h>
  45. /* debug */
  46. #ifdef DEBUG
  47. #define dump_dapm(codec, action) dbg_dump_dapm(codec, action)
  48. #else
  49. #define dump_dapm(codec, action)
  50. #endif
  51. /* dapm power sequences - make this per codec in the future */
  52. static int dapm_up_seq[] = {
  53. snd_soc_dapm_pre, snd_soc_dapm_micbias, snd_soc_dapm_mic,
  54. snd_soc_dapm_mux, snd_soc_dapm_dac, snd_soc_dapm_mixer, snd_soc_dapm_pga,
  55. snd_soc_dapm_adc, snd_soc_dapm_hp, snd_soc_dapm_spk, snd_soc_dapm_post
  56. };
  57. static int dapm_down_seq[] = {
  58. snd_soc_dapm_pre, snd_soc_dapm_adc, snd_soc_dapm_hp, snd_soc_dapm_spk,
  59. snd_soc_dapm_pga, snd_soc_dapm_mixer, snd_soc_dapm_dac, snd_soc_dapm_mic,
  60. snd_soc_dapm_micbias, snd_soc_dapm_mux, snd_soc_dapm_post
  61. };
  62. static int dapm_status = 1;
  63. module_param(dapm_status, int, 0);
  64. MODULE_PARM_DESC(dapm_status, "enable DPM sysfs entries");
  65. static unsigned int pop_time;
  66. static void pop_wait(void)
  67. {
  68. if (pop_time)
  69. schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time));
  70. }
  71. static void pop_dbg(const char *fmt, ...)
  72. {
  73. va_list args;
  74. va_start(args, fmt);
  75. if (pop_time) {
  76. vprintk(fmt, args);
  77. pop_wait();
  78. }
  79. va_end(args);
  80. }
  81. /* create a new dapm widget */
  82. static inline struct snd_soc_dapm_widget *dapm_cnew_widget(
  83. const struct snd_soc_dapm_widget *_widget)
  84. {
  85. return kmemdup(_widget, sizeof(*_widget), GFP_KERNEL);
  86. }
  87. /* set up initial codec paths */
  88. static void dapm_set_path_status(struct snd_soc_dapm_widget *w,
  89. struct snd_soc_dapm_path *p, int i)
  90. {
  91. switch (w->id) {
  92. case snd_soc_dapm_switch:
  93. case snd_soc_dapm_mixer: {
  94. int val;
  95. int reg = w->kcontrols[i].private_value & 0xff;
  96. int shift = (w->kcontrols[i].private_value >> 8) & 0x0f;
  97. int mask = (w->kcontrols[i].private_value >> 16) & 0xff;
  98. int invert = (w->kcontrols[i].private_value >> 24) & 0x01;
  99. val = snd_soc_read(w->codec, reg);
  100. val = (val >> shift) & mask;
  101. if ((invert && !val) || (!invert && val))
  102. p->connect = 1;
  103. else
  104. p->connect = 0;
  105. }
  106. break;
  107. case snd_soc_dapm_mux: {
  108. struct soc_enum *e = (struct soc_enum *)w->kcontrols[i].private_value;
  109. int val, item, bitmask;
  110. for (bitmask = 1; bitmask < e->mask; bitmask <<= 1)
  111. ;
  112. val = snd_soc_read(w->codec, e->reg);
  113. item = (val >> e->shift_l) & (bitmask - 1);
  114. p->connect = 0;
  115. for (i = 0; i < e->mask; i++) {
  116. if (!(strcmp(p->name, e->texts[i])) && item == i)
  117. p->connect = 1;
  118. }
  119. }
  120. break;
  121. /* does not effect routing - always connected */
  122. case snd_soc_dapm_pga:
  123. case snd_soc_dapm_output:
  124. case snd_soc_dapm_adc:
  125. case snd_soc_dapm_input:
  126. case snd_soc_dapm_dac:
  127. case snd_soc_dapm_micbias:
  128. case snd_soc_dapm_vmid:
  129. p->connect = 1;
  130. break;
  131. /* does effect routing - dynamically connected */
  132. case snd_soc_dapm_hp:
  133. case snd_soc_dapm_mic:
  134. case snd_soc_dapm_spk:
  135. case snd_soc_dapm_line:
  136. case snd_soc_dapm_pre:
  137. case snd_soc_dapm_post:
  138. p->connect = 0;
  139. break;
  140. }
  141. }
  142. /* connect mux widget to it's interconnecting audio paths */
  143. static int dapm_connect_mux(struct snd_soc_codec *codec,
  144. struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
  145. struct snd_soc_dapm_path *path, const char *control_name,
  146. const struct snd_kcontrol_new *kcontrol)
  147. {
  148. struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
  149. int i;
  150. for (i = 0; i < e->mask; i++) {
  151. if (!(strcmp(control_name, e->texts[i]))) {
  152. list_add(&path->list, &codec->dapm_paths);
  153. list_add(&path->list_sink, &dest->sources);
  154. list_add(&path->list_source, &src->sinks);
  155. path->name = (char*)e->texts[i];
  156. dapm_set_path_status(dest, path, 0);
  157. return 0;
  158. }
  159. }
  160. return -ENODEV;
  161. }
  162. /* connect mixer widget to it's interconnecting audio paths */
  163. static int dapm_connect_mixer(struct snd_soc_codec *codec,
  164. struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
  165. struct snd_soc_dapm_path *path, const char *control_name)
  166. {
  167. int i;
  168. /* search for mixer kcontrol */
  169. for (i = 0; i < dest->num_kcontrols; i++) {
  170. if (!strcmp(control_name, dest->kcontrols[i].name)) {
  171. list_add(&path->list, &codec->dapm_paths);
  172. list_add(&path->list_sink, &dest->sources);
  173. list_add(&path->list_source, &src->sinks);
  174. path->name = dest->kcontrols[i].name;
  175. dapm_set_path_status(dest, path, i);
  176. return 0;
  177. }
  178. }
  179. return -ENODEV;
  180. }
  181. /* update dapm codec register bits */
  182. static int dapm_update_bits(struct snd_soc_dapm_widget *widget)
  183. {
  184. int change, power;
  185. unsigned short old, new;
  186. struct snd_soc_codec *codec = widget->codec;
  187. /* check for valid widgets */
  188. if (widget->reg < 0 || widget->id == snd_soc_dapm_input ||
  189. widget->id == snd_soc_dapm_output ||
  190. widget->id == snd_soc_dapm_hp ||
  191. widget->id == snd_soc_dapm_mic ||
  192. widget->id == snd_soc_dapm_line ||
  193. widget->id == snd_soc_dapm_spk)
  194. return 0;
  195. power = widget->power;
  196. if (widget->invert)
  197. power = (power ? 0:1);
  198. old = snd_soc_read(codec, widget->reg);
  199. new = (old & ~(0x1 << widget->shift)) | (power << widget->shift);
  200. change = old != new;
  201. if (change) {
  202. pop_dbg("pop test %s : %s in %d ms\n", widget->name,
  203. widget->power ? "on" : "off", pop_time);
  204. snd_soc_write(codec, widget->reg, new);
  205. pop_wait();
  206. }
  207. pr_debug("reg %x old %x new %x change %d\n", widget->reg,
  208. old, new, change);
  209. return change;
  210. }
  211. /* ramps the volume up or down to minimise pops before or after a
  212. * DAPM power event */
  213. static int dapm_set_pga(struct snd_soc_dapm_widget *widget, int power)
  214. {
  215. const struct snd_kcontrol_new *k = widget->kcontrols;
  216. if (widget->muted && !power)
  217. return 0;
  218. if (!widget->muted && power)
  219. return 0;
  220. if (widget->num_kcontrols && k) {
  221. int reg = k->private_value & 0xff;
  222. int shift = (k->private_value >> 8) & 0x0f;
  223. int mask = (k->private_value >> 16) & 0xff;
  224. int invert = (k->private_value >> 24) & 0x01;
  225. if (power) {
  226. int i;
  227. /* power up has happended, increase volume to last level */
  228. if (invert) {
  229. for (i = mask; i > widget->saved_value; i--)
  230. snd_soc_update_bits(widget->codec, reg, mask, i);
  231. } else {
  232. for (i = 0; i < widget->saved_value; i++)
  233. snd_soc_update_bits(widget->codec, reg, mask, i);
  234. }
  235. widget->muted = 0;
  236. } else {
  237. /* power down is about to occur, decrease volume to mute */
  238. int val = snd_soc_read(widget->codec, reg);
  239. int i = widget->saved_value = (val >> shift) & mask;
  240. if (invert) {
  241. for (; i < mask; i++)
  242. snd_soc_update_bits(widget->codec, reg, mask, i);
  243. } else {
  244. for (; i > 0; i--)
  245. snd_soc_update_bits(widget->codec, reg, mask, i);
  246. }
  247. widget->muted = 1;
  248. }
  249. }
  250. return 0;
  251. }
  252. /* create new dapm mixer control */
  253. static int dapm_new_mixer(struct snd_soc_codec *codec,
  254. struct snd_soc_dapm_widget *w)
  255. {
  256. int i, ret = 0;
  257. char name[32];
  258. struct snd_soc_dapm_path *path;
  259. /* add kcontrol */
  260. for (i = 0; i < w->num_kcontrols; i++) {
  261. /* match name */
  262. list_for_each_entry(path, &w->sources, list_sink) {
  263. /* mixer/mux paths name must match control name */
  264. if (path->name != (char*)w->kcontrols[i].name)
  265. continue;
  266. /* add dapm control with long name */
  267. snprintf(name, 32, "%s %s", w->name, w->kcontrols[i].name);
  268. path->long_name = kstrdup (name, GFP_KERNEL);
  269. if (path->long_name == NULL)
  270. return -ENOMEM;
  271. path->kcontrol = snd_soc_cnew(&w->kcontrols[i], w,
  272. path->long_name);
  273. ret = snd_ctl_add(codec->card, path->kcontrol);
  274. if (ret < 0) {
  275. printk(KERN_ERR "asoc: failed to add dapm kcontrol %s\n",
  276. path->long_name);
  277. kfree(path->long_name);
  278. path->long_name = NULL;
  279. return ret;
  280. }
  281. }
  282. }
  283. return ret;
  284. }
  285. /* create new dapm mux control */
  286. static int dapm_new_mux(struct snd_soc_codec *codec,
  287. struct snd_soc_dapm_widget *w)
  288. {
  289. struct snd_soc_dapm_path *path = NULL;
  290. struct snd_kcontrol *kcontrol;
  291. int ret = 0;
  292. if (!w->num_kcontrols) {
  293. printk(KERN_ERR "asoc: mux %s has no controls\n", w->name);
  294. return -EINVAL;
  295. }
  296. kcontrol = snd_soc_cnew(&w->kcontrols[0], w, w->name);
  297. ret = snd_ctl_add(codec->card, kcontrol);
  298. if (ret < 0)
  299. goto err;
  300. list_for_each_entry(path, &w->sources, list_sink)
  301. path->kcontrol = kcontrol;
  302. return ret;
  303. err:
  304. printk(KERN_ERR "asoc: failed to add kcontrol %s\n", w->name);
  305. return ret;
  306. }
  307. /* create new dapm volume control */
  308. static int dapm_new_pga(struct snd_soc_codec *codec,
  309. struct snd_soc_dapm_widget *w)
  310. {
  311. struct snd_kcontrol *kcontrol;
  312. int ret = 0;
  313. if (!w->num_kcontrols)
  314. return -EINVAL;
  315. kcontrol = snd_soc_cnew(&w->kcontrols[0], w, w->name);
  316. ret = snd_ctl_add(codec->card, kcontrol);
  317. if (ret < 0) {
  318. printk(KERN_ERR "asoc: failed to add kcontrol %s\n", w->name);
  319. return ret;
  320. }
  321. return ret;
  322. }
  323. /* reset 'walked' bit for each dapm path */
  324. static inline void dapm_clear_walk(struct snd_soc_codec *codec)
  325. {
  326. struct snd_soc_dapm_path *p;
  327. list_for_each_entry(p, &codec->dapm_paths, list)
  328. p->walked = 0;
  329. }
  330. /*
  331. * Recursively check for a completed path to an active or physically connected
  332. * output widget. Returns number of complete paths.
  333. */
  334. static int is_connected_output_ep(struct snd_soc_dapm_widget *widget)
  335. {
  336. struct snd_soc_dapm_path *path;
  337. int con = 0;
  338. if (widget->id == snd_soc_dapm_adc && widget->active)
  339. return 1;
  340. if (widget->connected) {
  341. /* connected pin ? */
  342. if (widget->id == snd_soc_dapm_output && !widget->ext)
  343. return 1;
  344. /* connected jack or spk ? */
  345. if (widget->id == snd_soc_dapm_hp || widget->id == snd_soc_dapm_spk ||
  346. widget->id == snd_soc_dapm_line)
  347. return 1;
  348. }
  349. list_for_each_entry(path, &widget->sinks, list_source) {
  350. if (path->walked)
  351. continue;
  352. if (path->sink && path->connect) {
  353. path->walked = 1;
  354. con += is_connected_output_ep(path->sink);
  355. }
  356. }
  357. return con;
  358. }
  359. /*
  360. * Recursively check for a completed path to an active or physically connected
  361. * input widget. Returns number of complete paths.
  362. */
  363. static int is_connected_input_ep(struct snd_soc_dapm_widget *widget)
  364. {
  365. struct snd_soc_dapm_path *path;
  366. int con = 0;
  367. /* active stream ? */
  368. if (widget->id == snd_soc_dapm_dac && widget->active)
  369. return 1;
  370. if (widget->connected) {
  371. /* connected pin ? */
  372. if (widget->id == snd_soc_dapm_input && !widget->ext)
  373. return 1;
  374. /* connected VMID/Bias for lower pops */
  375. if (widget->id == snd_soc_dapm_vmid)
  376. return 1;
  377. /* connected jack ? */
  378. if (widget->id == snd_soc_dapm_mic || widget->id == snd_soc_dapm_line)
  379. return 1;
  380. }
  381. list_for_each_entry(path, &widget->sources, list_sink) {
  382. if (path->walked)
  383. continue;
  384. if (path->source && path->connect) {
  385. path->walked = 1;
  386. con += is_connected_input_ep(path->source);
  387. }
  388. }
  389. return con;
  390. }
  391. /*
  392. * Handler for generic register modifier widget.
  393. */
  394. int dapm_reg_event(struct snd_soc_dapm_widget *w,
  395. struct snd_kcontrol *kcontrol, int event)
  396. {
  397. unsigned int val;
  398. if (SND_SOC_DAPM_EVENT_ON(event))
  399. val = w->on_val;
  400. else
  401. val = w->off_val;
  402. snd_soc_update_bits(w->codec, -(w->reg + 1),
  403. w->mask << w->shift, val << w->shift);
  404. return 0;
  405. }
  406. /*
  407. * Scan each dapm widget for complete audio path.
  408. * A complete path is a route that has valid endpoints i.e.:-
  409. *
  410. * o DAC to output pin.
  411. * o Input Pin to ADC.
  412. * o Input pin to Output pin (bypass, sidetone)
  413. * o DAC to ADC (loopback).
  414. */
  415. static int dapm_power_widgets(struct snd_soc_codec *codec, int event)
  416. {
  417. struct snd_soc_dapm_widget *w;
  418. int in, out, i, c = 1, *seq = NULL, ret = 0, power_change, power;
  419. /* do we have a sequenced stream event */
  420. if (event == SND_SOC_DAPM_STREAM_START) {
  421. c = ARRAY_SIZE(dapm_up_seq);
  422. seq = dapm_up_seq;
  423. } else if (event == SND_SOC_DAPM_STREAM_STOP) {
  424. c = ARRAY_SIZE(dapm_down_seq);
  425. seq = dapm_down_seq;
  426. }
  427. for(i = 0; i < c; i++) {
  428. list_for_each_entry(w, &codec->dapm_widgets, list) {
  429. /* is widget in stream order */
  430. if (seq && seq[i] && w->id != seq[i])
  431. continue;
  432. /* vmid - no action */
  433. if (w->id == snd_soc_dapm_vmid)
  434. continue;
  435. /* active ADC */
  436. if (w->id == snd_soc_dapm_adc && w->active) {
  437. in = is_connected_input_ep(w);
  438. dapm_clear_walk(w->codec);
  439. w->power = (in != 0) ? 1 : 0;
  440. dapm_update_bits(w);
  441. continue;
  442. }
  443. /* active DAC */
  444. if (w->id == snd_soc_dapm_dac && w->active) {
  445. out = is_connected_output_ep(w);
  446. dapm_clear_walk(w->codec);
  447. w->power = (out != 0) ? 1 : 0;
  448. dapm_update_bits(w);
  449. continue;
  450. }
  451. /* programmable gain/attenuation */
  452. if (w->id == snd_soc_dapm_pga) {
  453. int on;
  454. in = is_connected_input_ep(w);
  455. dapm_clear_walk(w->codec);
  456. out = is_connected_output_ep(w);
  457. dapm_clear_walk(w->codec);
  458. w->power = on = (out != 0 && in != 0) ? 1 : 0;
  459. if (!on)
  460. dapm_set_pga(w, on); /* lower volume to reduce pops */
  461. dapm_update_bits(w);
  462. if (on)
  463. dapm_set_pga(w, on); /* restore volume from zero */
  464. continue;
  465. }
  466. /* pre and post event widgets */
  467. if (w->id == snd_soc_dapm_pre) {
  468. if (!w->event)
  469. continue;
  470. if (event == SND_SOC_DAPM_STREAM_START) {
  471. ret = w->event(w,
  472. NULL, SND_SOC_DAPM_PRE_PMU);
  473. if (ret < 0)
  474. return ret;
  475. } else if (event == SND_SOC_DAPM_STREAM_STOP) {
  476. ret = w->event(w,
  477. NULL, SND_SOC_DAPM_PRE_PMD);
  478. if (ret < 0)
  479. return ret;
  480. }
  481. continue;
  482. }
  483. if (w->id == snd_soc_dapm_post) {
  484. if (!w->event)
  485. continue;
  486. if (event == SND_SOC_DAPM_STREAM_START) {
  487. ret = w->event(w,
  488. NULL, SND_SOC_DAPM_POST_PMU);
  489. if (ret < 0)
  490. return ret;
  491. } else if (event == SND_SOC_DAPM_STREAM_STOP) {
  492. ret = w->event(w,
  493. NULL, SND_SOC_DAPM_POST_PMD);
  494. if (ret < 0)
  495. return ret;
  496. }
  497. continue;
  498. }
  499. /* all other widgets */
  500. in = is_connected_input_ep(w);
  501. dapm_clear_walk(w->codec);
  502. out = is_connected_output_ep(w);
  503. dapm_clear_walk(w->codec);
  504. power = (out != 0 && in != 0) ? 1 : 0;
  505. power_change = (w->power == power) ? 0: 1;
  506. w->power = power;
  507. if (!power_change)
  508. continue;
  509. /* call any power change event handlers */
  510. if (w->event)
  511. pr_debug("power %s event for %s flags %x\n",
  512. w->power ? "on" : "off",
  513. w->name, w->event_flags);
  514. /* power up pre event */
  515. if (power && w->event &&
  516. (w->event_flags & SND_SOC_DAPM_PRE_PMU)) {
  517. ret = w->event(w, NULL, SND_SOC_DAPM_PRE_PMU);
  518. if (ret < 0)
  519. return ret;
  520. }
  521. /* power down pre event */
  522. if (!power && w->event &&
  523. (w->event_flags & SND_SOC_DAPM_PRE_PMD)) {
  524. ret = w->event(w, NULL, SND_SOC_DAPM_PRE_PMD);
  525. if (ret < 0)
  526. return ret;
  527. }
  528. dapm_update_bits(w);
  529. /* power up post event */
  530. if (power && w->event &&
  531. (w->event_flags & SND_SOC_DAPM_POST_PMU)) {
  532. ret = w->event(w,
  533. NULL, SND_SOC_DAPM_POST_PMU);
  534. if (ret < 0)
  535. return ret;
  536. }
  537. /* power down post event */
  538. if (!power && w->event &&
  539. (w->event_flags & SND_SOC_DAPM_POST_PMD)) {
  540. ret = w->event(w, NULL, SND_SOC_DAPM_POST_PMD);
  541. if (ret < 0)
  542. return ret;
  543. }
  544. }
  545. }
  546. return ret;
  547. }
  548. #ifdef DEBUG
  549. static void dbg_dump_dapm(struct snd_soc_codec* codec, const char *action)
  550. {
  551. struct snd_soc_dapm_widget *w;
  552. struct snd_soc_dapm_path *p = NULL;
  553. int in, out;
  554. printk("DAPM %s %s\n", codec->name, action);
  555. list_for_each_entry(w, &codec->dapm_widgets, list) {
  556. /* only display widgets that effect routing */
  557. switch (w->id) {
  558. case snd_soc_dapm_pre:
  559. case snd_soc_dapm_post:
  560. case snd_soc_dapm_vmid:
  561. continue;
  562. case snd_soc_dapm_mux:
  563. case snd_soc_dapm_output:
  564. case snd_soc_dapm_input:
  565. case snd_soc_dapm_switch:
  566. case snd_soc_dapm_hp:
  567. case snd_soc_dapm_mic:
  568. case snd_soc_dapm_spk:
  569. case snd_soc_dapm_line:
  570. case snd_soc_dapm_micbias:
  571. case snd_soc_dapm_dac:
  572. case snd_soc_dapm_adc:
  573. case snd_soc_dapm_pga:
  574. case snd_soc_dapm_mixer:
  575. if (w->name) {
  576. in = is_connected_input_ep(w);
  577. dapm_clear_walk(w->codec);
  578. out = is_connected_output_ep(w);
  579. dapm_clear_walk(w->codec);
  580. printk("%s: %s in %d out %d\n", w->name,
  581. w->power ? "On":"Off",in, out);
  582. list_for_each_entry(p, &w->sources, list_sink) {
  583. if (p->connect)
  584. printk(" in %s %s\n", p->name ? p->name : "static",
  585. p->source->name);
  586. }
  587. list_for_each_entry(p, &w->sinks, list_source) {
  588. if (p->connect)
  589. printk(" out %s %s\n", p->name ? p->name : "static",
  590. p->sink->name);
  591. }
  592. }
  593. break;
  594. }
  595. }
  596. }
  597. #endif
  598. /* test and update the power status of a mux widget */
  599. static int dapm_mux_update_power(struct snd_soc_dapm_widget *widget,
  600. struct snd_kcontrol *kcontrol, int mask,
  601. int val, struct soc_enum* e)
  602. {
  603. struct snd_soc_dapm_path *path;
  604. int found = 0;
  605. if (widget->id != snd_soc_dapm_mux)
  606. return -ENODEV;
  607. if (!snd_soc_test_bits(widget->codec, e->reg, mask, val))
  608. return 0;
  609. /* find dapm widget path assoc with kcontrol */
  610. list_for_each_entry(path, &widget->codec->dapm_paths, list) {
  611. if (path->kcontrol != kcontrol)
  612. continue;
  613. if (!path->name || ! e->texts[val])
  614. continue;
  615. found = 1;
  616. /* we now need to match the string in the enum to the path */
  617. if (!(strcmp(path->name, e->texts[val])))
  618. path->connect = 1; /* new connection */
  619. else
  620. path->connect = 0; /* old connection must be powered down */
  621. }
  622. if (found) {
  623. dapm_power_widgets(widget->codec, SND_SOC_DAPM_STREAM_NOP);
  624. dump_dapm(widget->codec, "mux power update");
  625. }
  626. return 0;
  627. }
  628. /* test and update the power status of a mixer or switch widget */
  629. static int dapm_mixer_update_power(struct snd_soc_dapm_widget *widget,
  630. struct snd_kcontrol *kcontrol, int reg,
  631. int val_mask, int val, int invert)
  632. {
  633. struct snd_soc_dapm_path *path;
  634. int found = 0;
  635. if (widget->id != snd_soc_dapm_mixer &&
  636. widget->id != snd_soc_dapm_switch)
  637. return -ENODEV;
  638. if (!snd_soc_test_bits(widget->codec, reg, val_mask, val))
  639. return 0;
  640. /* find dapm widget path assoc with kcontrol */
  641. list_for_each_entry(path, &widget->codec->dapm_paths, list) {
  642. if (path->kcontrol != kcontrol)
  643. continue;
  644. /* found, now check type */
  645. found = 1;
  646. if (val)
  647. /* new connection */
  648. path->connect = invert ? 0:1;
  649. else
  650. /* old connection must be powered down */
  651. path->connect = invert ? 1:0;
  652. break;
  653. }
  654. if (found) {
  655. dapm_power_widgets(widget->codec, SND_SOC_DAPM_STREAM_NOP);
  656. dump_dapm(widget->codec, "mixer power update");
  657. }
  658. return 0;
  659. }
  660. /* show dapm widget status in sys fs */
  661. static ssize_t dapm_widget_show(struct device *dev,
  662. struct device_attribute *attr, char *buf)
  663. {
  664. struct snd_soc_device *devdata = dev_get_drvdata(dev);
  665. struct snd_soc_codec *codec = devdata->codec;
  666. struct snd_soc_dapm_widget *w;
  667. int count = 0;
  668. char *state = "not set";
  669. list_for_each_entry(w, &codec->dapm_widgets, list) {
  670. /* only display widgets that burnm power */
  671. switch (w->id) {
  672. case snd_soc_dapm_hp:
  673. case snd_soc_dapm_mic:
  674. case snd_soc_dapm_spk:
  675. case snd_soc_dapm_line:
  676. case snd_soc_dapm_micbias:
  677. case snd_soc_dapm_dac:
  678. case snd_soc_dapm_adc:
  679. case snd_soc_dapm_pga:
  680. case snd_soc_dapm_mixer:
  681. if (w->name)
  682. count += sprintf(buf + count, "%s: %s\n",
  683. w->name, w->power ? "On":"Off");
  684. break;
  685. default:
  686. break;
  687. }
  688. }
  689. switch (codec->bias_level) {
  690. case SND_SOC_BIAS_ON:
  691. state = "On";
  692. break;
  693. case SND_SOC_BIAS_PREPARE:
  694. state = "Prepare";
  695. break;
  696. case SND_SOC_BIAS_STANDBY:
  697. state = "Standby";
  698. break;
  699. case SND_SOC_BIAS_OFF:
  700. state = "Off";
  701. break;
  702. }
  703. count += sprintf(buf + count, "PM State: %s\n", state);
  704. return count;
  705. }
  706. static DEVICE_ATTR(dapm_widget, 0444, dapm_widget_show, NULL);
  707. /* pop/click delay times */
  708. static ssize_t dapm_pop_time_show(struct device *dev,
  709. struct device_attribute *attr, char *buf)
  710. {
  711. return sprintf(buf, "%d\n", pop_time);
  712. }
  713. static ssize_t dapm_pop_time_store(struct device *dev,
  714. struct device_attribute *attr,
  715. const char *buf, size_t count)
  716. {
  717. unsigned long val;
  718. if (strict_strtoul(buf, 10, &val) >= 0)
  719. pop_time = val;
  720. else
  721. printk(KERN_ERR "Unable to parse pop_time setting\n");
  722. return count;
  723. }
  724. static DEVICE_ATTR(dapm_pop_time, 0744, dapm_pop_time_show,
  725. dapm_pop_time_store);
  726. int snd_soc_dapm_sys_add(struct device *dev)
  727. {
  728. int ret = 0;
  729. if (dapm_status) {
  730. ret = device_create_file(dev, &dev_attr_dapm_widget);
  731. if (ret == 0)
  732. ret = device_create_file(dev, &dev_attr_dapm_pop_time);
  733. }
  734. return ret;
  735. }
  736. static void snd_soc_dapm_sys_remove(struct device *dev)
  737. {
  738. if (dapm_status) {
  739. device_remove_file(dev, &dev_attr_dapm_pop_time);
  740. device_remove_file(dev, &dev_attr_dapm_widget);
  741. }
  742. }
  743. /* free all dapm widgets and resources */
  744. static void dapm_free_widgets(struct snd_soc_codec *codec)
  745. {
  746. struct snd_soc_dapm_widget *w, *next_w;
  747. struct snd_soc_dapm_path *p, *next_p;
  748. list_for_each_entry_safe(w, next_w, &codec->dapm_widgets, list) {
  749. list_del(&w->list);
  750. kfree(w);
  751. }
  752. list_for_each_entry_safe(p, next_p, &codec->dapm_paths, list) {
  753. list_del(&p->list);
  754. kfree(p->long_name);
  755. kfree(p);
  756. }
  757. }
  758. static int snd_soc_dapm_set_pin(struct snd_soc_codec *codec,
  759. char *pin, int status)
  760. {
  761. struct snd_soc_dapm_widget *w;
  762. list_for_each_entry(w, &codec->dapm_widgets, list) {
  763. if (!strcmp(w->name, pin)) {
  764. pr_debug("dapm: %s: pin %s\n", codec->name, pin);
  765. w->connected = status;
  766. return 0;
  767. }
  768. }
  769. pr_err("dapm: %s: configuring unknown pin %s\n", codec->name, pin);
  770. return -EINVAL;
  771. }
  772. /**
  773. * snd_soc_dapm_sync - scan and power dapm paths
  774. * @codec: audio codec
  775. *
  776. * Walks all dapm audio paths and powers widgets according to their
  777. * stream or path usage.
  778. *
  779. * Returns 0 for success.
  780. */
  781. int snd_soc_dapm_sync(struct snd_soc_codec *codec)
  782. {
  783. int ret = dapm_power_widgets(codec, SND_SOC_DAPM_STREAM_NOP);
  784. dump_dapm(codec, "sync");
  785. return ret;
  786. }
  787. EXPORT_SYMBOL_GPL(snd_soc_dapm_sync);
  788. static int snd_soc_dapm_add_route(struct snd_soc_codec *codec,
  789. const char *sink, const char *control, const char *source)
  790. {
  791. struct snd_soc_dapm_path *path;
  792. struct snd_soc_dapm_widget *wsource = NULL, *wsink = NULL, *w;
  793. int ret = 0;
  794. /* find src and dest widgets */
  795. list_for_each_entry(w, &codec->dapm_widgets, list) {
  796. if (!wsink && !(strcmp(w->name, sink))) {
  797. wsink = w;
  798. continue;
  799. }
  800. if (!wsource && !(strcmp(w->name, source))) {
  801. wsource = w;
  802. }
  803. }
  804. if (wsource == NULL || wsink == NULL)
  805. return -ENODEV;
  806. path = kzalloc(sizeof(struct snd_soc_dapm_path), GFP_KERNEL);
  807. if (!path)
  808. return -ENOMEM;
  809. path->source = wsource;
  810. path->sink = wsink;
  811. INIT_LIST_HEAD(&path->list);
  812. INIT_LIST_HEAD(&path->list_source);
  813. INIT_LIST_HEAD(&path->list_sink);
  814. /* check for external widgets */
  815. if (wsink->id == snd_soc_dapm_input) {
  816. if (wsource->id == snd_soc_dapm_micbias ||
  817. wsource->id == snd_soc_dapm_mic ||
  818. wsink->id == snd_soc_dapm_line ||
  819. wsink->id == snd_soc_dapm_output)
  820. wsink->ext = 1;
  821. }
  822. if (wsource->id == snd_soc_dapm_output) {
  823. if (wsink->id == snd_soc_dapm_spk ||
  824. wsink->id == snd_soc_dapm_hp ||
  825. wsink->id == snd_soc_dapm_line ||
  826. wsink->id == snd_soc_dapm_input)
  827. wsource->ext = 1;
  828. }
  829. /* connect static paths */
  830. if (control == NULL) {
  831. list_add(&path->list, &codec->dapm_paths);
  832. list_add(&path->list_sink, &wsink->sources);
  833. list_add(&path->list_source, &wsource->sinks);
  834. path->connect = 1;
  835. return 0;
  836. }
  837. /* connect dynamic paths */
  838. switch(wsink->id) {
  839. case snd_soc_dapm_adc:
  840. case snd_soc_dapm_dac:
  841. case snd_soc_dapm_pga:
  842. case snd_soc_dapm_input:
  843. case snd_soc_dapm_output:
  844. case snd_soc_dapm_micbias:
  845. case snd_soc_dapm_vmid:
  846. case snd_soc_dapm_pre:
  847. case snd_soc_dapm_post:
  848. list_add(&path->list, &codec->dapm_paths);
  849. list_add(&path->list_sink, &wsink->sources);
  850. list_add(&path->list_source, &wsource->sinks);
  851. path->connect = 1;
  852. return 0;
  853. case snd_soc_dapm_mux:
  854. ret = dapm_connect_mux(codec, wsource, wsink, path, control,
  855. &wsink->kcontrols[0]);
  856. if (ret != 0)
  857. goto err;
  858. break;
  859. case snd_soc_dapm_switch:
  860. case snd_soc_dapm_mixer:
  861. ret = dapm_connect_mixer(codec, wsource, wsink, path, control);
  862. if (ret != 0)
  863. goto err;
  864. break;
  865. case snd_soc_dapm_hp:
  866. case snd_soc_dapm_mic:
  867. case snd_soc_dapm_line:
  868. case snd_soc_dapm_spk:
  869. list_add(&path->list, &codec->dapm_paths);
  870. list_add(&path->list_sink, &wsink->sources);
  871. list_add(&path->list_source, &wsource->sinks);
  872. path->connect = 0;
  873. return 0;
  874. }
  875. return 0;
  876. err:
  877. printk(KERN_WARNING "asoc: no dapm match for %s --> %s --> %s\n", source,
  878. control, sink);
  879. kfree(path);
  880. return ret;
  881. }
  882. /**
  883. * snd_soc_dapm_connect_input - connect dapm widgets
  884. * @codec: audio codec
  885. * @sink: name of target widget
  886. * @control: mixer control name
  887. * @source: name of source name
  888. *
  889. * Connects 2 dapm widgets together via a named audio path. The sink is
  890. * the widget receiving the audio signal, whilst the source is the sender
  891. * of the audio signal.
  892. *
  893. * This function has been deprecated in favour of snd_soc_dapm_add_routes().
  894. *
  895. * Returns 0 for success else error.
  896. */
  897. int snd_soc_dapm_connect_input(struct snd_soc_codec *codec, const char *sink,
  898. const char *control, const char *source)
  899. {
  900. return snd_soc_dapm_add_route(codec, sink, control, source);
  901. }
  902. EXPORT_SYMBOL_GPL(snd_soc_dapm_connect_input);
  903. /**
  904. * snd_soc_dapm_add_routes - Add routes between DAPM widgets
  905. * @codec: codec
  906. * @route: audio routes
  907. * @num: number of routes
  908. *
  909. * Connects 2 dapm widgets together via a named audio path. The sink is
  910. * the widget receiving the audio signal, whilst the source is the sender
  911. * of the audio signal.
  912. *
  913. * Returns 0 for success else error. On error all resources can be freed
  914. * with a call to snd_soc_card_free().
  915. */
  916. int snd_soc_dapm_add_routes(struct snd_soc_codec *codec,
  917. const struct snd_soc_dapm_route *route, int num)
  918. {
  919. int i, ret;
  920. for (i = 0; i < num; i++) {
  921. ret = snd_soc_dapm_add_route(codec, route->sink,
  922. route->control, route->source);
  923. if (ret < 0) {
  924. printk(KERN_ERR "Failed to add route %s->%s\n",
  925. route->source,
  926. route->sink);
  927. return ret;
  928. }
  929. route++;
  930. }
  931. return 0;
  932. }
  933. EXPORT_SYMBOL_GPL(snd_soc_dapm_add_routes);
  934. /**
  935. * snd_soc_dapm_new_widgets - add new dapm widgets
  936. * @codec: audio codec
  937. *
  938. * Checks the codec for any new dapm widgets and creates them if found.
  939. *
  940. * Returns 0 for success.
  941. */
  942. int snd_soc_dapm_new_widgets(struct snd_soc_codec *codec)
  943. {
  944. struct snd_soc_dapm_widget *w;
  945. list_for_each_entry(w, &codec->dapm_widgets, list)
  946. {
  947. if (w->new)
  948. continue;
  949. switch(w->id) {
  950. case snd_soc_dapm_switch:
  951. case snd_soc_dapm_mixer:
  952. dapm_new_mixer(codec, w);
  953. break;
  954. case snd_soc_dapm_mux:
  955. dapm_new_mux(codec, w);
  956. break;
  957. case snd_soc_dapm_adc:
  958. case snd_soc_dapm_dac:
  959. case snd_soc_dapm_pga:
  960. dapm_new_pga(codec, w);
  961. break;
  962. case snd_soc_dapm_input:
  963. case snd_soc_dapm_output:
  964. case snd_soc_dapm_micbias:
  965. case snd_soc_dapm_spk:
  966. case snd_soc_dapm_hp:
  967. case snd_soc_dapm_mic:
  968. case snd_soc_dapm_line:
  969. case snd_soc_dapm_vmid:
  970. case snd_soc_dapm_pre:
  971. case snd_soc_dapm_post:
  972. break;
  973. }
  974. w->new = 1;
  975. }
  976. dapm_power_widgets(codec, SND_SOC_DAPM_STREAM_NOP);
  977. return 0;
  978. }
  979. EXPORT_SYMBOL_GPL(snd_soc_dapm_new_widgets);
  980. /**
  981. * snd_soc_dapm_get_volsw - dapm mixer get callback
  982. * @kcontrol: mixer control
  983. * @uinfo: control element information
  984. *
  985. * Callback to get the value of a dapm mixer control.
  986. *
  987. * Returns 0 for success.
  988. */
  989. int snd_soc_dapm_get_volsw(struct snd_kcontrol *kcontrol,
  990. struct snd_ctl_elem_value *ucontrol)
  991. {
  992. struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
  993. int reg = kcontrol->private_value & 0xff;
  994. int shift = (kcontrol->private_value >> 8) & 0x0f;
  995. int rshift = (kcontrol->private_value >> 12) & 0x0f;
  996. int max = (kcontrol->private_value >> 16) & 0xff;
  997. int invert = (kcontrol->private_value >> 24) & 0x01;
  998. int mask = (1 << fls(max)) - 1;
  999. /* return the saved value if we are powered down */
  1000. if (widget->id == snd_soc_dapm_pga && !widget->power) {
  1001. ucontrol->value.integer.value[0] = widget->saved_value;
  1002. return 0;
  1003. }
  1004. ucontrol->value.integer.value[0] =
  1005. (snd_soc_read(widget->codec, reg) >> shift) & mask;
  1006. if (shift != rshift)
  1007. ucontrol->value.integer.value[1] =
  1008. (snd_soc_read(widget->codec, reg) >> rshift) & mask;
  1009. if (invert) {
  1010. ucontrol->value.integer.value[0] =
  1011. max - ucontrol->value.integer.value[0];
  1012. if (shift != rshift)
  1013. ucontrol->value.integer.value[1] =
  1014. max - ucontrol->value.integer.value[1];
  1015. }
  1016. return 0;
  1017. }
  1018. EXPORT_SYMBOL_GPL(snd_soc_dapm_get_volsw);
  1019. /**
  1020. * snd_soc_dapm_put_volsw - dapm mixer set callback
  1021. * @kcontrol: mixer control
  1022. * @uinfo: control element information
  1023. *
  1024. * Callback to set the value of a dapm mixer control.
  1025. *
  1026. * Returns 0 for success.
  1027. */
  1028. int snd_soc_dapm_put_volsw(struct snd_kcontrol *kcontrol,
  1029. struct snd_ctl_elem_value *ucontrol)
  1030. {
  1031. struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
  1032. int reg = kcontrol->private_value & 0xff;
  1033. int shift = (kcontrol->private_value >> 8) & 0x0f;
  1034. int rshift = (kcontrol->private_value >> 12) & 0x0f;
  1035. int max = (kcontrol->private_value >> 16) & 0xff;
  1036. int mask = (1 << fls(max)) - 1;
  1037. int invert = (kcontrol->private_value >> 24) & 0x01;
  1038. unsigned short val, val2, val_mask;
  1039. int ret;
  1040. val = (ucontrol->value.integer.value[0] & mask);
  1041. if (invert)
  1042. val = max - val;
  1043. val_mask = mask << shift;
  1044. val = val << shift;
  1045. if (shift != rshift) {
  1046. val2 = (ucontrol->value.integer.value[1] & mask);
  1047. if (invert)
  1048. val2 = max - val2;
  1049. val_mask |= mask << rshift;
  1050. val |= val2 << rshift;
  1051. }
  1052. mutex_lock(&widget->codec->mutex);
  1053. widget->value = val;
  1054. /* save volume value if the widget is powered down */
  1055. if (widget->id == snd_soc_dapm_pga && !widget->power) {
  1056. widget->saved_value = val;
  1057. mutex_unlock(&widget->codec->mutex);
  1058. return 1;
  1059. }
  1060. dapm_mixer_update_power(widget, kcontrol, reg, val_mask, val, invert);
  1061. if (widget->event) {
  1062. if (widget->event_flags & SND_SOC_DAPM_PRE_REG) {
  1063. ret = widget->event(widget, kcontrol,
  1064. SND_SOC_DAPM_PRE_REG);
  1065. if (ret < 0) {
  1066. ret = 1;
  1067. goto out;
  1068. }
  1069. }
  1070. ret = snd_soc_update_bits(widget->codec, reg, val_mask, val);
  1071. if (widget->event_flags & SND_SOC_DAPM_POST_REG)
  1072. ret = widget->event(widget, kcontrol,
  1073. SND_SOC_DAPM_POST_REG);
  1074. } else
  1075. ret = snd_soc_update_bits(widget->codec, reg, val_mask, val);
  1076. out:
  1077. mutex_unlock(&widget->codec->mutex);
  1078. return ret;
  1079. }
  1080. EXPORT_SYMBOL_GPL(snd_soc_dapm_put_volsw);
  1081. /**
  1082. * snd_soc_dapm_get_enum_double - dapm enumerated double mixer get callback
  1083. * @kcontrol: mixer control
  1084. * @uinfo: control element information
  1085. *
  1086. * Callback to get the value of a dapm enumerated double mixer control.
  1087. *
  1088. * Returns 0 for success.
  1089. */
  1090. int snd_soc_dapm_get_enum_double(struct snd_kcontrol *kcontrol,
  1091. struct snd_ctl_elem_value *ucontrol)
  1092. {
  1093. struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
  1094. struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
  1095. unsigned short val, bitmask;
  1096. for (bitmask = 1; bitmask < e->mask; bitmask <<= 1)
  1097. ;
  1098. val = snd_soc_read(widget->codec, e->reg);
  1099. ucontrol->value.enumerated.item[0] = (val >> e->shift_l) & (bitmask - 1);
  1100. if (e->shift_l != e->shift_r)
  1101. ucontrol->value.enumerated.item[1] =
  1102. (val >> e->shift_r) & (bitmask - 1);
  1103. return 0;
  1104. }
  1105. EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_double);
  1106. /**
  1107. * snd_soc_dapm_put_enum_double - dapm enumerated double mixer set callback
  1108. * @kcontrol: mixer control
  1109. * @uinfo: control element information
  1110. *
  1111. * Callback to set the value of a dapm enumerated double mixer control.
  1112. *
  1113. * Returns 0 for success.
  1114. */
  1115. int snd_soc_dapm_put_enum_double(struct snd_kcontrol *kcontrol,
  1116. struct snd_ctl_elem_value *ucontrol)
  1117. {
  1118. struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
  1119. struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
  1120. unsigned short val, mux;
  1121. unsigned short mask, bitmask;
  1122. int ret = 0;
  1123. for (bitmask = 1; bitmask < e->mask; bitmask <<= 1)
  1124. ;
  1125. if (ucontrol->value.enumerated.item[0] > e->mask - 1)
  1126. return -EINVAL;
  1127. mux = ucontrol->value.enumerated.item[0];
  1128. val = mux << e->shift_l;
  1129. mask = (bitmask - 1) << e->shift_l;
  1130. if (e->shift_l != e->shift_r) {
  1131. if (ucontrol->value.enumerated.item[1] > e->mask - 1)
  1132. return -EINVAL;
  1133. val |= ucontrol->value.enumerated.item[1] << e->shift_r;
  1134. mask |= (bitmask - 1) << e->shift_r;
  1135. }
  1136. mutex_lock(&widget->codec->mutex);
  1137. widget->value = val;
  1138. dapm_mux_update_power(widget, kcontrol, mask, mux, e);
  1139. if (widget->event) {
  1140. if (widget->event_flags & SND_SOC_DAPM_PRE_REG) {
  1141. ret = widget->event(widget,
  1142. kcontrol, SND_SOC_DAPM_PRE_REG);
  1143. if (ret < 0)
  1144. goto out;
  1145. }
  1146. ret = snd_soc_update_bits(widget->codec, e->reg, mask, val);
  1147. if (widget->event_flags & SND_SOC_DAPM_POST_REG)
  1148. ret = widget->event(widget,
  1149. kcontrol, SND_SOC_DAPM_POST_REG);
  1150. } else
  1151. ret = snd_soc_update_bits(widget->codec, e->reg, mask, val);
  1152. out:
  1153. mutex_unlock(&widget->codec->mutex);
  1154. return ret;
  1155. }
  1156. EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_double);
  1157. /**
  1158. * snd_soc_dapm_new_control - create new dapm control
  1159. * @codec: audio codec
  1160. * @widget: widget template
  1161. *
  1162. * Creates a new dapm control based upon the template.
  1163. *
  1164. * Returns 0 for success else error.
  1165. */
  1166. int snd_soc_dapm_new_control(struct snd_soc_codec *codec,
  1167. const struct snd_soc_dapm_widget *widget)
  1168. {
  1169. struct snd_soc_dapm_widget *w;
  1170. if ((w = dapm_cnew_widget(widget)) == NULL)
  1171. return -ENOMEM;
  1172. w->codec = codec;
  1173. INIT_LIST_HEAD(&w->sources);
  1174. INIT_LIST_HEAD(&w->sinks);
  1175. INIT_LIST_HEAD(&w->list);
  1176. list_add(&w->list, &codec->dapm_widgets);
  1177. /* machine layer set ups unconnected pins and insertions */
  1178. w->connected = 1;
  1179. return 0;
  1180. }
  1181. EXPORT_SYMBOL_GPL(snd_soc_dapm_new_control);
  1182. /**
  1183. * snd_soc_dapm_new_controls - create new dapm controls
  1184. * @codec: audio codec
  1185. * @widget: widget array
  1186. * @num: number of widgets
  1187. *
  1188. * Creates new DAPM controls based upon the templates.
  1189. *
  1190. * Returns 0 for success else error.
  1191. */
  1192. int snd_soc_dapm_new_controls(struct snd_soc_codec *codec,
  1193. const struct snd_soc_dapm_widget *widget,
  1194. int num)
  1195. {
  1196. int i, ret;
  1197. for (i = 0; i < num; i++) {
  1198. ret = snd_soc_dapm_new_control(codec, widget);
  1199. if (ret < 0)
  1200. return ret;
  1201. widget++;
  1202. }
  1203. return 0;
  1204. }
  1205. EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls);
  1206. /**
  1207. * snd_soc_dapm_stream_event - send a stream event to the dapm core
  1208. * @codec: audio codec
  1209. * @stream: stream name
  1210. * @event: stream event
  1211. *
  1212. * Sends a stream event to the dapm core. The core then makes any
  1213. * necessary widget power changes.
  1214. *
  1215. * Returns 0 for success else error.
  1216. */
  1217. int snd_soc_dapm_stream_event(struct snd_soc_codec *codec,
  1218. char *stream, int event)
  1219. {
  1220. struct snd_soc_dapm_widget *w;
  1221. if (stream == NULL)
  1222. return 0;
  1223. mutex_lock(&codec->mutex);
  1224. list_for_each_entry(w, &codec->dapm_widgets, list)
  1225. {
  1226. if (!w->sname)
  1227. continue;
  1228. pr_debug("widget %s\n %s stream %s event %d\n",
  1229. w->name, w->sname, stream, event);
  1230. if (strstr(w->sname, stream)) {
  1231. switch(event) {
  1232. case SND_SOC_DAPM_STREAM_START:
  1233. w->active = 1;
  1234. break;
  1235. case SND_SOC_DAPM_STREAM_STOP:
  1236. w->active = 0;
  1237. break;
  1238. case SND_SOC_DAPM_STREAM_SUSPEND:
  1239. if (w->active)
  1240. w->suspend = 1;
  1241. w->active = 0;
  1242. break;
  1243. case SND_SOC_DAPM_STREAM_RESUME:
  1244. if (w->suspend) {
  1245. w->active = 1;
  1246. w->suspend = 0;
  1247. }
  1248. break;
  1249. case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
  1250. break;
  1251. case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
  1252. break;
  1253. }
  1254. }
  1255. }
  1256. mutex_unlock(&codec->mutex);
  1257. dapm_power_widgets(codec, event);
  1258. dump_dapm(codec, __func__);
  1259. return 0;
  1260. }
  1261. EXPORT_SYMBOL_GPL(snd_soc_dapm_stream_event);
  1262. /**
  1263. * snd_soc_dapm_set_bias_level - set the bias level for the system
  1264. * @socdev: audio device
  1265. * @level: level to configure
  1266. *
  1267. * Configure the bias (power) levels for the SoC audio device.
  1268. *
  1269. * Returns 0 for success else error.
  1270. */
  1271. int snd_soc_dapm_set_bias_level(struct snd_soc_device *socdev,
  1272. enum snd_soc_bias_level level)
  1273. {
  1274. struct snd_soc_codec *codec = socdev->codec;
  1275. struct snd_soc_machine *machine = socdev->machine;
  1276. int ret = 0;
  1277. if (machine->set_bias_level)
  1278. ret = machine->set_bias_level(machine, level);
  1279. if (ret == 0 && codec->set_bias_level)
  1280. ret = codec->set_bias_level(codec, level);
  1281. return ret;
  1282. }
  1283. /**
  1284. * snd_soc_dapm_enable_pin - enable pin.
  1285. * @snd_soc_codec: SoC codec
  1286. * @pin: pin name
  1287. *
  1288. * Enables input/output pin and it's parents or children widgets iff there is
  1289. * a valid audio route and active audio stream.
  1290. * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
  1291. * do any widget power switching.
  1292. */
  1293. int snd_soc_dapm_enable_pin(struct snd_soc_codec *codec, char *pin)
  1294. {
  1295. return snd_soc_dapm_set_pin(codec, pin, 1);
  1296. }
  1297. EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin);
  1298. /**
  1299. * snd_soc_dapm_disable_pin - disable pin.
  1300. * @codec: SoC codec
  1301. * @pin: pin name
  1302. *
  1303. * Disables input/output pin and it's parents or children widgets.
  1304. * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
  1305. * do any widget power switching.
  1306. */
  1307. int snd_soc_dapm_disable_pin(struct snd_soc_codec *codec, char *pin)
  1308. {
  1309. return snd_soc_dapm_set_pin(codec, pin, 0);
  1310. }
  1311. EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin);
  1312. /**
  1313. * snd_soc_dapm_get_pin_status - get audio pin status
  1314. * @codec: audio codec
  1315. * @pin: audio signal pin endpoint (or start point)
  1316. *
  1317. * Get audio pin status - connected or disconnected.
  1318. *
  1319. * Returns 1 for connected otherwise 0.
  1320. */
  1321. int snd_soc_dapm_get_pin_status(struct snd_soc_codec *codec, char *pin)
  1322. {
  1323. struct snd_soc_dapm_widget *w;
  1324. list_for_each_entry(w, &codec->dapm_widgets, list) {
  1325. if (!strcmp(w->name, pin))
  1326. return w->connected;
  1327. }
  1328. return 0;
  1329. }
  1330. EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status);
  1331. /**
  1332. * snd_soc_dapm_free - free dapm resources
  1333. * @socdev: SoC device
  1334. *
  1335. * Free all dapm widgets and resources.
  1336. */
  1337. void snd_soc_dapm_free(struct snd_soc_device *socdev)
  1338. {
  1339. struct snd_soc_codec *codec = socdev->codec;
  1340. snd_soc_dapm_sys_remove(socdev->dev);
  1341. dapm_free_widgets(codec);
  1342. }
  1343. EXPORT_SYMBOL_GPL(snd_soc_dapm_free);
  1344. /* Module information */
  1345. MODULE_AUTHOR("Liam Girdwood, liam.girdwood@wolfsonmicro.com, www.wolfsonmicro.com");
  1346. MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC");
  1347. MODULE_LICENSE("GPL");