wm2000.c 22 KB

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