wm2000.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948
  1. /*
  2. * wm2000.c -- WM2000 ALSA Soc Audio driver
  3. *
  4. * Copyright 2008-2011 Wolfson Microelectronics PLC.
  5. *
  6. * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License version 2 as
  10. * published by the Free Software Foundation.
  11. *
  12. /*(DEBLOBBED)*/
  13. #include <linux/module.h>
  14. #include <linux/moduleparam.h>
  15. #include <linux/kernel.h>
  16. #include <linux/init.h>
  17. #include <linux/firmware.h>
  18. #include <linux/clk.h>
  19. #include <linux/delay.h>
  20. #include <linux/pm.h>
  21. #include <linux/i2c.h>
  22. #include <linux/regmap.h>
  23. #include <linux/debugfs.h>
  24. #include <linux/regulator/consumer.h>
  25. #include <linux/slab.h>
  26. #include <sound/core.h>
  27. #include <sound/pcm.h>
  28. #include <sound/pcm_params.h>
  29. #include <sound/soc.h>
  30. #include <sound/initval.h>
  31. #include <sound/tlv.h>
  32. #include <sound/wm2000.h>
  33. #include "wm2000.h"
  34. #define WM2000_NUM_SUPPLIES 3
  35. static const char *wm2000_supplies[WM2000_NUM_SUPPLIES] = {
  36. "SPKVDD",
  37. "DBVDD",
  38. "DCVDD",
  39. };
  40. enum wm2000_anc_mode {
  41. ANC_ACTIVE = 0,
  42. ANC_BYPASS = 1,
  43. ANC_STANDBY = 2,
  44. ANC_OFF = 3,
  45. };
  46. struct wm2000_priv {
  47. struct i2c_client *i2c;
  48. struct regmap *regmap;
  49. struct clk *mclk;
  50. struct regulator_bulk_data supplies[WM2000_NUM_SUPPLIES];
  51. enum wm2000_anc_mode anc_mode;
  52. unsigned int anc_active:1;
  53. unsigned int anc_eng_ena:1;
  54. unsigned int spk_ena:1;
  55. unsigned int speech_clarity:1;
  56. int anc_download_size;
  57. char *anc_download;
  58. struct mutex lock;
  59. };
  60. static int wm2000_write(struct i2c_client *i2c, unsigned int reg,
  61. unsigned int value)
  62. {
  63. struct wm2000_priv *wm2000 = i2c_get_clientdata(i2c);
  64. return regmap_write(wm2000->regmap, reg, value);
  65. }
  66. static unsigned int wm2000_read(struct i2c_client *i2c, unsigned int r)
  67. {
  68. struct wm2000_priv *wm2000 = i2c_get_clientdata(i2c);
  69. unsigned int val;
  70. int ret;
  71. ret = regmap_read(wm2000->regmap, r, &val);
  72. if (ret < 0)
  73. return -1;
  74. return val;
  75. }
  76. static void wm2000_reset(struct wm2000_priv *wm2000)
  77. {
  78. struct i2c_client *i2c = wm2000->i2c;
  79. wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_ENG_CLR);
  80. wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_CLR);
  81. wm2000_write(i2c, WM2000_REG_ID1, 0);
  82. wm2000->anc_mode = ANC_OFF;
  83. }
  84. static int wm2000_poll_bit(struct i2c_client *i2c,
  85. unsigned int reg, u8 mask)
  86. {
  87. int timeout = 4000;
  88. int val;
  89. val = wm2000_read(i2c, reg);
  90. while (!(val & mask) && --timeout) {
  91. msleep(1);
  92. val = wm2000_read(i2c, reg);
  93. }
  94. if (timeout == 0)
  95. return 0;
  96. else
  97. return 1;
  98. }
  99. static int wm2000_power_up(struct i2c_client *i2c, int analogue)
  100. {
  101. struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev);
  102. unsigned long rate;
  103. int ret;
  104. if (WARN_ON(wm2000->anc_mode != ANC_OFF))
  105. return -EINVAL;
  106. dev_dbg(&i2c->dev, "Beginning power up\n");
  107. ret = regulator_bulk_enable(WM2000_NUM_SUPPLIES, wm2000->supplies);
  108. if (ret != 0) {
  109. dev_err(&i2c->dev, "Failed to enable supplies: %d\n", ret);
  110. return ret;
  111. }
  112. rate = clk_get_rate(wm2000->mclk);
  113. if (rate <= 13500000) {
  114. dev_dbg(&i2c->dev, "Disabling MCLK divider\n");
  115. wm2000_write(i2c, WM2000_REG_SYS_CTL2,
  116. WM2000_MCLK_DIV2_ENA_CLR);
  117. } else {
  118. dev_dbg(&i2c->dev, "Enabling MCLK divider\n");
  119. wm2000_write(i2c, WM2000_REG_SYS_CTL2,
  120. WM2000_MCLK_DIV2_ENA_SET);
  121. }
  122. wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_ENG_CLR);
  123. wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_ENG_SET);
  124. /* Wait for ANC engine to become ready */
  125. if (!wm2000_poll_bit(i2c, WM2000_REG_ANC_STAT,
  126. WM2000_ANC_ENG_IDLE)) {
  127. dev_err(&i2c->dev, "ANC engine failed to reset\n");
  128. regulator_bulk_disable(WM2000_NUM_SUPPLIES, wm2000->supplies);
  129. return -ETIMEDOUT;
  130. }
  131. if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS,
  132. WM2000_STATUS_BOOT_COMPLETE)) {
  133. dev_err(&i2c->dev, "ANC engine failed to initialise\n");
  134. regulator_bulk_disable(WM2000_NUM_SUPPLIES, wm2000->supplies);
  135. return -ETIMEDOUT;
  136. }
  137. wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_SET);
  138. /* Open code download of the data since it is the only bulk
  139. * write we do. */
  140. dev_dbg(&i2c->dev, "Downloading %d bytes\n",
  141. wm2000->anc_download_size - 2);
  142. ret = i2c_master_send(i2c, wm2000->anc_download,
  143. wm2000->anc_download_size);
  144. if (ret < 0) {
  145. dev_err(&i2c->dev, "i2c_transfer() failed: %d\n", ret);
  146. regulator_bulk_disable(WM2000_NUM_SUPPLIES, wm2000->supplies);
  147. return ret;
  148. }
  149. if (ret != wm2000->anc_download_size) {
  150. dev_err(&i2c->dev, "i2c_transfer() failed, %d != %d\n",
  151. ret, wm2000->anc_download_size);
  152. regulator_bulk_disable(WM2000_NUM_SUPPLIES, wm2000->supplies);
  153. return -EIO;
  154. }
  155. dev_dbg(&i2c->dev, "Download complete\n");
  156. if (analogue) {
  157. wm2000_write(i2c, WM2000_REG_ANA_VMID_PU_TIME, 248 / 4);
  158. wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL,
  159. WM2000_MODE_ANA_SEQ_INCLUDE |
  160. WM2000_MODE_MOUSE_ENABLE |
  161. WM2000_MODE_THERMAL_ENABLE);
  162. } else {
  163. wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL,
  164. WM2000_MODE_MOUSE_ENABLE |
  165. WM2000_MODE_THERMAL_ENABLE);
  166. }
  167. ret = wm2000_read(i2c, WM2000_REG_SPEECH_CLARITY);
  168. if (wm2000->speech_clarity)
  169. ret |= WM2000_SPEECH_CLARITY;
  170. else
  171. ret &= ~WM2000_SPEECH_CLARITY;
  172. wm2000_write(i2c, WM2000_REG_SPEECH_CLARITY, ret);
  173. wm2000_write(i2c, WM2000_REG_SYS_START0, 0x33);
  174. wm2000_write(i2c, WM2000_REG_SYS_START1, 0x02);
  175. wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_INT_N_CLR);
  176. if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS,
  177. WM2000_STATUS_MOUSE_ACTIVE)) {
  178. dev_err(&i2c->dev, "Timed out waiting for device\n");
  179. regulator_bulk_disable(WM2000_NUM_SUPPLIES, wm2000->supplies);
  180. return -ETIMEDOUT;
  181. }
  182. dev_dbg(&i2c->dev, "ANC active\n");
  183. if (analogue)
  184. dev_dbg(&i2c->dev, "Analogue active\n");
  185. wm2000->anc_mode = ANC_ACTIVE;
  186. return 0;
  187. }
  188. static int wm2000_power_down(struct i2c_client *i2c, int analogue)
  189. {
  190. struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev);
  191. if (analogue) {
  192. wm2000_write(i2c, WM2000_REG_ANA_VMID_PD_TIME, 248 / 4);
  193. wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL,
  194. WM2000_MODE_ANA_SEQ_INCLUDE |
  195. WM2000_MODE_POWER_DOWN);
  196. } else {
  197. wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL,
  198. WM2000_MODE_POWER_DOWN);
  199. }
  200. if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS,
  201. WM2000_STATUS_POWER_DOWN_COMPLETE)) {
  202. dev_err(&i2c->dev, "Timeout waiting for ANC power down\n");
  203. return -ETIMEDOUT;
  204. }
  205. if (!wm2000_poll_bit(i2c, WM2000_REG_ANC_STAT,
  206. WM2000_ANC_ENG_IDLE)) {
  207. dev_err(&i2c->dev, "Timeout waiting for ANC engine idle\n");
  208. return -ETIMEDOUT;
  209. }
  210. regulator_bulk_disable(WM2000_NUM_SUPPLIES, wm2000->supplies);
  211. dev_dbg(&i2c->dev, "powered off\n");
  212. wm2000->anc_mode = ANC_OFF;
  213. return 0;
  214. }
  215. static int wm2000_enter_bypass(struct i2c_client *i2c, int analogue)
  216. {
  217. struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev);
  218. if (WARN_ON(wm2000->anc_mode != ANC_ACTIVE))
  219. return -EINVAL;
  220. if (analogue) {
  221. wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL,
  222. WM2000_MODE_ANA_SEQ_INCLUDE |
  223. WM2000_MODE_THERMAL_ENABLE |
  224. WM2000_MODE_BYPASS_ENTRY);
  225. } else {
  226. wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL,
  227. WM2000_MODE_THERMAL_ENABLE |
  228. WM2000_MODE_BYPASS_ENTRY);
  229. }
  230. if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS,
  231. WM2000_STATUS_ANC_DISABLED)) {
  232. dev_err(&i2c->dev, "Timeout waiting for ANC disable\n");
  233. return -ETIMEDOUT;
  234. }
  235. if (!wm2000_poll_bit(i2c, WM2000_REG_ANC_STAT,
  236. WM2000_ANC_ENG_IDLE)) {
  237. dev_err(&i2c->dev, "Timeout waiting for ANC engine idle\n");
  238. return -ETIMEDOUT;
  239. }
  240. wm2000_write(i2c, WM2000_REG_SYS_CTL1, WM2000_SYS_STBY);
  241. wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_CLR);
  242. wm2000->anc_mode = ANC_BYPASS;
  243. dev_dbg(&i2c->dev, "bypass enabled\n");
  244. return 0;
  245. }
  246. static int wm2000_exit_bypass(struct i2c_client *i2c, int analogue)
  247. {
  248. struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev);
  249. if (WARN_ON(wm2000->anc_mode != ANC_BYPASS))
  250. return -EINVAL;
  251. wm2000_write(i2c, WM2000_REG_SYS_CTL1, 0);
  252. if (analogue) {
  253. wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL,
  254. WM2000_MODE_ANA_SEQ_INCLUDE |
  255. WM2000_MODE_MOUSE_ENABLE |
  256. WM2000_MODE_THERMAL_ENABLE);
  257. } else {
  258. wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL,
  259. WM2000_MODE_MOUSE_ENABLE |
  260. WM2000_MODE_THERMAL_ENABLE);
  261. }
  262. wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_SET);
  263. wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_INT_N_CLR);
  264. if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS,
  265. WM2000_STATUS_MOUSE_ACTIVE)) {
  266. dev_err(&i2c->dev, "Timed out waiting for MOUSE\n");
  267. return -ETIMEDOUT;
  268. }
  269. wm2000->anc_mode = ANC_ACTIVE;
  270. dev_dbg(&i2c->dev, "MOUSE active\n");
  271. return 0;
  272. }
  273. static int wm2000_enter_standby(struct i2c_client *i2c, int analogue)
  274. {
  275. struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev);
  276. if (WARN_ON(wm2000->anc_mode != ANC_ACTIVE))
  277. return -EINVAL;
  278. if (analogue) {
  279. wm2000_write(i2c, WM2000_REG_ANA_VMID_PD_TIME, 248 / 4);
  280. wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL,
  281. WM2000_MODE_ANA_SEQ_INCLUDE |
  282. WM2000_MODE_THERMAL_ENABLE |
  283. WM2000_MODE_STANDBY_ENTRY);
  284. } else {
  285. wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL,
  286. WM2000_MODE_THERMAL_ENABLE |
  287. WM2000_MODE_STANDBY_ENTRY);
  288. }
  289. if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS,
  290. WM2000_STATUS_ANC_DISABLED)) {
  291. dev_err(&i2c->dev,
  292. "Timed out waiting for ANC disable after 1ms\n");
  293. return -ETIMEDOUT;
  294. }
  295. if (!wm2000_poll_bit(i2c, WM2000_REG_ANC_STAT, WM2000_ANC_ENG_IDLE)) {
  296. dev_err(&i2c->dev,
  297. "Timed out waiting for standby\n");
  298. return -ETIMEDOUT;
  299. }
  300. wm2000_write(i2c, WM2000_REG_SYS_CTL1, WM2000_SYS_STBY);
  301. wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_CLR);
  302. wm2000->anc_mode = ANC_STANDBY;
  303. dev_dbg(&i2c->dev, "standby\n");
  304. if (analogue)
  305. dev_dbg(&i2c->dev, "Analogue disabled\n");
  306. return 0;
  307. }
  308. static int wm2000_exit_standby(struct i2c_client *i2c, int analogue)
  309. {
  310. struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev);
  311. if (WARN_ON(wm2000->anc_mode != ANC_STANDBY))
  312. return -EINVAL;
  313. wm2000_write(i2c, WM2000_REG_SYS_CTL1, 0);
  314. if (analogue) {
  315. wm2000_write(i2c, WM2000_REG_ANA_VMID_PU_TIME, 248 / 4);
  316. wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL,
  317. WM2000_MODE_ANA_SEQ_INCLUDE |
  318. WM2000_MODE_THERMAL_ENABLE |
  319. WM2000_MODE_MOUSE_ENABLE);
  320. } else {
  321. wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL,
  322. WM2000_MODE_THERMAL_ENABLE |
  323. WM2000_MODE_MOUSE_ENABLE);
  324. }
  325. wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_SET);
  326. wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_INT_N_CLR);
  327. if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS,
  328. WM2000_STATUS_MOUSE_ACTIVE)) {
  329. dev_err(&i2c->dev, "Timed out waiting for MOUSE\n");
  330. return -ETIMEDOUT;
  331. }
  332. wm2000->anc_mode = ANC_ACTIVE;
  333. dev_dbg(&i2c->dev, "MOUSE active\n");
  334. if (analogue)
  335. dev_dbg(&i2c->dev, "Analogue enabled\n");
  336. return 0;
  337. }
  338. typedef int (*wm2000_mode_fn)(struct i2c_client *i2c, int analogue);
  339. static struct {
  340. enum wm2000_anc_mode source;
  341. enum wm2000_anc_mode dest;
  342. int analogue;
  343. wm2000_mode_fn step[2];
  344. } anc_transitions[] = {
  345. {
  346. .source = ANC_OFF,
  347. .dest = ANC_ACTIVE,
  348. .analogue = 1,
  349. .step = {
  350. wm2000_power_up,
  351. },
  352. },
  353. {
  354. .source = ANC_OFF,
  355. .dest = ANC_STANDBY,
  356. .step = {
  357. wm2000_power_up,
  358. wm2000_enter_standby,
  359. },
  360. },
  361. {
  362. .source = ANC_OFF,
  363. .dest = ANC_BYPASS,
  364. .analogue = 1,
  365. .step = {
  366. wm2000_power_up,
  367. wm2000_enter_bypass,
  368. },
  369. },
  370. {
  371. .source = ANC_ACTIVE,
  372. .dest = ANC_BYPASS,
  373. .analogue = 1,
  374. .step = {
  375. wm2000_enter_bypass,
  376. },
  377. },
  378. {
  379. .source = ANC_ACTIVE,
  380. .dest = ANC_STANDBY,
  381. .analogue = 1,
  382. .step = {
  383. wm2000_enter_standby,
  384. },
  385. },
  386. {
  387. .source = ANC_ACTIVE,
  388. .dest = ANC_OFF,
  389. .analogue = 1,
  390. .step = {
  391. wm2000_power_down,
  392. },
  393. },
  394. {
  395. .source = ANC_BYPASS,
  396. .dest = ANC_ACTIVE,
  397. .analogue = 1,
  398. .step = {
  399. wm2000_exit_bypass,
  400. },
  401. },
  402. {
  403. .source = ANC_BYPASS,
  404. .dest = ANC_STANDBY,
  405. .analogue = 1,
  406. .step = {
  407. wm2000_exit_bypass,
  408. wm2000_enter_standby,
  409. },
  410. },
  411. {
  412. .source = ANC_BYPASS,
  413. .dest = ANC_OFF,
  414. .step = {
  415. wm2000_exit_bypass,
  416. wm2000_power_down,
  417. },
  418. },
  419. {
  420. .source = ANC_STANDBY,
  421. .dest = ANC_ACTIVE,
  422. .analogue = 1,
  423. .step = {
  424. wm2000_exit_standby,
  425. },
  426. },
  427. {
  428. .source = ANC_STANDBY,
  429. .dest = ANC_BYPASS,
  430. .analogue = 1,
  431. .step = {
  432. wm2000_exit_standby,
  433. wm2000_enter_bypass,
  434. },
  435. },
  436. {
  437. .source = ANC_STANDBY,
  438. .dest = ANC_OFF,
  439. .step = {
  440. wm2000_exit_standby,
  441. wm2000_power_down,
  442. },
  443. },
  444. };
  445. static int wm2000_anc_transition(struct wm2000_priv *wm2000,
  446. enum wm2000_anc_mode mode)
  447. {
  448. struct i2c_client *i2c = wm2000->i2c;
  449. int i, j;
  450. int ret;
  451. if (wm2000->anc_mode == mode)
  452. return 0;
  453. for (i = 0; i < ARRAY_SIZE(anc_transitions); i++)
  454. if (anc_transitions[i].source == wm2000->anc_mode &&
  455. anc_transitions[i].dest == mode)
  456. break;
  457. if (i == ARRAY_SIZE(anc_transitions)) {
  458. dev_err(&i2c->dev, "No transition for %d->%d\n",
  459. wm2000->anc_mode, mode);
  460. return -EINVAL;
  461. }
  462. /* Maintain clock while active */
  463. if (anc_transitions[i].source == ANC_OFF) {
  464. ret = clk_prepare_enable(wm2000->mclk);
  465. if (ret != 0) {
  466. dev_err(&i2c->dev, "Failed to enable MCLK: %d\n", ret);
  467. return ret;
  468. }
  469. }
  470. for (j = 0; j < ARRAY_SIZE(anc_transitions[j].step); j++) {
  471. if (!anc_transitions[i].step[j])
  472. break;
  473. ret = anc_transitions[i].step[j](i2c,
  474. anc_transitions[i].analogue);
  475. if (ret != 0)
  476. return ret;
  477. }
  478. if (anc_transitions[i].dest == ANC_OFF)
  479. clk_disable_unprepare(wm2000->mclk);
  480. return 0;
  481. }
  482. static int wm2000_anc_set_mode(struct wm2000_priv *wm2000)
  483. {
  484. struct i2c_client *i2c = wm2000->i2c;
  485. enum wm2000_anc_mode mode;
  486. if (wm2000->anc_eng_ena && wm2000->spk_ena)
  487. if (wm2000->anc_active)
  488. mode = ANC_ACTIVE;
  489. else
  490. mode = ANC_BYPASS;
  491. else
  492. mode = ANC_STANDBY;
  493. dev_dbg(&i2c->dev, "Set mode %d (enabled %d, mute %d, active %d)\n",
  494. mode, wm2000->anc_eng_ena, !wm2000->spk_ena,
  495. wm2000->anc_active);
  496. return wm2000_anc_transition(wm2000, mode);
  497. }
  498. static int wm2000_anc_mode_get(struct snd_kcontrol *kcontrol,
  499. struct snd_ctl_elem_value *ucontrol)
  500. {
  501. struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
  502. struct wm2000_priv *wm2000 = dev_get_drvdata(codec->dev);
  503. ucontrol->value.integer.value[0] = wm2000->anc_active;
  504. return 0;
  505. }
  506. static int wm2000_anc_mode_put(struct snd_kcontrol *kcontrol,
  507. struct snd_ctl_elem_value *ucontrol)
  508. {
  509. struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
  510. struct wm2000_priv *wm2000 = dev_get_drvdata(codec->dev);
  511. unsigned int anc_active = ucontrol->value.integer.value[0];
  512. int ret;
  513. if (anc_active > 1)
  514. return -EINVAL;
  515. mutex_lock(&wm2000->lock);
  516. wm2000->anc_active = anc_active;
  517. ret = wm2000_anc_set_mode(wm2000);
  518. mutex_unlock(&wm2000->lock);
  519. return ret;
  520. }
  521. static int wm2000_speaker_get(struct snd_kcontrol *kcontrol,
  522. struct snd_ctl_elem_value *ucontrol)
  523. {
  524. struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
  525. struct wm2000_priv *wm2000 = dev_get_drvdata(codec->dev);
  526. ucontrol->value.integer.value[0] = wm2000->spk_ena;
  527. return 0;
  528. }
  529. static int wm2000_speaker_put(struct snd_kcontrol *kcontrol,
  530. struct snd_ctl_elem_value *ucontrol)
  531. {
  532. struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
  533. struct wm2000_priv *wm2000 = dev_get_drvdata(codec->dev);
  534. unsigned int val = ucontrol->value.integer.value[0];
  535. int ret;
  536. if (val > 1)
  537. return -EINVAL;
  538. mutex_lock(&wm2000->lock);
  539. wm2000->spk_ena = val;
  540. ret = wm2000_anc_set_mode(wm2000);
  541. mutex_unlock(&wm2000->lock);
  542. return ret;
  543. }
  544. static const struct snd_kcontrol_new wm2000_controls[] = {
  545. SOC_SINGLE("ANC Volume", WM2000_REG_ANC_GAIN_CTRL, 0, 255, 0),
  546. SOC_SINGLE_BOOL_EXT("WM2000 ANC Switch", 0,
  547. wm2000_anc_mode_get,
  548. wm2000_anc_mode_put),
  549. SOC_SINGLE_BOOL_EXT("WM2000 Switch", 0,
  550. wm2000_speaker_get,
  551. wm2000_speaker_put),
  552. };
  553. static int wm2000_anc_power_event(struct snd_soc_dapm_widget *w,
  554. struct snd_kcontrol *kcontrol, int event)
  555. {
  556. struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
  557. struct wm2000_priv *wm2000 = dev_get_drvdata(codec->dev);
  558. int ret;
  559. mutex_lock(&wm2000->lock);
  560. if (SND_SOC_DAPM_EVENT_ON(event))
  561. wm2000->anc_eng_ena = 1;
  562. if (SND_SOC_DAPM_EVENT_OFF(event))
  563. wm2000->anc_eng_ena = 0;
  564. ret = wm2000_anc_set_mode(wm2000);
  565. mutex_unlock(&wm2000->lock);
  566. return ret;
  567. }
  568. static const struct snd_soc_dapm_widget wm2000_dapm_widgets[] = {
  569. /* Externally visible pins */
  570. SND_SOC_DAPM_OUTPUT("SPKN"),
  571. SND_SOC_DAPM_OUTPUT("SPKP"),
  572. SND_SOC_DAPM_INPUT("LINN"),
  573. SND_SOC_DAPM_INPUT("LINP"),
  574. SND_SOC_DAPM_PGA_E("ANC Engine", SND_SOC_NOPM, 0, 0, NULL, 0,
  575. wm2000_anc_power_event,
  576. SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
  577. };
  578. /* Target, Path, Source */
  579. static const struct snd_soc_dapm_route wm2000_audio_map[] = {
  580. { "SPKN", NULL, "ANC Engine" },
  581. { "SPKP", NULL, "ANC Engine" },
  582. { "ANC Engine", NULL, "LINN" },
  583. { "ANC Engine", NULL, "LINP" },
  584. };
  585. #ifdef CONFIG_PM
  586. static int wm2000_suspend(struct snd_soc_codec *codec)
  587. {
  588. struct wm2000_priv *wm2000 = dev_get_drvdata(codec->dev);
  589. return wm2000_anc_transition(wm2000, ANC_OFF);
  590. }
  591. static int wm2000_resume(struct snd_soc_codec *codec)
  592. {
  593. struct wm2000_priv *wm2000 = dev_get_drvdata(codec->dev);
  594. return wm2000_anc_set_mode(wm2000);
  595. }
  596. #else
  597. #define wm2000_suspend NULL
  598. #define wm2000_resume NULL
  599. #endif
  600. static bool wm2000_readable_reg(struct device *dev, unsigned int reg)
  601. {
  602. switch (reg) {
  603. case WM2000_REG_SYS_START:
  604. case WM2000_REG_ANC_GAIN_CTRL:
  605. case WM2000_REG_MSE_TH1:
  606. case WM2000_REG_MSE_TH2:
  607. case WM2000_REG_SPEECH_CLARITY:
  608. case WM2000_REG_SYS_WATCHDOG:
  609. case WM2000_REG_ANA_VMID_PD_TIME:
  610. case WM2000_REG_ANA_VMID_PU_TIME:
  611. case WM2000_REG_CAT_FLTR_INDX:
  612. case WM2000_REG_CAT_GAIN_0:
  613. case WM2000_REG_SYS_STATUS:
  614. case WM2000_REG_SYS_MODE_CNTRL:
  615. case WM2000_REG_SYS_START0:
  616. case WM2000_REG_SYS_START1:
  617. case WM2000_REG_ID1:
  618. case WM2000_REG_ID2:
  619. case WM2000_REG_REVISON:
  620. case WM2000_REG_SYS_CTL1:
  621. case WM2000_REG_SYS_CTL2:
  622. case WM2000_REG_ANC_STAT:
  623. case WM2000_REG_IF_CTL:
  624. case WM2000_REG_ANA_MIC_CTL:
  625. case WM2000_REG_SPK_CTL:
  626. return true;
  627. default:
  628. return false;
  629. }
  630. }
  631. static const struct regmap_config wm2000_regmap = {
  632. .reg_bits = 16,
  633. .val_bits = 8,
  634. .max_register = WM2000_REG_SPK_CTL,
  635. .readable_reg = wm2000_readable_reg,
  636. };
  637. static int wm2000_probe(struct snd_soc_codec *codec)
  638. {
  639. struct wm2000_priv *wm2000 = dev_get_drvdata(codec->dev);
  640. /* This will trigger a transition to standby mode by default */
  641. wm2000_anc_set_mode(wm2000);
  642. return 0;
  643. }
  644. static int wm2000_remove(struct snd_soc_codec *codec)
  645. {
  646. struct wm2000_priv *wm2000 = dev_get_drvdata(codec->dev);
  647. return wm2000_anc_transition(wm2000, ANC_OFF);
  648. }
  649. static const struct snd_soc_codec_driver soc_codec_dev_wm2000 = {
  650. .probe = wm2000_probe,
  651. .remove = wm2000_remove,
  652. .suspend = wm2000_suspend,
  653. .resume = wm2000_resume,
  654. .component_driver = {
  655. .controls = wm2000_controls,
  656. .num_controls = ARRAY_SIZE(wm2000_controls),
  657. .dapm_widgets = wm2000_dapm_widgets,
  658. .num_dapm_widgets = ARRAY_SIZE(wm2000_dapm_widgets),
  659. .dapm_routes = wm2000_audio_map,
  660. .num_dapm_routes = ARRAY_SIZE(wm2000_audio_map),
  661. },
  662. };
  663. static int wm2000_i2c_probe(struct i2c_client *i2c,
  664. const struct i2c_device_id *i2c_id)
  665. {
  666. struct wm2000_priv *wm2000;
  667. struct wm2000_platform_data *pdata;
  668. const char *filename;
  669. const struct firmware *fw = NULL;
  670. int ret, i;
  671. int reg;
  672. u16 id;
  673. wm2000 = devm_kzalloc(&i2c->dev, sizeof(struct wm2000_priv),
  674. GFP_KERNEL);
  675. if (!wm2000)
  676. return -ENOMEM;
  677. mutex_init(&wm2000->lock);
  678. dev_set_drvdata(&i2c->dev, wm2000);
  679. wm2000->regmap = devm_regmap_init_i2c(i2c, &wm2000_regmap);
  680. if (IS_ERR(wm2000->regmap)) {
  681. ret = PTR_ERR(wm2000->regmap);
  682. dev_err(&i2c->dev, "Failed to allocate register map: %d\n",
  683. ret);
  684. goto out;
  685. }
  686. for (i = 0; i < WM2000_NUM_SUPPLIES; i++)
  687. wm2000->supplies[i].supply = wm2000_supplies[i];
  688. ret = devm_regulator_bulk_get(&i2c->dev, WM2000_NUM_SUPPLIES,
  689. wm2000->supplies);
  690. if (ret != 0) {
  691. dev_err(&i2c->dev, "Failed to get supplies: %d\n", ret);
  692. return ret;
  693. }
  694. ret = regulator_bulk_enable(WM2000_NUM_SUPPLIES, wm2000->supplies);
  695. if (ret != 0) {
  696. dev_err(&i2c->dev, "Failed to enable supplies: %d\n", ret);
  697. return ret;
  698. }
  699. /* Verify that this is a WM2000 */
  700. reg = wm2000_read(i2c, WM2000_REG_ID1);
  701. id = reg << 8;
  702. reg = wm2000_read(i2c, WM2000_REG_ID2);
  703. id |= reg & 0xff;
  704. if (id != 0x2000) {
  705. dev_err(&i2c->dev, "Device is not a WM2000 - ID %x\n", id);
  706. ret = -ENODEV;
  707. goto err_supplies;
  708. }
  709. reg = wm2000_read(i2c, WM2000_REG_REVISON);
  710. dev_info(&i2c->dev, "revision %c\n", reg + 'A');
  711. wm2000->mclk = devm_clk_get(&i2c->dev, "MCLK");
  712. if (IS_ERR(wm2000->mclk)) {
  713. ret = PTR_ERR(wm2000->mclk);
  714. dev_err(&i2c->dev, "Failed to get MCLK: %d\n", ret);
  715. goto err_supplies;
  716. }
  717. filename = "/*(DEBLOBBED)*/";
  718. pdata = dev_get_platdata(&i2c->dev);
  719. if (pdata) {
  720. wm2000->speech_clarity = !pdata->speech_enh_disable;
  721. if (pdata->download_file)
  722. filename = pdata->download_file;
  723. }
  724. ret = reject_firmware(&fw, filename, &i2c->dev);
  725. if (ret != 0) {
  726. dev_err(&i2c->dev, "Failed to acquire ANC data: %d\n", ret);
  727. goto err_supplies;
  728. }
  729. /* Pre-cook the concatenation of the register address onto the image */
  730. wm2000->anc_download_size = fw->size + 2;
  731. wm2000->anc_download = devm_kzalloc(&i2c->dev,
  732. wm2000->anc_download_size,
  733. GFP_KERNEL);
  734. if (wm2000->anc_download == NULL) {
  735. dev_err(&i2c->dev, "Out of memory\n");
  736. ret = -ENOMEM;
  737. goto err_supplies;
  738. }
  739. wm2000->anc_download[0] = 0x80;
  740. wm2000->anc_download[1] = 0x00;
  741. memcpy(wm2000->anc_download + 2, fw->data, fw->size);
  742. wm2000->anc_eng_ena = 1;
  743. wm2000->anc_active = 1;
  744. wm2000->spk_ena = 1;
  745. wm2000->i2c = i2c;
  746. wm2000_reset(wm2000);
  747. ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_wm2000, NULL, 0);
  748. err_supplies:
  749. regulator_bulk_disable(WM2000_NUM_SUPPLIES, wm2000->supplies);
  750. out:
  751. release_firmware(fw);
  752. return ret;
  753. }
  754. static int wm2000_i2c_remove(struct i2c_client *i2c)
  755. {
  756. snd_soc_unregister_codec(&i2c->dev);
  757. return 0;
  758. }
  759. static const struct i2c_device_id wm2000_i2c_id[] = {
  760. { "wm2000", 0 },
  761. { }
  762. };
  763. MODULE_DEVICE_TABLE(i2c, wm2000_i2c_id);
  764. static struct i2c_driver wm2000_i2c_driver = {
  765. .driver = {
  766. .name = "wm2000",
  767. },
  768. .probe = wm2000_i2c_probe,
  769. .remove = wm2000_i2c_remove,
  770. .id_table = wm2000_i2c_id,
  771. };
  772. module_i2c_driver(wm2000_i2c_driver);
  773. MODULE_DESCRIPTION("ASoC WM2000 driver");
  774. MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfonmicro.com>");
  775. MODULE_LICENSE("GPL");