treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / spi / spi-efm32.c
blob64d4c441b6419536bc813eebfcd66e80cd72a7cc
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (C) 2012-2013 Uwe Kleine-Koenig for Pengutronix
4 */
5 #include <linux/kernel.h>
6 #include <linux/io.h>
7 #include <linux/spi/spi.h>
8 #include <linux/spi/spi_bitbang.h>
9 #include <linux/gpio.h>
10 #include <linux/interrupt.h>
11 #include <linux/platform_device.h>
12 #include <linux/clk.h>
13 #include <linux/err.h>
14 #include <linux/module.h>
15 #include <linux/of_gpio.h>
16 #include <linux/platform_data/efm32-spi.h>
18 #define DRIVER_NAME "efm32-spi"
20 #define MASK_VAL(mask, val) ((val << __ffs(mask)) & mask)
22 #define REG_CTRL 0x00
23 #define REG_CTRL_SYNC 0x0001
24 #define REG_CTRL_CLKPOL 0x0100
25 #define REG_CTRL_CLKPHA 0x0200
26 #define REG_CTRL_MSBF 0x0400
27 #define REG_CTRL_TXBIL 0x1000
29 #define REG_FRAME 0x04
30 #define REG_FRAME_DATABITS__MASK 0x000f
31 #define REG_FRAME_DATABITS(n) ((n) - 3)
33 #define REG_CMD 0x0c
34 #define REG_CMD_RXEN 0x0001
35 #define REG_CMD_RXDIS 0x0002
36 #define REG_CMD_TXEN 0x0004
37 #define REG_CMD_TXDIS 0x0008
38 #define REG_CMD_MASTEREN 0x0010
40 #define REG_STATUS 0x10
41 #define REG_STATUS_TXENS 0x0002
42 #define REG_STATUS_TXC 0x0020
43 #define REG_STATUS_TXBL 0x0040
44 #define REG_STATUS_RXDATAV 0x0080
46 #define REG_CLKDIV 0x14
48 #define REG_RXDATAX 0x18
49 #define REG_RXDATAX_RXDATA__MASK 0x01ff
50 #define REG_RXDATAX_PERR 0x4000
51 #define REG_RXDATAX_FERR 0x8000
53 #define REG_TXDATA 0x34
55 #define REG_IF 0x40
56 #define REG_IF_TXBL 0x0002
57 #define REG_IF_RXDATAV 0x0004
59 #define REG_IFS 0x44
60 #define REG_IFC 0x48
61 #define REG_IEN 0x4c
63 #define REG_ROUTE 0x54
64 #define REG_ROUTE_RXPEN 0x0001
65 #define REG_ROUTE_TXPEN 0x0002
66 #define REG_ROUTE_CLKPEN 0x0008
67 #define REG_ROUTE_LOCATION__MASK 0x0700
68 #define REG_ROUTE_LOCATION(n) MASK_VAL(REG_ROUTE_LOCATION__MASK, (n))
70 struct efm32_spi_ddata {
71 struct spi_bitbang bitbang;
73 spinlock_t lock;
75 struct clk *clk;
76 void __iomem *base;
77 unsigned int rxirq, txirq;
78 struct efm32_spi_pdata pdata;
80 /* irq data */
81 struct completion done;
82 const u8 *tx_buf;
83 u8 *rx_buf;
84 unsigned tx_len, rx_len;
86 /* chip selects */
87 unsigned csgpio[];
90 #define ddata_to_dev(ddata) (&(ddata->bitbang.master->dev))
91 #define efm32_spi_vdbg(ddata, format, arg...) \
92 dev_vdbg(ddata_to_dev(ddata), format, ##arg)
94 static void efm32_spi_write32(struct efm32_spi_ddata *ddata,
95 u32 value, unsigned offset)
97 writel_relaxed(value, ddata->base + offset);
100 static u32 efm32_spi_read32(struct efm32_spi_ddata *ddata, unsigned offset)
102 return readl_relaxed(ddata->base + offset);
105 static void efm32_spi_chipselect(struct spi_device *spi, int is_on)
107 struct efm32_spi_ddata *ddata = spi_master_get_devdata(spi->master);
108 int value = !(spi->mode & SPI_CS_HIGH) == !(is_on == BITBANG_CS_ACTIVE);
110 gpio_set_value(ddata->csgpio[spi->chip_select], value);
113 static int efm32_spi_setup_transfer(struct spi_device *spi,
114 struct spi_transfer *t)
116 struct efm32_spi_ddata *ddata = spi_master_get_devdata(spi->master);
118 unsigned bpw = t->bits_per_word ?: spi->bits_per_word;
119 unsigned speed = t->speed_hz ?: spi->max_speed_hz;
120 unsigned long clkfreq = clk_get_rate(ddata->clk);
121 u32 clkdiv;
123 efm32_spi_write32(ddata, REG_CTRL_SYNC | REG_CTRL_MSBF |
124 (spi->mode & SPI_CPHA ? REG_CTRL_CLKPHA : 0) |
125 (spi->mode & SPI_CPOL ? REG_CTRL_CLKPOL : 0), REG_CTRL);
127 efm32_spi_write32(ddata,
128 REG_FRAME_DATABITS(bpw), REG_FRAME);
130 if (2 * speed >= clkfreq)
131 clkdiv = 0;
132 else
133 clkdiv = 64 * (DIV_ROUND_UP(2 * clkfreq, speed) - 4);
135 if (clkdiv > (1U << 21))
136 return -EINVAL;
138 efm32_spi_write32(ddata, clkdiv, REG_CLKDIV);
139 efm32_spi_write32(ddata, REG_CMD_MASTEREN, REG_CMD);
140 efm32_spi_write32(ddata, REG_CMD_RXEN | REG_CMD_TXEN, REG_CMD);
142 return 0;
145 static void efm32_spi_tx_u8(struct efm32_spi_ddata *ddata)
147 u8 val = 0;
149 if (ddata->tx_buf) {
150 val = *ddata->tx_buf;
151 ddata->tx_buf++;
154 ddata->tx_len--;
155 efm32_spi_write32(ddata, val, REG_TXDATA);
156 efm32_spi_vdbg(ddata, "%s: tx 0x%x\n", __func__, val);
159 static void efm32_spi_rx_u8(struct efm32_spi_ddata *ddata)
161 u32 rxdata = efm32_spi_read32(ddata, REG_RXDATAX);
162 efm32_spi_vdbg(ddata, "%s: rx 0x%x\n", __func__, rxdata);
164 if (ddata->rx_buf) {
165 *ddata->rx_buf = rxdata;
166 ddata->rx_buf++;
169 ddata->rx_len--;
172 static void efm32_spi_filltx(struct efm32_spi_ddata *ddata)
174 while (ddata->tx_len &&
175 ddata->tx_len + 2 > ddata->rx_len &&
176 efm32_spi_read32(ddata, REG_STATUS) & REG_STATUS_TXBL) {
177 efm32_spi_tx_u8(ddata);
181 static int efm32_spi_txrx_bufs(struct spi_device *spi, struct spi_transfer *t)
183 struct efm32_spi_ddata *ddata = spi_master_get_devdata(spi->master);
184 int ret = -EBUSY;
186 spin_lock_irq(&ddata->lock);
188 if (ddata->tx_buf || ddata->rx_buf)
189 goto out_unlock;
191 ddata->tx_buf = t->tx_buf;
192 ddata->rx_buf = t->rx_buf;
193 ddata->tx_len = ddata->rx_len =
194 t->len * DIV_ROUND_UP(t->bits_per_word, 8);
196 efm32_spi_filltx(ddata);
198 reinit_completion(&ddata->done);
200 efm32_spi_write32(ddata, REG_IF_TXBL | REG_IF_RXDATAV, REG_IEN);
202 spin_unlock_irq(&ddata->lock);
204 wait_for_completion(&ddata->done);
206 spin_lock_irq(&ddata->lock);
208 ret = t->len - max(ddata->tx_len, ddata->rx_len);
210 efm32_spi_write32(ddata, 0, REG_IEN);
211 ddata->tx_buf = ddata->rx_buf = NULL;
213 out_unlock:
214 spin_unlock_irq(&ddata->lock);
216 return ret;
219 static irqreturn_t efm32_spi_rxirq(int irq, void *data)
221 struct efm32_spi_ddata *ddata = data;
222 irqreturn_t ret = IRQ_NONE;
224 spin_lock(&ddata->lock);
226 while (ddata->rx_len > 0 &&
227 efm32_spi_read32(ddata, REG_STATUS) &
228 REG_STATUS_RXDATAV) {
229 efm32_spi_rx_u8(ddata);
231 ret = IRQ_HANDLED;
234 if (!ddata->rx_len) {
235 u32 ien = efm32_spi_read32(ddata, REG_IEN);
237 ien &= ~REG_IF_RXDATAV;
239 efm32_spi_write32(ddata, ien, REG_IEN);
241 complete(&ddata->done);
244 spin_unlock(&ddata->lock);
246 return ret;
249 static irqreturn_t efm32_spi_txirq(int irq, void *data)
251 struct efm32_spi_ddata *ddata = data;
253 efm32_spi_vdbg(ddata,
254 "%s: txlen = %u, rxlen = %u, if=0x%08x, stat=0x%08x\n",
255 __func__, ddata->tx_len, ddata->rx_len,
256 efm32_spi_read32(ddata, REG_IF),
257 efm32_spi_read32(ddata, REG_STATUS));
259 spin_lock(&ddata->lock);
261 efm32_spi_filltx(ddata);
263 efm32_spi_vdbg(ddata, "%s: txlen = %u, rxlen = %u\n",
264 __func__, ddata->tx_len, ddata->rx_len);
266 if (!ddata->tx_len) {
267 u32 ien = efm32_spi_read32(ddata, REG_IEN);
269 ien &= ~REG_IF_TXBL;
271 efm32_spi_write32(ddata, ien, REG_IEN);
272 efm32_spi_vdbg(ddata, "disable TXBL\n");
275 spin_unlock(&ddata->lock);
277 return IRQ_HANDLED;
280 static u32 efm32_spi_get_configured_location(struct efm32_spi_ddata *ddata)
282 u32 reg = efm32_spi_read32(ddata, REG_ROUTE);
284 return (reg & REG_ROUTE_LOCATION__MASK) >> __ffs(REG_ROUTE_LOCATION__MASK);
287 static void efm32_spi_probe_dt(struct platform_device *pdev,
288 struct spi_master *master, struct efm32_spi_ddata *ddata)
290 struct device_node *np = pdev->dev.of_node;
291 u32 location;
292 int ret;
294 ret = of_property_read_u32(np, "energymicro,location", &location);
296 if (ret)
297 /* fall back to wrongly namespaced property */
298 ret = of_property_read_u32(np, "efm32,location", &location);
300 if (ret)
301 /* fall back to old and (wrongly) generic property "location" */
302 ret = of_property_read_u32(np, "location", &location);
304 if (!ret) {
305 dev_dbg(&pdev->dev, "using location %u\n", location);
306 } else {
307 /* default to location configured in hardware */
308 location = efm32_spi_get_configured_location(ddata);
310 dev_info(&pdev->dev, "fall back to location %u\n", location);
313 ddata->pdata.location = location;
316 static int efm32_spi_probe(struct platform_device *pdev)
318 struct efm32_spi_ddata *ddata;
319 struct resource *res;
320 int ret;
321 struct spi_master *master;
322 struct device_node *np = pdev->dev.of_node;
323 int num_cs, i;
325 if (!np)
326 return -EINVAL;
328 num_cs = of_gpio_named_count(np, "cs-gpios");
329 if (num_cs < 0)
330 return num_cs;
332 master = spi_alloc_master(&pdev->dev,
333 sizeof(*ddata) + num_cs * sizeof(unsigned));
334 if (!master) {
335 dev_dbg(&pdev->dev,
336 "failed to allocate spi master controller\n");
337 return -ENOMEM;
339 platform_set_drvdata(pdev, master);
341 master->dev.of_node = pdev->dev.of_node;
343 master->num_chipselect = num_cs;
344 master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_CS_HIGH;
345 master->bits_per_word_mask = SPI_BPW_RANGE_MASK(4, 16);
347 ddata = spi_master_get_devdata(master);
349 ddata->bitbang.master = master;
350 ddata->bitbang.chipselect = efm32_spi_chipselect;
351 ddata->bitbang.setup_transfer = efm32_spi_setup_transfer;
352 ddata->bitbang.txrx_bufs = efm32_spi_txrx_bufs;
354 spin_lock_init(&ddata->lock);
355 init_completion(&ddata->done);
357 ddata->clk = devm_clk_get(&pdev->dev, NULL);
358 if (IS_ERR(ddata->clk)) {
359 ret = PTR_ERR(ddata->clk);
360 dev_err(&pdev->dev, "failed to get clock: %d\n", ret);
361 goto err;
364 for (i = 0; i < num_cs; ++i) {
365 ret = of_get_named_gpio(np, "cs-gpios", i);
366 if (ret < 0) {
367 dev_err(&pdev->dev, "failed to get csgpio#%u (%d)\n",
368 i, ret);
369 goto err;
371 ddata->csgpio[i] = ret;
372 dev_dbg(&pdev->dev, "csgpio#%u = %u\n", i, ddata->csgpio[i]);
373 ret = devm_gpio_request_one(&pdev->dev, ddata->csgpio[i],
374 GPIOF_OUT_INIT_LOW, DRIVER_NAME);
375 if (ret < 0) {
376 dev_err(&pdev->dev,
377 "failed to configure csgpio#%u (%d)\n",
378 i, ret);
379 goto err;
383 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
384 if (!res) {
385 ret = -ENODEV;
386 dev_err(&pdev->dev, "failed to determine base address\n");
387 goto err;
390 if (resource_size(res) < 0x60) {
391 ret = -EINVAL;
392 dev_err(&pdev->dev, "memory resource too small\n");
393 goto err;
396 ddata->base = devm_ioremap_resource(&pdev->dev, res);
397 if (IS_ERR(ddata->base)) {
398 ret = PTR_ERR(ddata->base);
399 goto err;
402 ret = platform_get_irq(pdev, 0);
403 if (ret <= 0)
404 goto err;
406 ddata->rxirq = ret;
408 ret = platform_get_irq(pdev, 1);
409 if (ret <= 0)
410 ret = ddata->rxirq + 1;
412 ddata->txirq = ret;
414 ret = clk_prepare_enable(ddata->clk);
415 if (ret < 0) {
416 dev_err(&pdev->dev, "failed to enable clock (%d)\n", ret);
417 goto err;
420 efm32_spi_probe_dt(pdev, master, ddata);
422 efm32_spi_write32(ddata, 0, REG_IEN);
423 efm32_spi_write32(ddata, REG_ROUTE_TXPEN | REG_ROUTE_RXPEN |
424 REG_ROUTE_CLKPEN |
425 REG_ROUTE_LOCATION(ddata->pdata.location), REG_ROUTE);
427 ret = request_irq(ddata->rxirq, efm32_spi_rxirq,
428 0, DRIVER_NAME " rx", ddata);
429 if (ret) {
430 dev_err(&pdev->dev, "failed to register rxirq (%d)\n", ret);
431 goto err_disable_clk;
434 ret = request_irq(ddata->txirq, efm32_spi_txirq,
435 0, DRIVER_NAME " tx", ddata);
436 if (ret) {
437 dev_err(&pdev->dev, "failed to register txirq (%d)\n", ret);
438 goto err_free_rx_irq;
441 ret = spi_bitbang_start(&ddata->bitbang);
442 if (ret) {
443 dev_err(&pdev->dev, "spi_bitbang_start failed (%d)\n", ret);
445 free_irq(ddata->txirq, ddata);
446 err_free_rx_irq:
447 free_irq(ddata->rxirq, ddata);
448 err_disable_clk:
449 clk_disable_unprepare(ddata->clk);
450 err:
451 spi_master_put(master);
454 return ret;
457 static int efm32_spi_remove(struct platform_device *pdev)
459 struct spi_master *master = platform_get_drvdata(pdev);
460 struct efm32_spi_ddata *ddata = spi_master_get_devdata(master);
462 spi_bitbang_stop(&ddata->bitbang);
464 efm32_spi_write32(ddata, 0, REG_IEN);
466 free_irq(ddata->txirq, ddata);
467 free_irq(ddata->rxirq, ddata);
468 clk_disable_unprepare(ddata->clk);
469 spi_master_put(master);
471 return 0;
474 static const struct of_device_id efm32_spi_dt_ids[] = {
476 .compatible = "energymicro,efm32-spi",
477 }, {
478 /* doesn't follow the "vendor,device" scheme, don't use */
479 .compatible = "efm32,spi",
480 }, {
481 /* sentinel */
484 MODULE_DEVICE_TABLE(of, efm32_spi_dt_ids);
486 static struct platform_driver efm32_spi_driver = {
487 .probe = efm32_spi_probe,
488 .remove = efm32_spi_remove,
490 .driver = {
491 .name = DRIVER_NAME,
492 .of_match_table = efm32_spi_dt_ids,
495 module_platform_driver(efm32_spi_driver);
497 MODULE_AUTHOR("Uwe Kleine-Koenig <u.kleine-koenig@pengutronix.de>");
498 MODULE_DESCRIPTION("EFM32 SPI driver");
499 MODULE_LICENSE("GPL v2");
500 MODULE_ALIAS("platform:" DRIVER_NAME);