treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / misc / atmel-ssc.c
blobab4144ea1f116940483a165555bb09176d6e9738
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Atmel SSC driver
5 * Copyright (C) 2007 Atmel Corporation
6 */
8 #include <linux/platform_device.h>
9 #include <linux/list.h>
10 #include <linux/clk.h>
11 #include <linux/err.h>
12 #include <linux/io.h>
13 #include <linux/spinlock.h>
14 #include <linux/atmel-ssc.h>
15 #include <linux/slab.h>
16 #include <linux/module.h>
18 #include <linux/of.h>
20 #include "../../sound/soc/atmel/atmel_ssc_dai.h"
22 /* Serialize access to ssc_list and user count */
23 static DEFINE_SPINLOCK(user_lock);
24 static LIST_HEAD(ssc_list);
26 struct ssc_device *ssc_request(unsigned int ssc_num)
28 int ssc_valid = 0;
29 struct ssc_device *ssc;
31 spin_lock(&user_lock);
32 list_for_each_entry(ssc, &ssc_list, list) {
33 if (ssc->pdev->dev.of_node) {
34 if (of_alias_get_id(ssc->pdev->dev.of_node, "ssc")
35 == ssc_num) {
36 ssc->pdev->id = ssc_num;
37 ssc_valid = 1;
38 break;
40 } else if (ssc->pdev->id == ssc_num) {
41 ssc_valid = 1;
42 break;
46 if (!ssc_valid) {
47 spin_unlock(&user_lock);
48 pr_err("ssc: ssc%d platform device is missing\n", ssc_num);
49 return ERR_PTR(-ENODEV);
52 if (ssc->user) {
53 spin_unlock(&user_lock);
54 dev_dbg(&ssc->pdev->dev, "module busy\n");
55 return ERR_PTR(-EBUSY);
57 ssc->user++;
58 spin_unlock(&user_lock);
60 clk_prepare(ssc->clk);
62 return ssc;
64 EXPORT_SYMBOL(ssc_request);
66 void ssc_free(struct ssc_device *ssc)
68 bool disable_clk = true;
70 spin_lock(&user_lock);
71 if (ssc->user)
72 ssc->user--;
73 else {
74 disable_clk = false;
75 dev_dbg(&ssc->pdev->dev, "device already free\n");
77 spin_unlock(&user_lock);
79 if (disable_clk)
80 clk_unprepare(ssc->clk);
82 EXPORT_SYMBOL(ssc_free);
84 static struct atmel_ssc_platform_data at91rm9200_config = {
85 .use_dma = 0,
86 .has_fslen_ext = 0,
89 static struct atmel_ssc_platform_data at91sam9rl_config = {
90 .use_dma = 0,
91 .has_fslen_ext = 1,
94 static struct atmel_ssc_platform_data at91sam9g45_config = {
95 .use_dma = 1,
96 .has_fslen_ext = 1,
99 static const struct platform_device_id atmel_ssc_devtypes[] = {
101 .name = "at91rm9200_ssc",
102 .driver_data = (unsigned long) &at91rm9200_config,
103 }, {
104 .name = "at91sam9rl_ssc",
105 .driver_data = (unsigned long) &at91sam9rl_config,
106 }, {
107 .name = "at91sam9g45_ssc",
108 .driver_data = (unsigned long) &at91sam9g45_config,
109 }, {
110 /* sentinel */
114 #ifdef CONFIG_OF
115 static const struct of_device_id atmel_ssc_dt_ids[] = {
117 .compatible = "atmel,at91rm9200-ssc",
118 .data = &at91rm9200_config,
119 }, {
120 .compatible = "atmel,at91sam9rl-ssc",
121 .data = &at91sam9rl_config,
122 }, {
123 .compatible = "atmel,at91sam9g45-ssc",
124 .data = &at91sam9g45_config,
125 }, {
126 /* sentinel */
129 MODULE_DEVICE_TABLE(of, atmel_ssc_dt_ids);
130 #endif
132 static inline const struct atmel_ssc_platform_data *
133 atmel_ssc_get_driver_data(struct platform_device *pdev)
135 if (pdev->dev.of_node) {
136 const struct of_device_id *match;
137 match = of_match_node(atmel_ssc_dt_ids, pdev->dev.of_node);
138 if (match == NULL)
139 return NULL;
140 return match->data;
143 return (struct atmel_ssc_platform_data *)
144 platform_get_device_id(pdev)->driver_data;
147 #ifdef CONFIG_SND_ATMEL_SOC_SSC
148 static int ssc_sound_dai_probe(struct ssc_device *ssc)
150 struct device_node *np = ssc->pdev->dev.of_node;
151 int ret;
152 int id;
154 ssc->sound_dai = false;
156 if (!of_property_read_bool(np, "#sound-dai-cells"))
157 return 0;
159 id = of_alias_get_id(np, "ssc");
160 if (id < 0)
161 return id;
163 ret = atmel_ssc_set_audio(id);
164 ssc->sound_dai = !ret;
166 return ret;
169 static void ssc_sound_dai_remove(struct ssc_device *ssc)
171 if (!ssc->sound_dai)
172 return;
174 atmel_ssc_put_audio(of_alias_get_id(ssc->pdev->dev.of_node, "ssc"));
176 #else
177 static inline int ssc_sound_dai_probe(struct ssc_device *ssc)
179 if (of_property_read_bool(ssc->pdev->dev.of_node, "#sound-dai-cells"))
180 return -ENOTSUPP;
182 return 0;
185 static inline void ssc_sound_dai_remove(struct ssc_device *ssc)
188 #endif
190 static int ssc_probe(struct platform_device *pdev)
192 struct resource *regs;
193 struct ssc_device *ssc;
194 const struct atmel_ssc_platform_data *plat_dat;
196 ssc = devm_kzalloc(&pdev->dev, sizeof(struct ssc_device), GFP_KERNEL);
197 if (!ssc) {
198 dev_dbg(&pdev->dev, "out of memory\n");
199 return -ENOMEM;
202 ssc->pdev = pdev;
204 plat_dat = atmel_ssc_get_driver_data(pdev);
205 if (!plat_dat)
206 return -ENODEV;
207 ssc->pdata = (struct atmel_ssc_platform_data *)plat_dat;
209 if (pdev->dev.of_node) {
210 struct device_node *np = pdev->dev.of_node;
211 ssc->clk_from_rk_pin =
212 of_property_read_bool(np, "atmel,clk-from-rk-pin");
215 regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
216 ssc->regs = devm_ioremap_resource(&pdev->dev, regs);
217 if (IS_ERR(ssc->regs))
218 return PTR_ERR(ssc->regs);
220 ssc->phybase = regs->start;
222 ssc->clk = devm_clk_get(&pdev->dev, "pclk");
223 if (IS_ERR(ssc->clk)) {
224 dev_dbg(&pdev->dev, "no pclk clock defined\n");
225 return -ENXIO;
228 /* disable all interrupts */
229 clk_prepare_enable(ssc->clk);
230 ssc_writel(ssc->regs, IDR, -1);
231 ssc_readl(ssc->regs, SR);
232 clk_disable_unprepare(ssc->clk);
234 ssc->irq = platform_get_irq(pdev, 0);
235 if (!ssc->irq) {
236 dev_dbg(&pdev->dev, "could not get irq\n");
237 return -ENXIO;
240 spin_lock(&user_lock);
241 list_add_tail(&ssc->list, &ssc_list);
242 spin_unlock(&user_lock);
244 platform_set_drvdata(pdev, ssc);
246 dev_info(&pdev->dev, "Atmel SSC device at 0x%p (irq %d)\n",
247 ssc->regs, ssc->irq);
249 if (ssc_sound_dai_probe(ssc))
250 dev_err(&pdev->dev, "failed to auto-setup ssc for audio\n");
252 return 0;
255 static int ssc_remove(struct platform_device *pdev)
257 struct ssc_device *ssc = platform_get_drvdata(pdev);
259 ssc_sound_dai_remove(ssc);
261 spin_lock(&user_lock);
262 list_del(&ssc->list);
263 spin_unlock(&user_lock);
265 return 0;
268 static struct platform_driver ssc_driver = {
269 .driver = {
270 .name = "ssc",
271 .of_match_table = of_match_ptr(atmel_ssc_dt_ids),
273 .id_table = atmel_ssc_devtypes,
274 .probe = ssc_probe,
275 .remove = ssc_remove,
277 module_platform_driver(ssc_driver);
279 MODULE_AUTHOR("Hans-Christian Egtvedt <hcegtvedt@atmel.com>");
280 MODULE_DESCRIPTION("SSC driver for Atmel AVR32 and AT91");
281 MODULE_LICENSE("GPL");
282 MODULE_ALIAS("platform:ssc");