Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * Copyright (c) 2010-2011,2013-2015 The Linux Foundation. All rights reserved.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * storm.c -- ALSA SoC machine driver for QTi ipq806x-based Storm board
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/mod_devicetable.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <sound/pcm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <sound/pcm_params.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <sound/soc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #define STORM_SYSCLK_MULT			4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) static int storm_ops_hw_params(struct snd_pcm_substream *substream,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) 		struct snd_pcm_hw_params *params)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) 	struct snd_soc_pcm_runtime *soc_runtime = asoc_substream_to_rtd(substream);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) 	struct snd_soc_card *card = soc_runtime->card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 	snd_pcm_format_t format = params_format(params);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 	unsigned int rate = params_rate(params);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) 	unsigned int sysclk_freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 	int bitwidth, ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 	bitwidth = snd_pcm_format_width(format);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 	if (bitwidth < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 		dev_err(card->dev, "invalid bit width given: %d\n", bitwidth);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 		return bitwidth;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 	 * as the CPU DAI is the I2S bus master and no system clock is needed by
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 	 * the MAX98357a DAC, simply set the system clock to be a constant
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 	 * multiple of the bit clock for the clock divider
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	sysclk_freq = rate * bitwidth * 2 * STORM_SYSCLK_MULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 	ret = snd_soc_dai_set_sysclk(asoc_rtd_to_cpu(soc_runtime, 0), 0, sysclk_freq, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 		dev_err(card->dev, "error setting sysclk to %u: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 			sysclk_freq, ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) static const struct snd_soc_ops storm_soc_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 	.hw_params	= storm_ops_hw_params,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) SND_SOC_DAILINK_DEFS(hifi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 	DAILINK_COMP_ARRAY(COMP_EMPTY()),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 	DAILINK_COMP_ARRAY(COMP_CODEC(NULL, "HiFi")),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 	DAILINK_COMP_ARRAY(COMP_EMPTY()));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) static struct snd_soc_dai_link storm_dai_link = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	.name		= "Primary",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 	.stream_name	= "Primary",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	.ops		= &storm_soc_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	SND_SOC_DAILINK_REG(hifi),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) static int storm_parse_of(struct snd_soc_card *card)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	struct snd_soc_dai_link *dai_link = card->dai_link;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	struct device_node *np = card->dev->of_node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	dai_link->cpus->of_node = of_parse_phandle(np, "cpu", 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	if (!dai_link->cpus->of_node) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 		dev_err(card->dev, "error getting cpu phandle\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	dai_link->platforms->of_node = dai_link->cpus->of_node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 	dai_link->codecs->of_node = of_parse_phandle(np, "codec", 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 	if (!dai_link->codecs->of_node) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 		dev_err(card->dev, "error getting codec phandle\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) static int storm_platform_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 	struct snd_soc_card *card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 	card = devm_kzalloc(&pdev->dev, sizeof(*card), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 	if (!card)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	card->dev = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 	card->owner = THIS_MODULE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 	ret = snd_soc_of_parse_card_name(card, "qcom,model");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 		dev_err(&pdev->dev, "error parsing card name: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 	card->dai_link	= &storm_dai_link;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	card->num_links	= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	ret = storm_parse_of(card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 		dev_err(&pdev->dev, "error resolving dai links: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	ret = devm_snd_soc_register_card(&pdev->dev, card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 		dev_err(&pdev->dev, "error registering soundcard: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) #ifdef CONFIG_OF
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) static const struct of_device_id storm_device_id[]  = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	{ .compatible = "google,storm-audio" },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	{},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) MODULE_DEVICE_TABLE(of, storm_device_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) static struct platform_driver storm_platform_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 	.driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 		.name = "storm-audio",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 		.of_match_table =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 			of_match_ptr(storm_device_id),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 	.probe = storm_platform_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) module_platform_driver(storm_platform_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) MODULE_DESCRIPTION("QTi IPQ806x-based Storm Machine Driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) MODULE_LICENSE("GPL v2");