wm2000.c 22 KB

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