ssm2602.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776
  1. /*
  2. * File: sound/soc/codecs/ssm2602.c
  3. * Author: Cliff Cai <Cliff.Cai@analog.com>
  4. *
  5. * Created: Tue June 06 2008
  6. * Description: Driver for ssm2602 sound chip
  7. *
  8. * Modified:
  9. * Copyright 2008 Analog Devices Inc.
  10. *
  11. * Bugs: Enter bugs at http://blackfin.uclinux.org/
  12. *
  13. * This program is free software; you can redistribute it and/or modify
  14. * it under the terms of the GNU General Public License as published by
  15. * the Free Software Foundation; either version 2 of the License, or
  16. * (at your option) any later version.
  17. *
  18. * This program is distributed in the hope that it will be useful,
  19. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  20. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  21. * GNU General Public License for more details.
  22. *
  23. * You should have received a copy of the GNU General Public License
  24. * along with this program; if not, see the file COPYING, or write
  25. * to the Free Software Foundation, Inc.,
  26. * 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
  27. */
  28. #include <linux/module.h>
  29. #include <linux/moduleparam.h>
  30. #include <linux/init.h>
  31. #include <linux/delay.h>
  32. #include <linux/pm.h>
  33. #include <linux/i2c.h>
  34. #include <linux/platform_device.h>
  35. #include <sound/core.h>
  36. #include <sound/pcm.h>
  37. #include <sound/pcm_params.h>
  38. #include <sound/soc.h>
  39. #include <sound/soc-dapm.h>
  40. #include <sound/initval.h>
  41. #include "ssm2602.h"
  42. #define AUDIO_NAME "ssm2602"
  43. #define SSM2602_VERSION "0.1"
  44. struct snd_soc_codec_device soc_codec_dev_ssm2602;
  45. /* codec private data */
  46. struct ssm2602_priv {
  47. unsigned int sysclk;
  48. struct snd_pcm_substream *master_substream;
  49. struct snd_pcm_substream *slave_substream;
  50. };
  51. /*
  52. * ssm2602 register cache
  53. * We can't read the ssm2602 register space when we are
  54. * using 2 wire for device control, so we cache them instead.
  55. * There is no point in caching the reset register
  56. */
  57. static const u16 ssm2602_reg[SSM2602_CACHEREGNUM] = {
  58. 0x0017, 0x0017, 0x0079, 0x0079,
  59. 0x0000, 0x0000, 0x0000, 0x000a,
  60. 0x0000, 0x0000
  61. };
  62. /*
  63. * read ssm2602 register cache
  64. */
  65. static inline unsigned int ssm2602_read_reg_cache(struct snd_soc_codec *codec,
  66. unsigned int reg)
  67. {
  68. u16 *cache = codec->reg_cache;
  69. if (reg == SSM2602_RESET)
  70. return 0;
  71. if (reg >= SSM2602_CACHEREGNUM)
  72. return -1;
  73. return cache[reg];
  74. }
  75. /*
  76. * write ssm2602 register cache
  77. */
  78. static inline void ssm2602_write_reg_cache(struct snd_soc_codec *codec,
  79. u16 reg, unsigned int value)
  80. {
  81. u16 *cache = codec->reg_cache;
  82. if (reg >= SSM2602_CACHEREGNUM)
  83. return;
  84. cache[reg] = value;
  85. }
  86. /*
  87. * write to the ssm2602 register space
  88. */
  89. static int ssm2602_write(struct snd_soc_codec *codec, unsigned int reg,
  90. unsigned int value)
  91. {
  92. u8 data[2];
  93. /* data is
  94. * D15..D9 ssm2602 register offset
  95. * D8...D0 register data
  96. */
  97. data[0] = (reg << 1) | ((value >> 8) & 0x0001);
  98. data[1] = value & 0x00ff;
  99. ssm2602_write_reg_cache(codec, reg, value);
  100. if (codec->hw_write(codec->control_data, data, 2) == 2)
  101. return 0;
  102. else
  103. return -EIO;
  104. }
  105. #define ssm2602_reset(c) ssm2602_write(c, SSM2602_RESET, 0)
  106. /*Appending several "None"s just for OSS mixer use*/
  107. static const char *ssm2602_input_select[] = {
  108. "Line", "Mic", "None", "None", "None",
  109. "None", "None", "None",
  110. };
  111. static const char *ssm2602_deemph[] = {"None", "32Khz", "44.1Khz", "48Khz"};
  112. static const struct soc_enum ssm2602_enum[] = {
  113. SOC_ENUM_SINGLE(SSM2602_APANA, 2, 2, ssm2602_input_select),
  114. SOC_ENUM_SINGLE(SSM2602_APDIGI, 1, 4, ssm2602_deemph),
  115. };
  116. static const struct snd_kcontrol_new ssm2602_snd_controls[] = {
  117. SOC_DOUBLE_R("Master Playback Volume", SSM2602_LOUT1V, SSM2602_ROUT1V,
  118. 0, 127, 0),
  119. SOC_DOUBLE_R("Master Playback ZC Switch", SSM2602_LOUT1V, SSM2602_ROUT1V,
  120. 7, 1, 0),
  121. SOC_DOUBLE_R("Capture Volume", SSM2602_LINVOL, SSM2602_RINVOL, 0, 31, 0),
  122. SOC_DOUBLE_R("Capture Switch", SSM2602_LINVOL, SSM2602_RINVOL, 7, 1, 1),
  123. SOC_SINGLE("Mic Boost (+20dB)", SSM2602_APANA, 0, 1, 0),
  124. SOC_SINGLE("Mic Switch", SSM2602_APANA, 1, 1, 1),
  125. SOC_SINGLE("Sidetone Playback Volume", SSM2602_APANA, 6, 3, 1),
  126. SOC_SINGLE("ADC High Pass Filter Switch", SSM2602_APDIGI, 0, 1, 1),
  127. SOC_SINGLE("Store DC Offset Switch", SSM2602_APDIGI, 4, 1, 0),
  128. SOC_ENUM("Capture Source", ssm2602_enum[0]),
  129. SOC_ENUM("Playback De-emphasis", ssm2602_enum[1]),
  130. };
  131. /* add non dapm controls */
  132. static int ssm2602_add_controls(struct snd_soc_codec *codec)
  133. {
  134. int err, i;
  135. for (i = 0; i < ARRAY_SIZE(ssm2602_snd_controls); i++) {
  136. err = snd_ctl_add(codec->card,
  137. snd_soc_cnew(&ssm2602_snd_controls[i], codec, NULL));
  138. if (err < 0)
  139. return err;
  140. }
  141. return 0;
  142. }
  143. /* Output Mixer */
  144. static const struct snd_kcontrol_new ssm2602_output_mixer_controls[] = {
  145. SOC_DAPM_SINGLE("Line Bypass Switch", SSM2602_APANA, 3, 1, 0),
  146. SOC_DAPM_SINGLE("Mic Sidetone Switch", SSM2602_APANA, 5, 1, 0),
  147. SOC_DAPM_SINGLE("HiFi Playback Switch", SSM2602_APANA, 4, 1, 0),
  148. };
  149. /* Input mux */
  150. static const struct snd_kcontrol_new ssm2602_input_mux_controls =
  151. SOC_DAPM_ENUM("Input Select", ssm2602_enum[0]);
  152. static const struct snd_soc_dapm_widget ssm2602_dapm_widgets[] = {
  153. SND_SOC_DAPM_MIXER("Output Mixer", SSM2602_PWR, 4, 1,
  154. &ssm2602_output_mixer_controls[0],
  155. ARRAY_SIZE(ssm2602_output_mixer_controls)),
  156. SND_SOC_DAPM_DAC("DAC", "HiFi Playback", SSM2602_PWR, 3, 1),
  157. SND_SOC_DAPM_OUTPUT("LOUT"),
  158. SND_SOC_DAPM_OUTPUT("LHPOUT"),
  159. SND_SOC_DAPM_OUTPUT("ROUT"),
  160. SND_SOC_DAPM_OUTPUT("RHPOUT"),
  161. SND_SOC_DAPM_ADC("ADC", "HiFi Capture", SSM2602_PWR, 2, 1),
  162. SND_SOC_DAPM_MUX("Input Mux", SND_SOC_NOPM, 0, 0, &ssm2602_input_mux_controls),
  163. SND_SOC_DAPM_PGA("Line Input", SSM2602_PWR, 0, 1, NULL, 0),
  164. SND_SOC_DAPM_MICBIAS("Mic Bias", SSM2602_PWR, 1, 1),
  165. SND_SOC_DAPM_INPUT("MICIN"),
  166. SND_SOC_DAPM_INPUT("RLINEIN"),
  167. SND_SOC_DAPM_INPUT("LLINEIN"),
  168. };
  169. static const struct snd_soc_dapm_route audio_conn[] = {
  170. /* output mixer */
  171. {"Output Mixer", "Line Bypass Switch", "Line Input"},
  172. {"Output Mixer", "HiFi Playback Switch", "DAC"},
  173. {"Output Mixer", "Mic Sidetone Switch", "Mic Bias"},
  174. /* outputs */
  175. {"RHPOUT", NULL, "Output Mixer"},
  176. {"ROUT", NULL, "Output Mixer"},
  177. {"LHPOUT", NULL, "Output Mixer"},
  178. {"LOUT", NULL, "Output Mixer"},
  179. /* input mux */
  180. {"Input Mux", "Line", "Line Input"},
  181. {"Input Mux", "Mic", "Mic Bias"},
  182. {"ADC", NULL, "Input Mux"},
  183. /* inputs */
  184. {"Line Input", NULL, "LLINEIN"},
  185. {"Line Input", NULL, "RLINEIN"},
  186. {"Mic Bias", NULL, "MICIN"},
  187. };
  188. static int ssm2602_add_widgets(struct snd_soc_codec *codec)
  189. {
  190. snd_soc_dapm_new_controls(codec, ssm2602_dapm_widgets,
  191. ARRAY_SIZE(ssm2602_dapm_widgets));
  192. snd_soc_dapm_add_routes(codec, audio_conn, ARRAY_SIZE(audio_conn));
  193. snd_soc_dapm_new_widgets(codec);
  194. return 0;
  195. }
  196. struct _coeff_div {
  197. u32 mclk;
  198. u32 rate;
  199. u16 fs;
  200. u8 sr:4;
  201. u8 bosr:1;
  202. u8 usb:1;
  203. };
  204. /* codec mclk clock divider coefficients */
  205. static const struct _coeff_div coeff_div[] = {
  206. /* 48k */
  207. {12288000, 48000, 256, 0x0, 0x0, 0x0},
  208. {18432000, 48000, 384, 0x0, 0x1, 0x0},
  209. {12000000, 48000, 250, 0x0, 0x0, 0x1},
  210. /* 32k */
  211. {12288000, 32000, 384, 0x6, 0x0, 0x0},
  212. {18432000, 32000, 576, 0x6, 0x1, 0x0},
  213. {12000000, 32000, 375, 0x6, 0x0, 0x1},
  214. /* 8k */
  215. {12288000, 8000, 1536, 0x3, 0x0, 0x0},
  216. {18432000, 8000, 2304, 0x3, 0x1, 0x0},
  217. {11289600, 8000, 1408, 0xb, 0x0, 0x0},
  218. {16934400, 8000, 2112, 0xb, 0x1, 0x0},
  219. {12000000, 8000, 1500, 0x3, 0x0, 0x1},
  220. /* 96k */
  221. {12288000, 96000, 128, 0x7, 0x0, 0x0},
  222. {18432000, 96000, 192, 0x7, 0x1, 0x0},
  223. {12000000, 96000, 125, 0x7, 0x0, 0x1},
  224. /* 44.1k */
  225. {11289600, 44100, 256, 0x8, 0x0, 0x0},
  226. {16934400, 44100, 384, 0x8, 0x1, 0x0},
  227. {12000000, 44100, 272, 0x8, 0x1, 0x1},
  228. /* 88.2k */
  229. {11289600, 88200, 128, 0xf, 0x0, 0x0},
  230. {16934400, 88200, 192, 0xf, 0x1, 0x0},
  231. {12000000, 88200, 136, 0xf, 0x1, 0x1},
  232. };
  233. static inline int get_coeff(int mclk, int rate)
  234. {
  235. int i;
  236. for (i = 0; i < ARRAY_SIZE(coeff_div); i++) {
  237. if (coeff_div[i].rate == rate && coeff_div[i].mclk == mclk)
  238. return i;
  239. }
  240. return i;
  241. }
  242. static int ssm2602_hw_params(struct snd_pcm_substream *substream,
  243. struct snd_pcm_hw_params *params)
  244. {
  245. u16 srate;
  246. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  247. struct snd_soc_device *socdev = rtd->socdev;
  248. struct snd_soc_codec *codec = socdev->codec;
  249. struct ssm2602_priv *ssm2602 = codec->private_data;
  250. u16 iface = ssm2602_read_reg_cache(codec, SSM2602_IFACE) & 0xfff3;
  251. int i = get_coeff(ssm2602->sysclk, params_rate(params));
  252. /*no match is found*/
  253. if (i == ARRAY_SIZE(coeff_div))
  254. return -EINVAL;
  255. srate = (coeff_div[i].sr << 2) |
  256. (coeff_div[i].bosr << 1) | coeff_div[i].usb;
  257. ssm2602_write(codec, SSM2602_ACTIVE, 0);
  258. ssm2602_write(codec, SSM2602_SRATE, srate);
  259. /* bit size */
  260. switch (params_format(params)) {
  261. case SNDRV_PCM_FORMAT_S16_LE:
  262. break;
  263. case SNDRV_PCM_FORMAT_S20_3LE:
  264. iface |= 0x0004;
  265. break;
  266. case SNDRV_PCM_FORMAT_S24_LE:
  267. iface |= 0x0008;
  268. break;
  269. case SNDRV_PCM_FORMAT_S32_LE:
  270. iface |= 0x000c;
  271. break;
  272. }
  273. ssm2602_write(codec, SSM2602_IFACE, iface);
  274. ssm2602_write(codec, SSM2602_ACTIVE, ACTIVE_ACTIVATE_CODEC);
  275. return 0;
  276. }
  277. static int ssm2602_startup(struct snd_pcm_substream *substream)
  278. {
  279. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  280. struct snd_soc_device *socdev = rtd->socdev;
  281. struct snd_soc_codec *codec = socdev->codec;
  282. struct ssm2602_priv *ssm2602 = codec->private_data;
  283. struct snd_pcm_runtime *master_runtime;
  284. /* The DAI has shared clocks so if we already have a playback or
  285. * capture going then constrain this substream to match it.
  286. */
  287. if (ssm2602->master_substream) {
  288. master_runtime = ssm2602->master_substream->runtime;
  289. snd_pcm_hw_constraint_minmax(substream->runtime,
  290. SNDRV_PCM_HW_PARAM_RATE,
  291. master_runtime->rate,
  292. master_runtime->rate);
  293. snd_pcm_hw_constraint_minmax(substream->runtime,
  294. SNDRV_PCM_HW_PARAM_SAMPLE_BITS,
  295. master_runtime->sample_bits,
  296. master_runtime->sample_bits);
  297. ssm2602->slave_substream = substream;
  298. } else
  299. ssm2602->master_substream = substream;
  300. return 0;
  301. }
  302. static int ssm2602_pcm_prepare(struct snd_pcm_substream *substream)
  303. {
  304. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  305. struct snd_soc_device *socdev = rtd->socdev;
  306. struct snd_soc_codec *codec = socdev->codec;
  307. /* set active */
  308. ssm2602_write(codec, SSM2602_ACTIVE, ACTIVE_ACTIVATE_CODEC);
  309. return 0;
  310. }
  311. static void ssm2602_shutdown(struct snd_pcm_substream *substream)
  312. {
  313. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  314. struct snd_soc_device *socdev = rtd->socdev;
  315. struct snd_soc_codec *codec = socdev->codec;
  316. /* deactivate */
  317. if (!codec->active)
  318. ssm2602_write(codec, SSM2602_ACTIVE, 0);
  319. }
  320. static int ssm2602_mute(struct snd_soc_dai *dai, int mute)
  321. {
  322. struct snd_soc_codec *codec = dai->codec;
  323. u16 mute_reg = ssm2602_read_reg_cache(codec, SSM2602_APDIGI) & ~APDIGI_ENABLE_DAC_MUTE;
  324. if (mute)
  325. ssm2602_write(codec, SSM2602_APDIGI,
  326. mute_reg | APDIGI_ENABLE_DAC_MUTE);
  327. else
  328. ssm2602_write(codec, SSM2602_APDIGI, mute_reg);
  329. return 0;
  330. }
  331. static int ssm2602_set_dai_sysclk(struct snd_soc_dai *codec_dai,
  332. int clk_id, unsigned int freq, int dir)
  333. {
  334. struct snd_soc_codec *codec = codec_dai->codec;
  335. struct ssm2602_priv *ssm2602 = codec->private_data;
  336. switch (freq) {
  337. case 11289600:
  338. case 12000000:
  339. case 12288000:
  340. case 16934400:
  341. case 18432000:
  342. ssm2602->sysclk = freq;
  343. return 0;
  344. }
  345. return -EINVAL;
  346. }
  347. static int ssm2602_set_dai_fmt(struct snd_soc_dai *codec_dai,
  348. unsigned int fmt)
  349. {
  350. struct snd_soc_codec *codec = codec_dai->codec;
  351. u16 iface = 0;
  352. /* set master/slave audio interface */
  353. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  354. case SND_SOC_DAIFMT_CBM_CFM:
  355. iface |= 0x0040;
  356. break;
  357. case SND_SOC_DAIFMT_CBS_CFS:
  358. break;
  359. default:
  360. return -EINVAL;
  361. }
  362. /* interface format */
  363. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  364. case SND_SOC_DAIFMT_I2S:
  365. iface |= 0x0002;
  366. break;
  367. case SND_SOC_DAIFMT_RIGHT_J:
  368. break;
  369. case SND_SOC_DAIFMT_LEFT_J:
  370. iface |= 0x0001;
  371. break;
  372. case SND_SOC_DAIFMT_DSP_A:
  373. iface |= 0x0003;
  374. break;
  375. case SND_SOC_DAIFMT_DSP_B:
  376. iface |= 0x0013;
  377. break;
  378. default:
  379. return -EINVAL;
  380. }
  381. /* clock inversion */
  382. switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
  383. case SND_SOC_DAIFMT_NB_NF:
  384. break;
  385. case SND_SOC_DAIFMT_IB_IF:
  386. iface |= 0x0090;
  387. break;
  388. case SND_SOC_DAIFMT_IB_NF:
  389. iface |= 0x0080;
  390. break;
  391. case SND_SOC_DAIFMT_NB_IF:
  392. iface |= 0x0010;
  393. break;
  394. default:
  395. return -EINVAL;
  396. }
  397. /* set iface */
  398. ssm2602_write(codec, SSM2602_IFACE, iface);
  399. return 0;
  400. }
  401. static int ssm2602_set_bias_level(struct snd_soc_codec *codec,
  402. enum snd_soc_bias_level level)
  403. {
  404. u16 reg = ssm2602_read_reg_cache(codec, SSM2602_PWR) & 0xff7f;
  405. switch (level) {
  406. case SND_SOC_BIAS_ON:
  407. /* vref/mid, osc on, dac unmute */
  408. ssm2602_write(codec, SSM2602_PWR, reg);
  409. break;
  410. case SND_SOC_BIAS_PREPARE:
  411. break;
  412. case SND_SOC_BIAS_STANDBY:
  413. /* everything off except vref/vmid, */
  414. ssm2602_write(codec, SSM2602_PWR, reg | PWR_CLK_OUT_PDN);
  415. break;
  416. case SND_SOC_BIAS_OFF:
  417. /* everything off, dac mute, inactive */
  418. ssm2602_write(codec, SSM2602_ACTIVE, 0);
  419. ssm2602_write(codec, SSM2602_PWR, 0xffff);
  420. break;
  421. }
  422. codec->bias_level = level;
  423. return 0;
  424. }
  425. #define SSM2602_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
  426. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |\
  427. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |\
  428. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |\
  429. SNDRV_PCM_RATE_96000)
  430. struct snd_soc_dai ssm2602_dai = {
  431. .name = "SSM2602",
  432. .playback = {
  433. .stream_name = "Playback",
  434. .channels_min = 2,
  435. .channels_max = 2,
  436. .rates = SSM2602_RATES,
  437. .formats = SNDRV_PCM_FMTBIT_S32_LE,},
  438. .capture = {
  439. .stream_name = "Capture",
  440. .channels_min = 2,
  441. .channels_max = 2,
  442. .rates = SSM2602_RATES,
  443. .formats = SNDRV_PCM_FMTBIT_S32_LE,},
  444. .ops = {
  445. .startup = ssm2602_startup,
  446. .prepare = ssm2602_pcm_prepare,
  447. .hw_params = ssm2602_hw_params,
  448. .shutdown = ssm2602_shutdown,
  449. },
  450. .dai_ops = {
  451. .digital_mute = ssm2602_mute,
  452. .set_sysclk = ssm2602_set_dai_sysclk,
  453. .set_fmt = ssm2602_set_dai_fmt,
  454. }
  455. };
  456. EXPORT_SYMBOL_GPL(ssm2602_dai);
  457. static int ssm2602_suspend(struct platform_device *pdev, pm_message_t state)
  458. {
  459. struct snd_soc_device *socdev = platform_get_drvdata(pdev);
  460. struct snd_soc_codec *codec = socdev->codec;
  461. ssm2602_set_bias_level(codec, SND_SOC_BIAS_OFF);
  462. return 0;
  463. }
  464. static int ssm2602_resume(struct platform_device *pdev)
  465. {
  466. struct snd_soc_device *socdev = platform_get_drvdata(pdev);
  467. struct snd_soc_codec *codec = socdev->codec;
  468. int i;
  469. u8 data[2];
  470. u16 *cache = codec->reg_cache;
  471. /* Sync reg_cache with the hardware */
  472. for (i = 0; i < ARRAY_SIZE(ssm2602_reg); i++) {
  473. data[0] = (i << 1) | ((cache[i] >> 8) & 0x0001);
  474. data[1] = cache[i] & 0x00ff;
  475. codec->hw_write(codec->control_data, data, 2);
  476. }
  477. ssm2602_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
  478. ssm2602_set_bias_level(codec, codec->suspend_bias_level);
  479. return 0;
  480. }
  481. /*
  482. * initialise the ssm2602 driver
  483. * register the mixer and dsp interfaces with the kernel
  484. */
  485. static int ssm2602_init(struct snd_soc_device *socdev)
  486. {
  487. struct snd_soc_codec *codec = socdev->codec;
  488. int reg, ret = 0;
  489. codec->name = "SSM2602";
  490. codec->owner = THIS_MODULE;
  491. codec->read = ssm2602_read_reg_cache;
  492. codec->write = ssm2602_write;
  493. codec->set_bias_level = ssm2602_set_bias_level;
  494. codec->dai = &ssm2602_dai;
  495. codec->num_dai = 1;
  496. codec->reg_cache_size = sizeof(ssm2602_reg);
  497. codec->reg_cache = kmemdup(ssm2602_reg, sizeof(ssm2602_reg),
  498. GFP_KERNEL);
  499. if (codec->reg_cache == NULL)
  500. return -ENOMEM;
  501. ssm2602_reset(codec);
  502. /* register pcms */
  503. ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
  504. if (ret < 0) {
  505. pr_err("ssm2602: failed to create pcms\n");
  506. goto pcm_err;
  507. }
  508. /*power on device*/
  509. ssm2602_write(codec, SSM2602_ACTIVE, 0);
  510. /* set the update bits */
  511. reg = ssm2602_read_reg_cache(codec, SSM2602_LINVOL);
  512. ssm2602_write(codec, SSM2602_LINVOL, reg | LINVOL_LRIN_BOTH);
  513. reg = ssm2602_read_reg_cache(codec, SSM2602_RINVOL);
  514. ssm2602_write(codec, SSM2602_RINVOL, reg | RINVOL_RLIN_BOTH);
  515. reg = ssm2602_read_reg_cache(codec, SSM2602_LOUT1V);
  516. ssm2602_write(codec, SSM2602_LOUT1V, reg | LOUT1V_LRHP_BOTH);
  517. reg = ssm2602_read_reg_cache(codec, SSM2602_ROUT1V);
  518. ssm2602_write(codec, SSM2602_ROUT1V, reg | ROUT1V_RLHP_BOTH);
  519. /*select Line in as default input*/
  520. ssm2602_write(codec, SSM2602_APANA,
  521. APANA_ENABLE_MIC_BOOST2 | APANA_SELECT_DAC |
  522. APANA_ENABLE_MIC_BOOST);
  523. ssm2602_write(codec, SSM2602_PWR, 0);
  524. ssm2602_add_controls(codec);
  525. ssm2602_add_widgets(codec);
  526. ret = snd_soc_register_card(socdev);
  527. if (ret < 0) {
  528. pr_err("ssm2602: failed to register card\n");
  529. goto card_err;
  530. }
  531. return ret;
  532. card_err:
  533. snd_soc_free_pcms(socdev);
  534. snd_soc_dapm_free(socdev);
  535. pcm_err:
  536. kfree(codec->reg_cache);
  537. return ret;
  538. }
  539. static struct snd_soc_device *ssm2602_socdev;
  540. #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
  541. /*
  542. * ssm2602 2 wire address is determined by GPIO5
  543. * state during powerup.
  544. * low = 0x1a
  545. * high = 0x1b
  546. */
  547. static int ssm2602_i2c_probe(struct i2c_client *i2c,
  548. const struct i2c_device_id *id)
  549. {
  550. struct snd_soc_device *socdev = ssm2602_socdev;
  551. struct snd_soc_codec *codec = socdev->codec;
  552. int ret;
  553. i2c_set_clientdata(i2c, codec);
  554. codec->control_data = i2c;
  555. ret = ssm2602_init(socdev);
  556. if (ret < 0)
  557. pr_err("failed to initialise SSM2602\n");
  558. return ret;
  559. }
  560. static int ssm2602_i2c_remove(struct i2c_client *client)
  561. {
  562. struct snd_soc_codec *codec = i2c_get_clientdata(client);
  563. kfree(codec->reg_cache);
  564. return 0;
  565. }
  566. static const struct i2c_device_id ssm2602_i2c_id[] = {
  567. { "ssm2602", 0 },
  568. { }
  569. };
  570. MODULE_DEVICE_TABLE(i2c, ssm2602_i2c_id);
  571. /* corgi i2c codec control layer */
  572. static struct i2c_driver ssm2602_i2c_driver = {
  573. .driver = {
  574. .name = "SSM2602 I2C Codec",
  575. .owner = THIS_MODULE,
  576. },
  577. .probe = ssm2602_i2c_probe,
  578. .remove = ssm2602_i2c_remove,
  579. .id_table = ssm2602_i2c_id,
  580. };
  581. static int ssm2602_add_i2c_device(struct platform_device *pdev,
  582. const struct ssm2602_setup_data *setup)
  583. {
  584. struct i2c_board_info info;
  585. struct i2c_adapter *adapter;
  586. struct i2c_client *client;
  587. int ret;
  588. ret = i2c_add_driver(&ssm2602_i2c_driver);
  589. if (ret != 0) {
  590. dev_err(&pdev->dev, "can't add i2c driver\n");
  591. return ret;
  592. }
  593. memset(&info, 0, sizeof(struct i2c_board_info));
  594. info.addr = setup->i2c_address;
  595. strlcpy(info.type, "ssm2602", I2C_NAME_SIZE);
  596. adapter = i2c_get_adapter(setup->i2c_bus);
  597. if (!adapter) {
  598. dev_err(&pdev->dev, "can't get i2c adapter %d\n",
  599. setup->i2c_bus);
  600. goto err_driver;
  601. }
  602. client = i2c_new_device(adapter, &info);
  603. i2c_put_adapter(adapter);
  604. if (!client) {
  605. dev_err(&pdev->dev, "can't add i2c device at 0x%x\n",
  606. (unsigned int)info.addr);
  607. goto err_driver;
  608. }
  609. return 0;
  610. err_driver:
  611. i2c_del_driver(&ssm2602_i2c_driver);
  612. return -ENODEV;
  613. }
  614. #endif
  615. static int ssm2602_probe(struct platform_device *pdev)
  616. {
  617. struct snd_soc_device *socdev = platform_get_drvdata(pdev);
  618. struct ssm2602_setup_data *setup;
  619. struct snd_soc_codec *codec;
  620. struct ssm2602_priv *ssm2602;
  621. int ret = 0;
  622. pr_info("ssm2602 Audio Codec %s", SSM2602_VERSION);
  623. setup = socdev->codec_data;
  624. codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
  625. if (codec == NULL)
  626. return -ENOMEM;
  627. ssm2602 = kzalloc(sizeof(struct ssm2602_priv), GFP_KERNEL);
  628. if (ssm2602 == NULL) {
  629. kfree(codec);
  630. return -ENOMEM;
  631. }
  632. codec->private_data = ssm2602;
  633. socdev->codec = codec;
  634. mutex_init(&codec->mutex);
  635. INIT_LIST_HEAD(&codec->dapm_widgets);
  636. INIT_LIST_HEAD(&codec->dapm_paths);
  637. ssm2602_socdev = socdev;
  638. #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
  639. if (setup->i2c_address) {
  640. codec->hw_write = (hw_write_t)i2c_master_send;
  641. ret = ssm2602_add_i2c_device(pdev, setup);
  642. }
  643. #else
  644. /* other interfaces */
  645. #endif
  646. return ret;
  647. }
  648. /* remove everything here */
  649. static int ssm2602_remove(struct platform_device *pdev)
  650. {
  651. struct snd_soc_device *socdev = platform_get_drvdata(pdev);
  652. struct snd_soc_codec *codec = socdev->codec;
  653. if (codec->control_data)
  654. ssm2602_set_bias_level(codec, SND_SOC_BIAS_OFF);
  655. snd_soc_free_pcms(socdev);
  656. snd_soc_dapm_free(socdev);
  657. #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
  658. i2c_unregister_device(codec->control_data);
  659. i2c_del_driver(&ssm2602_i2c_driver);
  660. #endif
  661. kfree(codec->private_data);
  662. kfree(codec);
  663. return 0;
  664. }
  665. struct snd_soc_codec_device soc_codec_dev_ssm2602 = {
  666. .probe = ssm2602_probe,
  667. .remove = ssm2602_remove,
  668. .suspend = ssm2602_suspend,
  669. .resume = ssm2602_resume,
  670. };
  671. EXPORT_SYMBOL_GPL(soc_codec_dev_ssm2602);
  672. MODULE_DESCRIPTION("ASoC ssm2602 driver");
  673. MODULE_AUTHOR("Cliff Cai");
  674. MODULE_LICENSE("GPL");