Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * sam9x5_wm8731   --	SoC audio for AT91SAM9X5-based boards
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *			that are using WM8731 as codec.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  *  Copyright (C) 2011 Atmel,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  *		  Nicolas Ferre <nicolas.ferre@atmel.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  *  Copyright (C) 2013 Paratronic,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10)  *		  Richard Genoud <richard.genoud@gmail.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12)  * Based on sam9g20_wm8731.c by:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13)  * Sedji Gaouaou <sedji.gaouaou@atmel.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <linux/export.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <linux/mod_devicetable.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #include <sound/soc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #include <sound/soc-dai.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #include <sound/soc-dapm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) #include "../codecs/wm8731.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) #include "atmel_ssc_dai.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) #define MCLK_RATE 12288000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) #define DRV_NAME "sam9x5-snd-wm8731"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) struct sam9x5_drvdata {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 	int ssc_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39)  * Logic for a wm8731 as connected on a at91sam9x5ek based board.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) static int sam9x5_wm8731_init(struct snd_soc_pcm_runtime *rtd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 	struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 	struct device *dev = rtd->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	dev_dbg(dev, "%s called\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 	/* set the codec system clock for DAC and ADC */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 	ret = snd_soc_dai_set_sysclk(codec_dai, WM8731_SYSCLK_XTAL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 				     MCLK_RATE, SND_SOC_CLOCK_IN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 	if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 		dev_err(dev, "Failed to set WM8731 SYSCLK: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61)  * Audio paths on at91sam9x5ek board:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63)  *  |A| ------------> |      | ---R----> Headphone Jack
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64)  *  |T| <----\        |  WM  | ---L--/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65)  *  |9| ---> CLK <--> | 8731 | <--R----- Line In Jack
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66)  *  |1| <------------ |      | <--L--/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) static const struct snd_soc_dapm_widget sam9x5_dapm_widgets[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	SND_SOC_DAPM_HP("Headphone Jack", NULL),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	SND_SOC_DAPM_LINE("Line In Jack", NULL),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) static int sam9x5_wm8731_driver_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	struct device_node *np = pdev->dev.of_node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 	struct device_node *codec_np, *cpu_np;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 	struct snd_soc_card *card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	struct snd_soc_dai_link *dai;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 	struct sam9x5_drvdata *priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 	struct snd_soc_dai_link_component *comp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 	if (!np) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 		dev_err(&pdev->dev, "No device node supplied\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	card = devm_kzalloc(&pdev->dev, sizeof(*card), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 	dai = devm_kzalloc(&pdev->dev, sizeof(*dai), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 	comp = devm_kzalloc(&pdev->dev, 3 * sizeof(*comp), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	if (!dai || !card || !priv || !comp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 		ret = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	snd_soc_card_set_drvdata(card, priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 	card->dev = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 	card->owner = THIS_MODULE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 	card->dai_link = dai;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 	card->num_links = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 	card->dapm_widgets = sam9x5_dapm_widgets;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 	card->num_dapm_widgets = ARRAY_SIZE(sam9x5_dapm_widgets);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 	dai->cpus = &comp[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 	dai->num_cpus = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	dai->codecs = &comp[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 	dai->num_codecs = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	dai->platforms = &comp[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 	dai->num_platforms = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 	dai->name = "WM8731";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 	dai->stream_name = "WM8731 PCM";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 	dai->codecs->dai_name = "wm8731-hifi";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	dai->init = sam9x5_wm8731_init;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 	dai->dai_fmt = SND_SOC_DAIFMT_DSP_A | SND_SOC_DAIFMT_NB_NF
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 		| SND_SOC_DAIFMT_CBM_CFM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	ret = snd_soc_of_parse_card_name(card, "atmel,model");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 		dev_err(&pdev->dev, "atmel,model node missing\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	ret = snd_soc_of_parse_audio_routing(card, "atmel,audio-routing");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 		dev_err(&pdev->dev, "atmel,audio-routing node missing\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 	codec_np = of_parse_phandle(np, "atmel,audio-codec", 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 	if (!codec_np) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 		dev_err(&pdev->dev, "atmel,audio-codec node missing\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 		ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 	dai->codecs->of_node = codec_np;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 	cpu_np = of_parse_phandle(np, "atmel,ssc-controller", 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	if (!cpu_np) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 		dev_err(&pdev->dev, "atmel,ssc-controller node missing\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 		ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 		goto out_put_codec_np;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 	dai->cpus->of_node = cpu_np;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 	dai->platforms->of_node = cpu_np;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 	priv->ssc_id = of_alias_get_id(cpu_np, "ssc");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	ret = atmel_ssc_set_audio(priv->ssc_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	if (ret != 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 		dev_err(&pdev->dev, "Failed to set SSC %d for audio: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 			ret, priv->ssc_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 		goto out_put_cpu_np;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 	ret = devm_snd_soc_register_card(&pdev->dev, card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 		dev_err(&pdev->dev, "Platform device allocation failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 		goto out_put_audio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 	dev_dbg(&pdev->dev, "%s ok\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 	goto out_put_cpu_np;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) out_put_audio:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 	atmel_ssc_put_audio(priv->ssc_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) out_put_cpu_np:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	of_node_put(cpu_np);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) out_put_codec_np:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 	of_node_put(codec_np);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) static int sam9x5_wm8731_driver_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 	struct snd_soc_card *card = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 	struct sam9x5_drvdata *priv = card->drvdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 	atmel_ssc_put_audio(priv->ssc_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) static const struct of_device_id sam9x5_wm8731_of_match[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 	{ .compatible = "atmel,sam9x5-wm8731-audio", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	{},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) MODULE_DEVICE_TABLE(of, sam9x5_wm8731_of_match);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) static struct platform_driver sam9x5_wm8731_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 	.driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 		.name = DRV_NAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 		.of_match_table = of_match_ptr(sam9x5_wm8731_of_match),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 	.probe = sam9x5_wm8731_driver_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 	.remove = sam9x5_wm8731_driver_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) module_platform_driver(sam9x5_wm8731_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) /* Module information */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) MODULE_AUTHOR("Nicolas Ferre <nicolas.ferre@atmel.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) MODULE_AUTHOR("Richard Genoud <richard.genoud@gmail.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) MODULE_DESCRIPTION("ALSA SoC machine driver for AT91SAM9x5 - WM8731");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) MODULE_ALIAS("platform:" DRV_NAME);