mop500_ab8500.c 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (C) ST-Ericsson SA 2012
  4. *
  5. * Author: Ola Lilja <ola.o.lilja@stericsson.com>,
  6. * Kristoffer Karlsson <kristoffer.karlsson@stericsson.com>
  7. * for ST-Ericsson.
  8. *
  9. * License terms:
  10. */
  11. #include <linux/module.h>
  12. #include <linux/device.h>
  13. #include <linux/io.h>
  14. #include <linux/clk.h>
  15. #include <linux/mutex.h>
  16. #include <sound/soc.h>
  17. #include <sound/soc-dapm.h>
  18. #include <sound/pcm.h>
  19. #include <sound/pcm_params.h>
  20. #include "ux500_pcm.h"
  21. #include "ux500_msp_dai.h"
  22. #include "mop500_ab8500.h"
  23. #include "../codecs/ab8500-codec.h"
  24. #define TX_SLOT_MONO 0x0008
  25. #define TX_SLOT_STEREO 0x000a
  26. #define RX_SLOT_MONO 0x0001
  27. #define RX_SLOT_STEREO 0x0003
  28. #define TX_SLOT_8CH 0x00FF
  29. #define RX_SLOT_8CH 0x00FF
  30. #define DEF_TX_SLOTS TX_SLOT_STEREO
  31. #define DEF_RX_SLOTS RX_SLOT_MONO
  32. #define DRIVERMODE_NORMAL 0
  33. #define DRIVERMODE_CODEC_ONLY 1
  34. /* Slot configuration */
  35. static unsigned int tx_slots = DEF_TX_SLOTS;
  36. static unsigned int rx_slots = DEF_RX_SLOTS;
  37. /* Configuration consistency parameters */
  38. static DEFINE_MUTEX(mop500_ab8500_params_lock);
  39. static unsigned long mop500_ab8500_usage;
  40. static int mop500_ab8500_rate;
  41. static int mop500_ab8500_channels;
  42. /* Clocks */
  43. static const char * const enum_mclk[] = {
  44. "SYSCLK",
  45. "ULPCLK"
  46. };
  47. enum mclk {
  48. MCLK_SYSCLK,
  49. MCLK_ULPCLK,
  50. };
  51. static SOC_ENUM_SINGLE_EXT_DECL(soc_enum_mclk, enum_mclk);
  52. /* Private data for machine-part MOP500<->AB8500 */
  53. struct mop500_ab8500_drvdata {
  54. /* Clocks */
  55. enum mclk mclk_sel;
  56. struct clk *clk_ptr_intclk;
  57. struct clk *clk_ptr_sysclk;
  58. struct clk *clk_ptr_ulpclk;
  59. };
  60. static inline const char *get_mclk_str(enum mclk mclk_sel)
  61. {
  62. switch (mclk_sel) {
  63. case MCLK_SYSCLK:
  64. return "SYSCLK";
  65. case MCLK_ULPCLK:
  66. return "ULPCLK";
  67. default:
  68. return "Unknown";
  69. }
  70. }
  71. static int mop500_ab8500_set_mclk(struct device *dev,
  72. struct mop500_ab8500_drvdata *drvdata)
  73. {
  74. int status;
  75. struct clk *clk_ptr;
  76. if (IS_ERR(drvdata->clk_ptr_intclk)) {
  77. dev_err(dev,
  78. "%s: ERROR: intclk not initialized!\n", __func__);
  79. return -EIO;
  80. }
  81. switch (drvdata->mclk_sel) {
  82. case MCLK_SYSCLK:
  83. clk_ptr = drvdata->clk_ptr_sysclk;
  84. break;
  85. case MCLK_ULPCLK:
  86. clk_ptr = drvdata->clk_ptr_ulpclk;
  87. break;
  88. default:
  89. return -EINVAL;
  90. }
  91. if (IS_ERR(clk_ptr)) {
  92. dev_err(dev, "%s: ERROR: %s not initialized!\n", __func__,
  93. get_mclk_str(drvdata->mclk_sel));
  94. return -EIO;
  95. }
  96. status = clk_set_parent(drvdata->clk_ptr_intclk, clk_ptr);
  97. if (status)
  98. dev_err(dev,
  99. "%s: ERROR: Setting intclk parent to %s failed (ret = %d)!",
  100. __func__, get_mclk_str(drvdata->mclk_sel), status);
  101. else
  102. dev_dbg(dev,
  103. "%s: intclk parent changed to %s.\n",
  104. __func__, get_mclk_str(drvdata->mclk_sel));
  105. return status;
  106. }
  107. /*
  108. * Control-events
  109. */
  110. static int mclk_input_control_get(struct snd_kcontrol *kcontrol,
  111. struct snd_ctl_elem_value *ucontrol)
  112. {
  113. struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
  114. struct mop500_ab8500_drvdata *drvdata =
  115. snd_soc_card_get_drvdata(card);
  116. ucontrol->value.enumerated.item[0] = drvdata->mclk_sel;
  117. return 0;
  118. }
  119. static int mclk_input_control_put(struct snd_kcontrol *kcontrol,
  120. struct snd_ctl_elem_value *ucontrol)
  121. {
  122. struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
  123. struct mop500_ab8500_drvdata *drvdata =
  124. snd_soc_card_get_drvdata(card);
  125. unsigned int val = ucontrol->value.enumerated.item[0];
  126. if (val > (unsigned int)MCLK_ULPCLK)
  127. return -EINVAL;
  128. if (drvdata->mclk_sel == val)
  129. return 0;
  130. drvdata->mclk_sel = val;
  131. return 1;
  132. }
  133. /*
  134. * Controls
  135. */
  136. static struct snd_kcontrol_new mop500_ab8500_ctrls[] = {
  137. SOC_ENUM_EXT("Master Clock Select",
  138. soc_enum_mclk,
  139. mclk_input_control_get, mclk_input_control_put),
  140. SOC_DAPM_PIN_SWITCH("Headset Left"),
  141. SOC_DAPM_PIN_SWITCH("Headset Right"),
  142. SOC_DAPM_PIN_SWITCH("Earpiece"),
  143. SOC_DAPM_PIN_SWITCH("Speaker Left"),
  144. SOC_DAPM_PIN_SWITCH("Speaker Right"),
  145. SOC_DAPM_PIN_SWITCH("LineOut Left"),
  146. SOC_DAPM_PIN_SWITCH("LineOut Right"),
  147. SOC_DAPM_PIN_SWITCH("Vibra 1"),
  148. SOC_DAPM_PIN_SWITCH("Vibra 2"),
  149. SOC_DAPM_PIN_SWITCH("Mic 1"),
  150. SOC_DAPM_PIN_SWITCH("Mic 2"),
  151. SOC_DAPM_PIN_SWITCH("LineIn Left"),
  152. SOC_DAPM_PIN_SWITCH("LineIn Right"),
  153. SOC_DAPM_PIN_SWITCH("DMic 1"),
  154. SOC_DAPM_PIN_SWITCH("DMic 2"),
  155. SOC_DAPM_PIN_SWITCH("DMic 3"),
  156. SOC_DAPM_PIN_SWITCH("DMic 4"),
  157. SOC_DAPM_PIN_SWITCH("DMic 5"),
  158. SOC_DAPM_PIN_SWITCH("DMic 6"),
  159. };
  160. /* ASoC */
  161. static int mop500_ab8500_startup(struct snd_pcm_substream *substream)
  162. {
  163. struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
  164. /* Set audio-clock source */
  165. return mop500_ab8500_set_mclk(rtd->card->dev,
  166. snd_soc_card_get_drvdata(rtd->card));
  167. }
  168. static void mop500_ab8500_shutdown(struct snd_pcm_substream *substream)
  169. {
  170. struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
  171. struct device *dev = rtd->card->dev;
  172. dev_dbg(dev, "%s: Enter\n", __func__);
  173. /* Reset slots configuration to default(s) */
  174. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
  175. tx_slots = DEF_TX_SLOTS;
  176. else
  177. rx_slots = DEF_RX_SLOTS;
  178. }
  179. static int mop500_ab8500_hw_params(struct snd_pcm_substream *substream,
  180. struct snd_pcm_hw_params *params)
  181. {
  182. struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
  183. struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
  184. struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
  185. struct device *dev = rtd->card->dev;
  186. unsigned int fmt;
  187. int channels, ret = 0, driver_mode, slots;
  188. unsigned int sw_codec, sw_cpu;
  189. bool is_playback;
  190. dev_dbg(dev, "%s: Enter\n", __func__);
  191. dev_dbg(dev, "%s: substream->pcm->name = %s\n"
  192. "substream->pcm->id = %s.\n"
  193. "substream->name = %s.\n"
  194. "substream->number = %d.\n",
  195. __func__,
  196. substream->pcm->name,
  197. substream->pcm->id,
  198. substream->name,
  199. substream->number);
  200. /* Ensure configuration consistency between DAIs */
  201. mutex_lock(&mop500_ab8500_params_lock);
  202. if (mop500_ab8500_usage) {
  203. if (mop500_ab8500_rate != params_rate(params) ||
  204. mop500_ab8500_channels != params_channels(params)) {
  205. mutex_unlock(&mop500_ab8500_params_lock);
  206. return -EBUSY;
  207. }
  208. } else {
  209. mop500_ab8500_rate = params_rate(params);
  210. mop500_ab8500_channels = params_channels(params);
  211. }
  212. __set_bit(cpu_dai->id, &mop500_ab8500_usage);
  213. mutex_unlock(&mop500_ab8500_params_lock);
  214. channels = params_channels(params);
  215. switch (params_format(params)) {
  216. case SNDRV_PCM_FORMAT_S32_LE:
  217. sw_cpu = 32;
  218. break;
  219. case SNDRV_PCM_FORMAT_S16_LE:
  220. sw_cpu = 16;
  221. break;
  222. default:
  223. return -EINVAL;
  224. }
  225. /* Setup codec depending on driver-mode */
  226. if (channels == 8)
  227. driver_mode = DRIVERMODE_CODEC_ONLY;
  228. else
  229. driver_mode = DRIVERMODE_NORMAL;
  230. dev_dbg(dev, "%s: Driver-mode: %s.\n", __func__,
  231. (driver_mode == DRIVERMODE_NORMAL) ? "NORMAL" : "CODEC_ONLY");
  232. /* Setup format */
  233. if (driver_mode == DRIVERMODE_NORMAL) {
  234. fmt = SND_SOC_DAIFMT_DSP_A |
  235. SND_SOC_DAIFMT_CBM_CFM |
  236. SND_SOC_DAIFMT_NB_NF |
  237. SND_SOC_DAIFMT_CONT;
  238. } else {
  239. fmt = SND_SOC_DAIFMT_DSP_A |
  240. SND_SOC_DAIFMT_CBM_CFM |
  241. SND_SOC_DAIFMT_NB_NF |
  242. SND_SOC_DAIFMT_GATED;
  243. }
  244. ret = snd_soc_runtime_set_dai_fmt(rtd, fmt);
  245. if (ret)
  246. return ret;
  247. /* Setup TDM-slots */
  248. is_playback = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK);
  249. switch (channels) {
  250. case 1:
  251. slots = 16;
  252. tx_slots = (is_playback) ? TX_SLOT_MONO : 0;
  253. rx_slots = (is_playback) ? 0 : RX_SLOT_MONO;
  254. break;
  255. case 2:
  256. slots = 16;
  257. tx_slots = (is_playback) ? TX_SLOT_STEREO : 0;
  258. rx_slots = (is_playback) ? 0 : RX_SLOT_STEREO;
  259. break;
  260. case 8:
  261. slots = 16;
  262. tx_slots = (is_playback) ? TX_SLOT_8CH : 0;
  263. rx_slots = (is_playback) ? 0 : RX_SLOT_8CH;
  264. break;
  265. default:
  266. return -EINVAL;
  267. }
  268. if (driver_mode == DRIVERMODE_NORMAL)
  269. sw_codec = sw_cpu;
  270. else
  271. sw_codec = 20;
  272. dev_dbg(dev, "%s: CPU-DAI TDM: TX=0x%04X RX=0x%04x\n", __func__,
  273. tx_slots, rx_slots);
  274. ret = snd_soc_dai_set_tdm_slot(cpu_dai, tx_slots, rx_slots, slots,
  275. sw_cpu);
  276. if (ret)
  277. return ret;
  278. dev_dbg(dev, "%s: CODEC-DAI TDM: TX=0x%04X RX=0x%04x\n", __func__,
  279. tx_slots, rx_slots);
  280. ret = snd_soc_dai_set_tdm_slot(codec_dai, tx_slots, rx_slots, slots,
  281. sw_codec);
  282. if (ret)
  283. return ret;
  284. return 0;
  285. }
  286. static int mop500_ab8500_hw_free(struct snd_pcm_substream *substream)
  287. {
  288. struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
  289. struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
  290. mutex_lock(&mop500_ab8500_params_lock);
  291. __clear_bit(cpu_dai->id, &mop500_ab8500_usage);
  292. mutex_unlock(&mop500_ab8500_params_lock);
  293. return 0;
  294. }
  295. struct snd_soc_ops mop500_ab8500_ops[] = {
  296. {
  297. .hw_params = mop500_ab8500_hw_params,
  298. .hw_free = mop500_ab8500_hw_free,
  299. .startup = mop500_ab8500_startup,
  300. .shutdown = mop500_ab8500_shutdown,
  301. }
  302. };
  303. int mop500_ab8500_machine_init(struct snd_soc_pcm_runtime *rtd)
  304. {
  305. struct snd_soc_dapm_context *dapm = &rtd->card->dapm;
  306. struct device *dev = rtd->card->dev;
  307. struct mop500_ab8500_drvdata *drvdata;
  308. int ret;
  309. dev_dbg(dev, "%s Enter.\n", __func__);
  310. /* Create driver private-data struct */
  311. drvdata = devm_kzalloc(dev, sizeof(struct mop500_ab8500_drvdata),
  312. GFP_KERNEL);
  313. if (!drvdata)
  314. return -ENOMEM;
  315. snd_soc_card_set_drvdata(rtd->card, drvdata);
  316. /* Setup clocks */
  317. drvdata->clk_ptr_sysclk = clk_get(dev, "sysclk");
  318. if (IS_ERR(drvdata->clk_ptr_sysclk))
  319. dev_warn(dev, "%s: WARNING: clk_get failed for 'sysclk'!\n",
  320. __func__);
  321. drvdata->clk_ptr_ulpclk = clk_get(dev, "ulpclk");
  322. if (IS_ERR(drvdata->clk_ptr_ulpclk))
  323. dev_warn(dev, "%s: WARNING: clk_get failed for 'ulpclk'!\n",
  324. __func__);
  325. drvdata->clk_ptr_intclk = clk_get(dev, "intclk");
  326. if (IS_ERR(drvdata->clk_ptr_intclk))
  327. dev_warn(dev, "%s: WARNING: clk_get failed for 'intclk'!\n",
  328. __func__);
  329. /* Set intclk default parent to ulpclk */
  330. drvdata->mclk_sel = MCLK_ULPCLK;
  331. ret = mop500_ab8500_set_mclk(dev, drvdata);
  332. if (ret < 0)
  333. dev_warn(dev, "%s: WARNING: mop500_ab8500_set_mclk!\n",
  334. __func__);
  335. drvdata->mclk_sel = MCLK_ULPCLK;
  336. /* Add controls */
  337. ret = snd_soc_add_card_controls(rtd->card, mop500_ab8500_ctrls,
  338. ARRAY_SIZE(mop500_ab8500_ctrls));
  339. if (ret < 0) {
  340. pr_err("%s: Failed to add machine-controls (%d)!\n",
  341. __func__, ret);
  342. return ret;
  343. }
  344. ret = snd_soc_dapm_disable_pin(dapm, "Earpiece");
  345. ret |= snd_soc_dapm_disable_pin(dapm, "Speaker Left");
  346. ret |= snd_soc_dapm_disable_pin(dapm, "Speaker Right");
  347. ret |= snd_soc_dapm_disable_pin(dapm, "LineOut Left");
  348. ret |= snd_soc_dapm_disable_pin(dapm, "LineOut Right");
  349. ret |= snd_soc_dapm_disable_pin(dapm, "Vibra 1");
  350. ret |= snd_soc_dapm_disable_pin(dapm, "Vibra 2");
  351. ret |= snd_soc_dapm_disable_pin(dapm, "Mic 1");
  352. ret |= snd_soc_dapm_disable_pin(dapm, "Mic 2");
  353. ret |= snd_soc_dapm_disable_pin(dapm, "LineIn Left");
  354. ret |= snd_soc_dapm_disable_pin(dapm, "LineIn Right");
  355. ret |= snd_soc_dapm_disable_pin(dapm, "DMic 1");
  356. ret |= snd_soc_dapm_disable_pin(dapm, "DMic 2");
  357. ret |= snd_soc_dapm_disable_pin(dapm, "DMic 3");
  358. ret |= snd_soc_dapm_disable_pin(dapm, "DMic 4");
  359. ret |= snd_soc_dapm_disable_pin(dapm, "DMic 5");
  360. ret |= snd_soc_dapm_disable_pin(dapm, "DMic 6");
  361. return ret;
  362. }
  363. void mop500_ab8500_remove(struct snd_soc_card *card)
  364. {
  365. struct mop500_ab8500_drvdata *drvdata = snd_soc_card_get_drvdata(card);
  366. if (drvdata->clk_ptr_sysclk != NULL)
  367. clk_put(drvdata->clk_ptr_sysclk);
  368. if (drvdata->clk_ptr_ulpclk != NULL)
  369. clk_put(drvdata->clk_ptr_ulpclk);
  370. if (drvdata->clk_ptr_intclk != NULL)
  371. clk_put(drvdata->clk_ptr_intclk);
  372. snd_soc_card_set_drvdata(card, drvdata);
  373. }