document.write('');
document.write('');
document.write('');
document.write('');
document.write('Paste provided by Paste.ee - View Original - View Raw - Download
');
document.write('/*\n * Copyright (c) 2015 exceet electronics GmbH\n * Author: Frieder Schrempf <frieder.schrempf@exceet.de>\n *\n * Recording not tested !!!\n *\n * Based on imx-wm8962.c\n * Copyright (C) 2012 Freescale Semiconductor, Inc.\n * Copyright (C) 2012 Linaro Ltd.\n *\n * The code contained herein is licensed under the GNU General Public\n * License. You may obtain a copy of the GNU General Public License\n * Version 2 or later at the following locations:\n *\n * http://www.opensource.org/licenses/gpl-license.html\n * http://www.gnu.org/copyleft/gpl.html\n */\n\n#include <linux/module.h>\n#include <linux/of_platform.h>\n#include <linux/i2c.h>\n#include <linux/of_gpio.h>\n#include <linux/slab.h>\n#include <linux/gpio.h>\n#include <linux/clk.h>\n#include <sound/soc.h>\n#include <sound/jack.h>\n#include <sound/control.h>\n#include <sound/pcm_params.h>\n#include <sound/soc-dapm.h>\n#include <linux/pinctrl/consumer.h>\n\n#include "../codecs/wm8510.h"\n#include "imx-audmux.h"\n\n#define DAI_NAME_SIZE 32\n\nstruct imx_wm8510_data {\n struct snd_soc_dai_link dai;\n struct snd_soc_card card;\n char codec_dai_name[DAI_NAME_SIZE];\n char platform_name[DAI_NAME_SIZE];\n struct clk *codec_clk;\n unsigned int mclk_frequency;\n unsigned int mclk_source;\n};\n\nstruct imx_priv {\n bool amic_mono;\n bool dmic_mono;\n struct snd_soc_codec *codec;\n struct platform_device *pdev;\n struct snd_pcm_substream *first_stream;\n struct snd_card *snd_card;\n};\nstatic struct imx_priv card_priv;\n\nstatic const struct snd_soc_dapm_widget imx_wm8510_dapm_widgets[] = {\n SND_SOC_DAPM_MIC("Int Mic", NULL),\n SND_SOC_DAPM_SPK("Ext Spk", NULL),\n};\n\nstatic int imx_hifi_hw_params(struct snd_pcm_substream *substream,\n struct snd_pcm_hw_params *params)\n{\n struct snd_soc_pcm_runtime *rtd = substream->private_data;\n struct snd_soc_dai *cpu_dai = rtd->cpu_dai;\n struct snd_soc_dai *codec_dai = rtd->codec_dai;\n struct imx_priv *priv = &card_priv;\n struct device *dev = &priv->pdev->dev;\n struct snd_soc_card *card = codec_dai->codec->card;\n struct imx_wm8510_data *data = snd_soc_card_get_drvdata(card);\n unsigned int channels = params_channels(params);\n unsigned int sample_rate = params_rate(params);\n snd_pcm_format_t sample_format = params_format(params);\n u32 dai_format, pll_out = 0, bclk = 0, mclk_div = 0;\n int ret = 0;\n\n\n dai_format = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |\n SND_SOC_DAIFMT_CBM_CFM;\n\n /* set codec DAI configuration */\n ret = snd_soc_dai_set_fmt(codec_dai, dai_format);\n if (ret < 0) {\n pr_err("imx-wm8510: Failed to set CODEC DAI CONFIGURATION fmt (%d)\n", ret);\n return ret;\n }\n\n /* set i.MX active slot mask */\n snd_soc_dai_set_tdm_slot(cpu_dai,\n channels == 1 ? 0xfffffffe : 0xfffffffc,\n channels == 1 ? 0xfffffffe : 0xfffffffc,\n 2, 32);\n\n dai_format = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_IF |\n SND_SOC_DAIFMT_CBM_CFM;\n\n /* set cpu DAI configuration */\n ret = snd_soc_dai_set_fmt(cpu_dai, dai_format);\n if (ret < 0) {\n pr_err("imx-wm8510: Failed to set CPU DAI CONFIGURATION fmt (%d)\n", ret);\n return ret;\n }\n\n /*\n * Figure out PLL and BCLK dividers for WM8510\n */\n switch (sample_rate) {\n case 48000:\n pll_out = 24576000;\n mclk_div = WM8510_MCLKDIV_2;\n bclk = WM8510_BCLKDIV_8;\n break;\n\n case 44100:\n pll_out = 22579200;\n mclk_div = WM8510_MCLKDIV_2;\n bclk = WM8510_BCLKDIV_8;\n break;\n\n case 22050:\n pll_out = 22579200;\n mclk_div = WM8510_MCLKDIV_4;\n bclk = WM8510_BCLKDIV_8;\n break;\n\n case 16000:\n pll_out = 24576000;\n mclk_div = WM8510_MCLKDIV_6;\n bclk = WM8510_BCLKDIV_8;\n break;\n\n case 11025:\n pll_out = 22579200;\n mclk_div = WM8510_MCLKDIV_8;\n bclk = WM8510_BCLKDIV_8;\n break;\n\n case 8000:\n pll_out = 24576000;\n mclk_div = WM8510_MCLKDIV_12;\n bclk = WM8510_BCLKDIV_8;\n break;\n\n default:\n pr_warning("imx-wm8510: Unsupported sample rate %d\n",sample_rate);\n return -EINVAL;\n }\n\n ret = snd_soc_dai_set_clkdiv(codec_dai, WM8510_BCLKDIV, bclk);\n if (ret < 0) {\n pr_warning("imx-wm8510: Failed to set CODEC DAI BCLKDIV (%d)\n", ret);\n return ret;\n }\n\n ret = snd_soc_dai_set_pll(codec_dai, 0, 0, data->mclk_frequency, pll_out);\n if (ret < 0)\n pr_err("imx-wm8510: Failed to start PLL: %d\n", ret);\n\n\n ret = snd_soc_dai_set_clkdiv(codec_dai, WM8510_MCLKDIV, mclk_div);\n if (ret < 0) {\n pr_warning("imx-wm8510: Failed to set CODEC MCLKDIV (%d)\n",ret);\n return ret;\n }\n\n return 0;\n}\n\nstatic struct snd_soc_ops imx_hifi_ops = {\n .hw_params = imx_hifi_hw_params,\n};\n\nstatic int imx_wm8510_probe(struct platform_device *pdev)\n{\n struct device_node *np = pdev->dev.of_node;\n struct device_node *cpu_np, *codec_np;\n struct platform_device *cpu_pdev;\n struct imx_priv *priv = &card_priv;\n struct i2c_client *codec_dev;\n struct imx_wm8510_data *data;\n int int_port, ext_port;\n int ret;\n\n priv->pdev = pdev;\n\n cpu_np = of_parse_phandle(pdev->dev.of_node, "cpu-dai", 0);\n if (!cpu_np) {\n dev_err(&pdev->dev, "cpu dai phandle missing or invalid\n");\n ret = -EINVAL;\n goto fail;\n }\n\n if (!strstr(cpu_np->name, "ssi"))\n goto audmux_bypass;\n\n ret = of_property_read_u32(np, "mux-int-port", &int_port);\n if (ret) {\n dev_err(&pdev->dev, "mux-int-port missing or invalid\n");\n return ret;\n }\n ret = of_property_read_u32(np, "mux-ext-port", &ext_port);\n if (ret) {\n dev_err(&pdev->dev, "mux-ext-port missing or invalid\n");\n return ret;\n }\n\n /*\n * The port numbering in the hardware manual starts at 1, while\n * the audmux API expects it starts at 0.\n */\n int_port--;\n ext_port--;\n ret = imx_audmux_v2_configure_port(int_port,\n IMX_AUDMUX_V2_PTCR_SYN |\n IMX_AUDMUX_V2_PTCR_TFSEL(ext_port) |\n IMX_AUDMUX_V2_PTCR_TCSEL(ext_port) |\n IMX_AUDMUX_V2_PTCR_TFSDIR |\n IMX_AUDMUX_V2_PTCR_TCLKDIR,\n IMX_AUDMUX_V2_PDCR_RXDSEL(ext_port));\n if (ret) {\n dev_err(&pdev->dev, "audmux internal port setup failed\n");\n return ret;\n }\n imx_audmux_v2_configure_port(ext_port,\n IMX_AUDMUX_V2_PTCR_SYN,\n IMX_AUDMUX_V2_PDCR_RXDSEL(int_port));\n if (ret) {\n dev_err(&pdev->dev, "audmux external port setup failed\n");\n return ret;\n }\n\n audmux_bypass:\n codec_np = of_parse_phandle(pdev->dev.of_node, "audio-codec", 0);\n if (!codec_np) {\n dev_err(&pdev->dev, "phandle missing or invalid\n");\n ret = -EINVAL;\n goto fail;\n }\n\n cpu_pdev = of_find_device_by_node(cpu_np);\n if (!cpu_pdev) {\n dev_err(&pdev->dev, "failed to find SSI platform device\n");\n ret = -EINVAL;\n goto fail;\n }\n codec_dev = of_find_i2c_device_by_node(codec_np);\n if (!codec_dev) {\n dev_err(&pdev->dev, "failed to find codec platform device\n");\n ret = -EINVAL;\n goto fail;\n }\n\n priv->first_stream = NULL;\n\n data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);\n if (!data) {\n ret = -ENOMEM;\n goto fail;\n }\n\n \n data->codec_clk = devm_clk_get(&codec_dev->dev, "audio_mclk");\n if (IS_ERR(data->codec_clk)) {\n ret = PTR_ERR(data->codec_clk);\n dev_err(&codec_dev->dev, "failed to get codec clk: %d\n", ret);\n goto fail;\n }\n\n ret = of_property_read_u32(codec_dev->dev.of_node, "mclk_frequency", (u32 *) &(data->mclk_frequency));\n if (ret) {\n dev_err(&codec_dev->dev, "mclk missing or invalid\n");\n return ret;\n }\n\n data->mclk_frequency = clk_get_rate(data->codec_clk);\n ret = clk_prepare_enable(data->codec_clk);\n if (ret) {\n dev_err(&codec_dev->dev, "failed to enable mclk\n");\n return ret;\n }\n\n priv->amic_mono = of_property_read_bool(codec_np, "amic-mono");\n priv->dmic_mono = of_property_read_bool(codec_np, "dmic-mono");\n\n data->dai.name = "WM8510";\n data->dai.stream_name = "WM8510 PCM";\n data->dai.codec_dai_name = "wm8510-hifi";\n data->dai.codec_of_node = codec_np;\n data->dai.cpu_dai_name = dev_name(&cpu_pdev->dev);\n data->dai.platform_of_node = cpu_np;\n data->dai.ops = &imx_hifi_ops;\n data->dai.dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |\n SND_SOC_DAIFMT_CBM_CFM;\n\n data->card.dev = &pdev->dev;\n ret = snd_soc_of_parse_card_name(&data->card, "model");\n if (ret)\n goto fail;\n ret = snd_soc_of_parse_audio_routing(&data->card, "audio-routing");\n if (ret)\n goto fail;\n data->card.num_links = 1;\n data->card.dai_link = &data->dai;\n data->card.dapm_widgets = imx_wm8510_dapm_widgets;\n data->card.num_dapm_widgets = ARRAY_SIZE(imx_wm8510_dapm_widgets);\n\n platform_set_drvdata(pdev, &data->card);\n snd_soc_card_set_drvdata(&data->card, data);\n\n ret = snd_soc_register_card(&data->card);\n if (ret) {\n dev_err(&pdev->dev, "snd_soc_register_card failed (%d)\n", ret);\n goto fail;\n }\n\n priv->snd_card = data->card.snd_card;\n\nfail:\n if (cpu_np)\n of_node_put(cpu_np);\n if (codec_np)\n of_node_put(codec_np);\n\n return ret;\n}\n\nstatic int imx_wm8510_remove(struct platform_device *pdev)\n{\n struct snd_soc_card *card = platform_get_drvdata(pdev);\n\n snd_soc_unregister_card(card);\n\n return 0;\n}\n\nstatic const struct of_device_id imx_wm8510_dt_ids[] = {\n { .compatible = "fsl,imx-audio-wm8510", },\n { /* sentinel */ }\n};\nMODULE_DEVICE_TABLE(of, imx_wm8510_dt_ids);\n\nstatic struct platform_driver imx_wm8510_driver = {\n .driver = {\n .name = "imx-wm8510",\n .owner = THIS_MODULE,\n .pm = &snd_soc_pm_ops,\n .of_match_table = imx_wm8510_dt_ids,\n },\n .probe = imx_wm8510_probe,\n .remove = imx_wm8510_remove,\n};\nmodule_platform_driver(imx_wm8510_driver);\n\nMODULE_AUTHOR("exceet electronics GmbH");\nMODULE_DESCRIPTION("Freescale i.MX WM8510 ASoC machine driver");\nMODULE_LICENSE("GPL v2");\nMODULE_ALIAS("platform:imx-wm8510");\n
');
function initEmbeddedPaste_NVViP3MFuhVKzts1() {
hljs.highlightBlock(document.getElementById('pastee-NVViP3MFuhVKzts1-content'));
}
addEventListener('DOMContentLoaded', initEmbeddedPaste_NVViP3MFuhVKzts1, false);
addEventListener('load', initEmbeddedPaste_NVViP3MFuhVKzts1, false);