[mirror_ubuntu-zesty-kernel.git] / drivers / spi / spi-efm32.c

/*
 * Copyright (C) 2012-2013 Uwe Kleine-Koenig for Pengutronix
 *
 * This program is free software; you can redistribute it and/or modify it under
 * the terms of the GNU General Public License version 2 as published by the
 * Free Software Foundation.
 */
#include <linux/kernel.h>
#include <linux/io.h>
#include <linux/spi/spi.h>
#include <linux/spi/spi_bitbang.h>
#include <linux/gpio.h>
#include <linux/interrupt.h>
#include <linux/platform_device.h>
#include <linux/clk.h>
#include <linux/err.h>
#include <linux/module.h>
#include <linux/of_gpio.h>
#include <linux/platform_data/efm32-spi.h>

#define DRIVER_NAME "efm32-spi"

#define MASK_VAL(mask, val)		((val << __ffs(mask)) & mask)

#define REG_CTRL		0x00
#define REG_CTRL_SYNC			0x0001
#define REG_CTRL_CLKPOL			0x0100
#define REG_CTRL_CLKPHA			0x0200
#define REG_CTRL_MSBF			0x0400
#define REG_CTRL_TXBIL			0x1000

#define REG_FRAME		0x04
#define REG_FRAME_DATABITS__MASK	0x000f
#define REG_FRAME_DATABITS(n)		((n) - 3)

#define REG_CMD			0x0c
#define REG_CMD_RXEN			0x0001
#define REG_CMD_RXDIS			0x0002
#define REG_CMD_TXEN			0x0004
#define REG_CMD_TXDIS			0x0008
#define REG_CMD_MASTEREN		0x0010

#define REG_STATUS		0x10
#define REG_STATUS_TXENS		0x0002
#define REG_STATUS_TXC			0x0020
#define REG_STATUS_TXBL			0x0040
#define REG_STATUS_RXDATAV		0x0080

#define REG_CLKDIV		0x14

#define REG_RXDATAX		0x18
#define REG_RXDATAX_RXDATA__MASK	0x01ff
#define REG_RXDATAX_PERR		0x4000
#define REG_RXDATAX_FERR		0x8000

#define REG_TXDATA		0x34

#define REG_IF		0x40
#define REG_IF_TXBL			0x0002
#define REG_IF_RXDATAV			0x0004

#define REG_IFS		0x44
#define REG_IFC		0x48
#define REG_IEN		0x4c

#define REG_ROUTE		0x54
#define REG_ROUTE_RXPEN			0x0001
#define REG_ROUTE_TXPEN			0x0002
#define REG_ROUTE_CLKPEN		0x0008
#define REG_ROUTE_LOCATION__MASK	0x0700
#define REG_ROUTE_LOCATION(n)		MASK_VAL(REG_ROUTE_LOCATION__MASK, (n))

struct efm32_spi_ddata {
	struct spi_bitbang bitbang;

	spinlock_t lock;

	struct clk *clk;
	void __iomem *base;
	unsigned int rxirq, txirq;
	struct efm32_spi_pdata pdata;

	/* irq data */
	struct completion done;
	const u8 *tx_buf;
	u8 *rx_buf;
	unsigned tx_len, rx_len;

	/* chip selects */
	unsigned csgpio[];
};

#define ddata_to_dev(ddata)	(&(ddata->bitbang.master->dev))
#define efm32_spi_vdbg(ddata, format, arg...)	\
	dev_vdbg(ddata_to_dev(ddata), format, ##arg)

static void efm32_spi_write32(struct efm32_spi_ddata *ddata,
		u32 value, unsigned offset)
{
	writel_relaxed(value, ddata->base + offset);
}

static u32 efm32_spi_read32(struct efm32_spi_ddata *ddata, unsigned offset)
{
	return readl_relaxed(ddata->base + offset);
}

static void efm32_spi_chipselect(struct spi_device *spi, int is_on)
{
	struct efm32_spi_ddata *ddata = spi_master_get_devdata(spi->master);
	int value = !(spi->mode & SPI_CS_HIGH) == !(is_on == BITBANG_CS_ACTIVE);

	gpio_set_value(ddata->csgpio[spi->chip_select], value);
}

static int efm32_spi_setup_transfer(struct spi_device *spi,
		struct spi_transfer *t)
{
	struct efm32_spi_ddata *ddata = spi_master_get_devdata(spi->master);

	unsigned bpw = t->bits_per_word ?: spi->bits_per_word;
	unsigned speed = t->speed_hz ?: spi->max_speed_hz;
	unsigned long clkfreq = clk_get_rate(ddata->clk);
	u32 clkdiv;

	efm32_spi_write32(ddata, REG_CTRL_SYNC | REG_CTRL_MSBF |
			(spi->mode & SPI_CPHA ? REG_CTRL_CLKPHA : 0) |
			(spi->mode & SPI_CPOL ? REG_CTRL_CLKPOL : 0), REG_CTRL);

	efm32_spi_write32(ddata,
			REG_FRAME_DATABITS(bpw), REG_FRAME);

	if (2 * speed >= clkfreq)
		clkdiv = 0;
	else
		clkdiv = 64 * (DIV_ROUND_UP(2 * clkfreq, speed) - 4);

	if (clkdiv > (1U << 21))
		return -EINVAL;

	efm32_spi_write32(ddata, clkdiv, REG_CLKDIV);
	efm32_spi_write32(ddata, REG_CMD_MASTEREN, REG_CMD);
	efm32_spi_write32(ddata, REG_CMD_RXEN | REG_CMD_TXEN, REG_CMD);

	return 0;
}

static void efm32_spi_tx_u8(struct efm32_spi_ddata *ddata)
{
	u8 val = 0;

	if (ddata->tx_buf) {
		val = *ddata->tx_buf;
		ddata->tx_buf++;
	}

	ddata->tx_len--;
	efm32_spi_write32(ddata, val, REG_TXDATA);
	efm32_spi_vdbg(ddata, "%s: tx 0x%x\n", __func__, val);
}

static void efm32_spi_rx_u8(struct efm32_spi_ddata *ddata)
{
	u32 rxdata = efm32_spi_read32(ddata, REG_RXDATAX);
	efm32_spi_vdbg(ddata, "%s: rx 0x%x\n", __func__, rxdata);

	if (ddata->rx_buf) {
		*ddata->rx_buf = rxdata;
		ddata->rx_buf++;
	}

	ddata->rx_len--;
}

static void efm32_spi_filltx(struct efm32_spi_ddata *ddata)
{
	while (ddata->tx_len &&
			ddata->tx_len + 2 > ddata->rx_len &&
			efm32_spi_read32(ddata, REG_STATUS) & REG_STATUS_TXBL) {
		efm32_spi_tx_u8(ddata);
	}
}

static int efm32_spi_txrx_bufs(struct spi_device *spi, struct spi_transfer *t)
{
	struct efm32_spi_ddata *ddata = spi_master_get_devdata(spi->master);
	int ret = -EBUSY;

	spin_lock_irq(&ddata->lock);

	if (ddata->tx_buf || ddata->rx_buf)
		goto out_unlock;

	ddata->tx_buf = t->tx_buf;
	ddata->rx_buf = t->rx_buf;
	ddata->tx_len = ddata->rx_len =
		t->len * DIV_ROUND_UP(t->bits_per_word, 8);

	efm32_spi_filltx(ddata);

	init_completion(&ddata->done);

	efm32_spi_write32(ddata, REG_IF_TXBL | REG_IF_RXDATAV, REG_IEN);

	spin_unlock_irq(&ddata->lock);

	wait_for_completion(&ddata->done);

	spin_lock_irq(&ddata->lock);

	ret = t->len - max(ddata->tx_len, ddata->rx_len);

	efm32_spi_write32(ddata, 0, REG_IEN);
	ddata->tx_buf = ddata->rx_buf = NULL;

out_unlock:
	spin_unlock_irq(&ddata->lock);

	return ret;
}

static irqreturn_t efm32_spi_rxirq(int irq, void *data)
{
	struct efm32_spi_ddata *ddata = data;
	irqreturn_t ret = IRQ_NONE;

	spin_lock(&ddata->lock);

	while (ddata->rx_len > 0 &&
			efm32_spi_read32(ddata, REG_STATUS) &
			REG_STATUS_RXDATAV) {
		efm32_spi_rx_u8(ddata);

		ret = IRQ_HANDLED;
	}

	if (!ddata->rx_len) {
		u32 ien = efm32_spi_read32(ddata, REG_IEN);

		ien &= ~REG_IF_RXDATAV;

		efm32_spi_write32(ddata, ien, REG_IEN);

		complete(&ddata->done);
	}

	spin_unlock(&ddata->lock);

	return ret;
}

static irqreturn_t efm32_spi_txirq(int irq, void *data)
{
	struct efm32_spi_ddata *ddata = data;

	efm32_spi_vdbg(ddata,
			"%s: txlen = %u, rxlen = %u, if=0x%08x, stat=0x%08x\n",
			__func__, ddata->tx_len, ddata->rx_len,
			efm32_spi_read32(ddata, REG_IF),
			efm32_spi_read32(ddata, REG_STATUS));

	spin_lock(&ddata->lock);

	efm32_spi_filltx(ddata);

	efm32_spi_vdbg(ddata, "%s: txlen = %u, rxlen = %u\n",
			__func__, ddata->tx_len, ddata->rx_len);

	if (!ddata->tx_len) {
		u32 ien = efm32_spi_read32(ddata, REG_IEN);

		ien &= ~REG_IF_TXBL;

		efm32_spi_write32(ddata, ien, REG_IEN);
		efm32_spi_vdbg(ddata, "disable TXBL\n");
	}

	spin_unlock(&ddata->lock);

	return IRQ_HANDLED;
}

static u32 efm32_spi_get_configured_location(struct efm32_spi_ddata *ddata)
{
	u32 reg = efm32_spi_read32(ddata, REG_ROUTE);

	return (reg & REG_ROUTE_LOCATION__MASK) >> __ffs(REG_ROUTE_LOCATION__MASK);
}

static int efm32_spi_probe_dt(struct platform_device *pdev,
		struct spi_master *master, struct efm32_spi_ddata *ddata)
{
	struct device_node *np = pdev->dev.of_node;
	u32 location;
	int ret;

	if (!np)
		return 1;

	ret = of_property_read_u32(np, "location", &location);
	if (!ret) {
		dev_dbg(&pdev->dev, "using location %u\n", location);
	} else {
		/* default to location configured in hardware */
		location = efm32_spi_get_configured_location(ddata);

		dev_info(&pdev->dev, "fall back to location %u\n", location);
	}

	ddata->pdata.location = location;
	return 0;
}

static int efm32_spi_probe(struct platform_device *pdev)
{
	struct efm32_spi_ddata *ddata;
	struct resource *res;
	int ret;
	struct spi_master *master;
	struct device_node *np = pdev->dev.of_node;
	unsigned int num_cs, i;

	num_cs = of_gpio_named_count(np, "cs-gpios");

	master = spi_alloc_master(&pdev->dev,
			sizeof(*ddata) + num_cs * sizeof(unsigned));
	if (!master) {
		dev_dbg(&pdev->dev,
				"failed to allocate spi master controller\n");
		return -ENOMEM;
	}
	platform_set_drvdata(pdev, master);

	master->dev.of_node = pdev->dev.of_node;

	master->num_chipselect = num_cs;
	master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_CS_HIGH;
	master->bits_per_word_mask = SPI_BPW_RANGE_MASK(4, 16);

	ddata = spi_master_get_devdata(master);

	ddata->bitbang.master = master;
	ddata->bitbang.chipselect = efm32_spi_chipselect;
	ddata->bitbang.setup_transfer = efm32_spi_setup_transfer;
	ddata->bitbang.txrx_bufs = efm32_spi_txrx_bufs;

	spin_lock_init(&ddata->lock);

	ddata->clk = devm_clk_get(&pdev->dev, NULL);
	if (IS_ERR(ddata->clk)) {
		ret = PTR_ERR(ddata->clk);
		dev_err(&pdev->dev, "failed to get clock: %d\n", ret);
		goto err;
	}

	for (i = 0; i < num_cs; ++i) {
		ret = of_get_named_gpio(np, "cs-gpios", i);
		if (ret < 0) {
			dev_err(&pdev->dev, "failed to get csgpio#%u (%d)\n",
					i, ret);
			goto err;
		}
		ddata->csgpio[i] = ret;
		dev_dbg(&pdev->dev, "csgpio#%u = %u\n", i, ddata->csgpio[i]);
		ret = devm_gpio_request_one(&pdev->dev, ddata->csgpio[i],
				GPIOF_OUT_INIT_LOW, DRIVER_NAME);
		if (ret < 0) {
			dev_err(&pdev->dev,
					"failed to configure csgpio#%u (%d)\n",
					i, ret);
			goto err;
		}
	}

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!res) {
		ret = -ENODEV;
		dev_err(&pdev->dev, "failed to determine base address\n");
		goto err;
	}

	if (resource_size(res) < 0x60) {
		ret = -EINVAL;
		dev_err(&pdev->dev, "memory resource too small\n");
		goto err;
	}

	ddata->base = devm_ioremap_resource(&pdev->dev, res);
	if (IS_ERR(ddata->base)) {
		ret = PTR_ERR(ddata->base);
		goto err;
	}

	ret = platform_get_irq(pdev, 0);
	if (ret <= 0) {
		dev_err(&pdev->dev, "failed to get rx irq (%d)\n", ret);
		goto err;
	}

	ddata->rxirq = ret;

	ret = platform_get_irq(pdev, 1);
	if (ret <= 0)
		ret = ddata->rxirq + 1;

	ddata->txirq = ret;

	ret = clk_prepare_enable(ddata->clk);
	if (ret < 0) {
		dev_err(&pdev->dev, "failed to enable clock (%d)\n", ret);
		goto err;
	}

	ret = efm32_spi_probe_dt(pdev, master, ddata);
	if (ret > 0) {
		/* not created by device tree */
		const struct efm32_spi_pdata *pdata =
			dev_get_platdata(&pdev->dev);

		if (pdata)
			ddata->pdata = *pdata;
		else
			ddata->pdata.location =
				efm32_spi_get_configured_location(ddata);

		master->bus_num = pdev->id;

	} else if (ret < 0) {
		goto err_disable_clk;
	}

	efm32_spi_write32(ddata, 0, REG_IEN);
	efm32_spi_write32(ddata, REG_ROUTE_TXPEN | REG_ROUTE_RXPEN |
			REG_ROUTE_CLKPEN |
			REG_ROUTE_LOCATION(ddata->pdata.location), REG_ROUTE);

	ret = request_irq(ddata->rxirq, efm32_spi_rxirq,
			0, DRIVER_NAME " rx", ddata);
	if (ret) {
		dev_err(&pdev->dev, "failed to register rxirq (%d)\n", ret);
		goto err_disable_clk;
	}

	ret = request_irq(ddata->txirq, efm32_spi_txirq,
			0, DRIVER_NAME " tx", ddata);
	if (ret) {
		dev_err(&pdev->dev, "failed to register txirq (%d)\n", ret);
		goto err_free_rx_irq;
	}

	ret = spi_bitbang_start(&ddata->bitbang);
	if (ret) {
		dev_err(&pdev->dev, "spi_bitbang_start failed (%d)\n", ret);

		free_irq(ddata->txirq, ddata);
err_free_rx_irq:
		free_irq(ddata->rxirq, ddata);
err_disable_clk:
		clk_disable_unprepare(ddata->clk);
err:
		spi_master_put(master);
	}

	return ret;
}

static int efm32_spi_remove(struct platform_device *pdev)
{
	struct spi_master *master = platform_get_drvdata(pdev);
	struct efm32_spi_ddata *ddata = spi_master_get_devdata(master);

	spi_bitbang_stop(&ddata->bitbang);

	efm32_spi_write32(ddata, 0, REG_IEN);

	free_irq(ddata->txirq, ddata);
	free_irq(ddata->rxirq, ddata);
	clk_disable_unprepare(ddata->clk);
	spi_master_put(master);

	return 0;
}

static const struct of_device_id efm32_spi_dt_ids[] = {
	{
		.compatible = "efm32,spi",
	}, {
		/* sentinel */
	}
};
MODULE_DEVICE_TABLE(of, efm32_spi_dt_ids);

static struct platform_driver efm32_spi_driver = {
	.probe = efm32_spi_probe,
	.remove = efm32_spi_remove,

	.driver = {
		.name = DRIVER_NAME,
		.owner = THIS_MODULE,
		.of_match_table = efm32_spi_dt_ids,
	},
};
module_platform_driver(efm32_spi_driver);

MODULE_AUTHOR("Uwe Kleine-Koenig <u.kleine-koenig@pengutronix.de>");
MODULE_DESCRIPTION("EFM32 SPI driver");
MODULE_LICENSE("GPL v2");
MODULE_ALIAS("platform:" DRIVER_NAME);
Commit	Line	Data
86f8973c UKK	1	/*
	2	* Copyright (C) 2012-2013 Uwe Kleine-Koenig for Pengutronix
	3	*
	4	* This program is free software; you can redistribute it and/or modify it under
	5	* the terms of the GNU General Public License version 2 as published by the
	6	* Free Software Foundation.
	7	*/
	8	#include <linux/kernel.h>
	9	#include <linux/io.h>
	10	#include <linux/spi/spi.h>
	11	#include <linux/spi/spi_bitbang.h>
	12	#include <linux/gpio.h>
	13	#include <linux/interrupt.h>
	14	#include <linux/platform_device.h>
	15	#include <linux/clk.h>
	16	#include <linux/err.h>
	17	#include <linux/module.h>
	18	#include <linux/of_gpio.h>
	19	#include <linux/platform_data/efm32-spi.h>
	20
	21	#define DRIVER_NAME "efm32-spi"
	22
	23	#define MASK_VAL(mask, val) ((val << __ffs(mask)) & mask)
	24
	25	#define REG_CTRL 0x00
	26	#define REG_CTRL_SYNC 0x0001
	27	#define REG_CTRL_CLKPOL 0x0100
	28	#define REG_CTRL_CLKPHA 0x0200
	29	#define REG_CTRL_MSBF 0x0400
	30	#define REG_CTRL_TXBIL 0x1000
	31
	32	#define REG_FRAME 0x04
	33	#define REG_FRAME_DATABITS__MASK 0x000f
	34	#define REG_FRAME_DATABITS(n) ((n) - 3)
	35
	36	#define REG_CMD 0x0c
	37	#define REG_CMD_RXEN 0x0001
	38	#define REG_CMD_RXDIS 0x0002
	39	#define REG_CMD_TXEN 0x0004
	40	#define REG_CMD_TXDIS 0x0008
	41	#define REG_CMD_MASTEREN 0x0010
	42
	43	#define REG_STATUS 0x10
	44	#define REG_STATUS_TXENS 0x0002
	45	#define REG_STATUS_TXC 0x0020
	46	#define REG_STATUS_TXBL 0x0040
	47	#define REG_STATUS_RXDATAV 0x0080
	48
	49	#define REG_CLKDIV 0x14
	50
	51	#define REG_RXDATAX 0x18
	52	#define REG_RXDATAX_RXDATA__MASK 0x01ff
	53	#define REG_RXDATAX_PERR 0x4000
	54	#define REG_RXDATAX_FERR 0x8000
	55
	56	#define REG_TXDATA 0x34
	57
	58	#define REG_IF 0x40
	59	#define REG_IF_TXBL 0x0002
	60	#define REG_IF_RXDATAV 0x0004
	61
	62	#define REG_IFS 0x44
	63	#define REG_IFC 0x48
	64	#define REG_IEN 0x4c
65
66	#define REG_ROUTE 0x54
67	#define REG_ROUTE_RXPEN 0x0001
68	#define REG_ROUTE_TXPEN 0x0002
69	#define REG_ROUTE_CLKPEN 0x0008
70	#define REG_ROUTE_LOCATION__MASK 0x0700
71	#define REG_ROUTE_LOCATION(n) MASK_VAL(REG_ROUTE_LOCATION__MASK, (n))
72
73	struct efm32_spi_ddata {
74	struct spi_bitbang bitbang;
75
76	spinlock_t lock;
77
78	struct clk *clk;
79	void __iomem *base;
80	unsigned int rxirq, txirq;
81	struct efm32_spi_pdata pdata;
82
83	/* irq data */
84	struct completion done;
85	const u8 *tx_buf;
86	u8 *rx_buf;
87	unsigned tx_len, rx_len;
88
89	/* chip selects */
90	unsigned csgpio[];
91	};
92
93	#define ddata_to_dev(ddata) (&(ddata->bitbang.master->dev))
94	#define efm32_spi_vdbg(ddata, format, arg...) \
95	dev_vdbg(ddata_to_dev(ddata), format, ##arg)
96
97	static void efm32_spi_write32(struct efm32_spi_ddata *ddata,
98	u32 value, unsigned offset)
99	{
100	writel_relaxed(value, ddata->base + offset);
101	}
102
103	static u32 efm32_spi_read32(struct efm32_spi_ddata *ddata, unsigned offset)
104	{
105	return readl_relaxed(ddata->base + offset);
106	}
107
108	static void efm32_spi_chipselect(struct spi_device *spi, int is_on)
109	{
110	struct efm32_spi_ddata *ddata = spi_master_get_devdata(spi->master);
111	int value = !(spi->mode & SPI_CS_HIGH) == !(is_on == BITBANG_CS_ACTIVE);
112
113	gpio_set_value(ddata->csgpio[spi->chip_select], value);
114	}
115
116	static int efm32_spi_setup_transfer(struct spi_device *spi,
117	struct spi_transfer *t)
118	{
119	struct efm32_spi_ddata *ddata = spi_master_get_devdata(spi->master);
120
121	unsigned bpw = t->bits_per_word ?: spi->bits_per_word;
122	unsigned speed = t->speed_hz ?: spi->max_speed_hz;
123	unsigned long clkfreq = clk_get_rate(ddata->clk);
124	u32 clkdiv;
125
126	efm32_spi_write32(ddata, REG_CTRL_SYNC \| REG_CTRL_MSBF \|
127	(spi->mode & SPI_CPHA ? REG_CTRL_CLKPHA : 0) \|
128	(spi->mode & SPI_CPOL ? REG_CTRL_CLKPOL : 0), REG_CTRL);
129
130	efm32_spi_write32(ddata,
131	REG_FRAME_DATABITS(bpw), REG_FRAME);
132
133	if (2 * speed >= clkfreq)
134	clkdiv = 0;
135	else
136	clkdiv = 64 * (DIV_ROUND_UP(2 * clkfreq, speed) - 4);
137
138	if (clkdiv > (1U << 21))
139	return -EINVAL;
140
141	efm32_spi_write32(ddata, clkdiv, REG_CLKDIV);
142	efm32_spi_write32(ddata, REG_CMD_MASTEREN, REG_CMD);
143	efm32_spi_write32(ddata, REG_CMD_RXEN \| REG_CMD_TXEN, REG_CMD);
144
145	return 0;
146	}
147
148	static void efm32_spi_tx_u8(struct efm32_spi_ddata *ddata)
149	{
150	u8 val = 0;
151
152	if (ddata->tx_buf) {
153	val = *ddata->tx_buf;
154	ddata->tx_buf++;
155	}
156
157	ddata->tx_len--;
158	efm32_spi_write32(ddata, val, REG_TXDATA);
159	efm32_spi_vdbg(ddata, "%s: tx 0x%x\n", __func__, val);
160	}
161
162	static void efm32_spi_rx_u8(struct efm32_spi_ddata *ddata)
163	{
164	u32 rxdata = efm32_spi_read32(ddata, REG_RXDATAX);
165	efm32_spi_vdbg(ddata, "%s: rx 0x%x\n", __func__, rxdata);
166
167	if (ddata->rx_buf) {
168	*ddata->rx_buf = rxdata;
169	ddata->rx_buf++;
170	}
171
172	ddata->rx_len--;
173	}
174
175	static void efm32_spi_filltx(struct efm32_spi_ddata *ddata)
176	{
177	while (ddata->tx_len &&
178	ddata->tx_len + 2 > ddata->rx_len &&
179	efm32_spi_read32(ddata, REG_STATUS) & REG_STATUS_TXBL) {
180	efm32_spi_tx_u8(ddata);
181	}
182	}
183
184	static int efm32_spi_txrx_bufs(struct spi_device spi, struct spi_transfer t)
185	{
186	struct efm32_spi_ddata *ddata = spi_master_get_devdata(spi->master);
187	int ret = -EBUSY;
188
189	spin_lock_irq(&ddata->lock);
190
191	if (ddata->tx_buf \|\| ddata->rx_buf)
192	goto out_unlock;
193
194	ddata->tx_buf = t->tx_buf;
195	ddata->rx_buf = t->rx_buf;
196	ddata->tx_len = ddata->rx_len =
197	t->len * DIV_ROUND_UP(t->bits_per_word, 8);
198
199	efm32_spi_filltx(ddata);
200
201	init_completion(&ddata->done);
202
203	efm32_spi_write32(ddata, REG_IF_TXBL \| REG_IF_RXDATAV, REG_IEN);
204
205	spin_unlock_irq(&ddata->lock);
206
207	wait_for_completion(&ddata->done);
208
209	spin_lock_irq(&ddata->lock);
210
211	ret = t->len - max(ddata->tx_len, ddata->rx_len);
212
213	efm32_spi_write32(ddata, 0, REG_IEN);
214	ddata->tx_buf = ddata->rx_buf = NULL;
215
216	out_unlock:
217	spin_unlock_irq(&ddata->lock);
218
219	return ret;
220	}
221
222	static irqreturn_t efm32_spi_rxirq(int irq, void *data)
223	{
224	struct efm32_spi_ddata *ddata = data;
225	irqreturn_t ret = IRQ_NONE;
226
227	spin_lock(&ddata->lock);
228
229	while (ddata->rx_len > 0 &&
230	efm32_spi_read32(ddata, REG_STATUS) &
231	REG_STATUS_RXDATAV) {
232	efm32_spi_rx_u8(ddata);
233
234	ret = IRQ_HANDLED;
235	}
236
237	if (!ddata->rx_len) {
238	u32 ien = efm32_spi_read32(ddata, REG_IEN);
239
240	ien &= ~REG_IF_RXDATAV;
241
242	efm32_spi_write32(ddata, ien, REG_IEN);
243
244	complete(&ddata->done);
245	}
246
247	spin_unlock(&ddata->lock);
248
249	return ret;
250	}
251
252	static irqreturn_t efm32_spi_txirq(int irq, void *data)
253	{
254	struct efm32_spi_ddata *ddata = data;
255
256	efm32_spi_vdbg(ddata,
257	"%s: txlen = %u, rxlen = %u, if=0x%08x, stat=0x%08x\n",
258	__func__, ddata->tx_len, ddata->rx_len,
259	efm32_spi_read32(ddata, REG_IF),
260	efm32_spi_read32(ddata, REG_STATUS));
261
262	spin_lock(&ddata->lock);
263
264	efm32_spi_filltx(ddata);
265
266	efm32_spi_vdbg(ddata, "%s: txlen = %u, rxlen = %u\n",
267	__func__, ddata->tx_len, ddata->rx_len);
268
269	if (!ddata->tx_len) {
270	u32 ien = efm32_spi_read32(ddata, REG_IEN);
271
272	ien &= ~REG_IF_TXBL;
273
274	efm32_spi_write32(ddata, ien, REG_IEN);
275	efm32_spi_vdbg(ddata, "disable TXBL\n");
276	}
277
278	spin_unlock(&ddata->lock);
279
280	return IRQ_HANDLED;
281	}
282
86f8973c UKK	283	static u32 efm32_spi_get_configured_location(struct efm32_spi_ddata *ddata)
	284	{
	285	u32 reg = efm32_spi_read32(ddata, REG_ROUTE);
	286
	287	return (reg & REG_ROUTE_LOCATION__MASK) >> __ffs(REG_ROUTE_LOCATION__MASK);
	288	}
	289
	290	static int efm32_spi_probe_dt(struct platform_device *pdev,
	291	struct spi_master master, struct efm32_spi_ddata ddata)
	292	{
	293	struct device_node *np = pdev->dev.of_node;
	294	u32 location;
	295	int ret;
	296
	297	if (!np)
	298	return 1;
	299
	300	ret = of_property_read_u32(np, "location", &location);
	301	if (!ret) {
	302	dev_dbg(&pdev->dev, "using location %u\n", location);
	303	} else {
	304	/* default to location configured in hardware */
	305	location = efm32_spi_get_configured_location(ddata);
	306
	307	dev_info(&pdev->dev, "fall back to location %u\n", location);
	308	}
	309
	310	ddata->pdata.location = location;
86f8973c UKK	311	return 0;
	312	}
	313
	314	static int efm32_spi_probe(struct platform_device *pdev)
	315	{
	316	struct efm32_spi_ddata *ddata;
	317	struct resource *res;
	318	int ret;
	319	struct spi_master *master;
	320	struct device_node *np = pdev->dev.of_node;
	321	unsigned int num_cs, i;
	322
	323	num_cs = of_gpio_named_count(np, "cs-gpios");
	324
	325	master = spi_alloc_master(&pdev->dev,
	326	sizeof(ddata) + num_cs sizeof(unsigned));
	327	if (!master) {
	328	dev_dbg(&pdev->dev,
	329	"failed to allocate spi master controller\n");
	330	return -ENOMEM;
	331	}
	332	platform_set_drvdata(pdev, master);
	333
	334	master->dev.of_node = pdev->dev.of_node;
	335
	336	master->num_chipselect = num_cs;
	337	master->mode_bits = SPI_CPOL \| SPI_CPHA \| SPI_CS_HIGH;
	338	master->bits_per_word_mask = SPI_BPW_RANGE_MASK(4, 16);
	339
	340	ddata = spi_master_get_devdata(master);
	341
702a4879	342	ddata->bitbang.master = master;
86f8973c UKK	343	ddata->bitbang.chipselect = efm32_spi_chipselect;
	344	ddata->bitbang.setup_transfer = efm32_spi_setup_transfer;
	345	ddata->bitbang.txrx_bufs = efm32_spi_txrx_bufs;
	346
	347	spin_lock_init(&ddata->lock);
	348
	349	ddata->clk = devm_clk_get(&pdev->dev, NULL);
	350	if (IS_ERR(ddata->clk)) {
	351	ret = PTR_ERR(ddata->clk);
	352	dev_err(&pdev->dev, "failed to get clock: %d\n", ret);
	353	goto err;
	354	}
	355
	356	for (i = 0; i < num_cs; ++i) {
	357	ret = of_get_named_gpio(np, "cs-gpios", i);
	358	if (ret < 0) {
	359	dev_err(&pdev->dev, "failed to get csgpio#%u (%d)\n",
	360	i, ret);
	361	goto err;
	362	}
	363	ddata->csgpio[i] = ret;
	364	dev_dbg(&pdev->dev, "csgpio#%u = %u\n", i, ddata->csgpio[i]);
	365	ret = devm_gpio_request_one(&pdev->dev, ddata->csgpio[i],
	366	GPIOF_OUT_INIT_LOW, DRIVER_NAME);
	367	if (ret < 0) {
	368	dev_err(&pdev->dev,
	369	"failed to configure csgpio#%u (%d)\n",
	370	i, ret);
	371	goto err;
	372	}
	373	}
	374
	375	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	376	if (!res) {
	377	ret = -ENODEV;
	378	dev_err(&pdev->dev, "failed to determine base address\n");
	379	goto err;
	380	}
	381
6a009e8d	382	if (resource_size(res) < 0x60) {
86f8973c UKK	383	ret = -EINVAL;
	384	dev_err(&pdev->dev, "memory resource too small\n");
	385	goto err;
	386	}
	387
	388	ddata->base = devm_ioremap_resource(&pdev->dev, res);
	389	if (IS_ERR(ddata->base)) {
	390	ret = PTR_ERR(ddata->base);
86f8973c UKK	391	goto err;
	392	}
	393
	394	ret = platform_get_irq(pdev, 0);
	395	if (ret <= 0) {
	396	dev_err(&pdev->dev, "failed to get rx irq (%d)\n", ret);
	397	goto err;
	398	}
	399
	400	ddata->rxirq = ret;
	401
	402	ret = platform_get_irq(pdev, 1);
	403	if (ret <= 0)
	404	ret = ddata->rxirq + 1;
	405
	406	ddata->txirq = ret;
	407
	408	ret = clk_prepare_enable(ddata->clk);
	409	if (ret < 0) {
	410	dev_err(&pdev->dev, "failed to enable clock (%d)\n", ret);
	411	goto err;
	412	}
	413
	414	ret = efm32_spi_probe_dt(pdev, master, ddata);
	415	if (ret > 0) {
	416	/* not created by device tree */
	417	const struct efm32_spi_pdata *pdata =
	418	dev_get_platdata(&pdev->dev);
	419
	420	if (pdata)
	421	ddata->pdata = *pdata;
	422	else
	423	ddata->pdata.location =
	424	efm32_spi_get_configured_location(ddata);
	425
	426	master->bus_num = pdev->id;
	427
	428	} else if (ret < 0) {
	429	goto err_disable_clk;
	430	}
	431
	432	efm32_spi_write32(ddata, 0, REG_IEN);
	433	efm32_spi_write32(ddata, REG_ROUTE_TXPEN \| REG_ROUTE_RXPEN \|
	434	REG_ROUTE_CLKPEN \|
	435	REG_ROUTE_LOCATION(ddata->pdata.location), REG_ROUTE);
	436
	437	ret = request_irq(ddata->rxirq, efm32_spi_rxirq,
	438	0, DRIVER_NAME " rx", ddata);
	439	if (ret) {
	440	dev_err(&pdev->dev, "failed to register rxirq (%d)\n", ret);
	441	goto err_disable_clk;
	442	}
	443
	444	ret = request_irq(ddata->txirq, efm32_spi_txirq,
	445	0, DRIVER_NAME " tx", ddata);
	446	if (ret) {
	447	dev_err(&pdev->dev, "failed to register txirq (%d)\n", ret);
	448	goto err_free_rx_irq;
	449	}
	450
	451	ret = spi_bitbang_start(&ddata->bitbang);
	452	if (ret) {
	453	dev_err(&pdev->dev, "spi_bitbang_start failed (%d)\n", ret);
	454
455	free_irq(ddata->txirq, ddata);
456	err_free_rx_irq:
457	free_irq(ddata->rxirq, ddata);
458	err_disable_clk:
459	clk_disable_unprepare(ddata->clk);
460	err:
461	spi_master_put(master);
86f8973c UKK	462	}
	463
	464	return ret;
	465	}
	466
	467	static int efm32_spi_remove(struct platform_device *pdev)
	468	{
	469	struct spi_master *master = platform_get_drvdata(pdev);
	470	struct efm32_spi_ddata *ddata = spi_master_get_devdata(master);
	471
e6f7563b UKK	472	spi_bitbang_stop(&ddata->bitbang);
e6f7563b UKK	473
86f8973c UKK	474	efm32_spi_write32(ddata, 0, REG_IEN);
	475
	476	free_irq(ddata->txirq, ddata);
	477	free_irq(ddata->rxirq, ddata);
	478	clk_disable_unprepare(ddata->clk);
	479	spi_master_put(master);
86f8973c UKK	480
	481	return 0;
	482	}
	483
	484	static const struct of_device_id efm32_spi_dt_ids[] = {
	485	{
	486	.compatible = "efm32,spi",
	487	}, {
	488	/* sentinel */
	489	}
	490	};
d8851a0d	491	MODULE_DEVICE_TABLE(of, efm32_spi_dt_ids);
86f8973c UKK	492
	493	static struct platform_driver efm32_spi_driver = {
	494	.probe = efm32_spi_probe,
	495	.remove = efm32_spi_remove,
	496
	497	.driver = {
	498	.name = DRIVER_NAME,
	499	.owner = THIS_MODULE,
	500	.of_match_table = efm32_spi_dt_ids,
	501	},
	502	};
	503	module_platform_driver(efm32_spi_driver);
	504
	505	MODULE_AUTHOR("Uwe Kleine-Koenig <u.kleine-koenig@pengutronix.de>");
	506	MODULE_DESCRIPTION("EFM32 SPI driver");
	507	MODULE_LICENSE("GPL v2");
	508	MODULE_ALIAS("platform:" DRIVER_NAME);