[linux.git] / drivers / spi / spi-st-ssc4.c

/*
 *  Copyright (c) 2008-2014 STMicroelectronics Limited
 *
 *  Author: Angus Clark <[email protected]>
 *          Patrice Chotard <[email protected]>
 *          Lee Jones <[email protected]>
 *
 *  SPI master mode controller driver, used in STMicroelectronics devices.
 *
 *  May be copied or modified under the terms of the GNU General Public
 *  License Version 2.0 only.  See linux/COPYING for more information.
 */

#include <linux/clk.h>
#include <linux/delay.h>
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/module.h>
#include <linux/pinctrl/consumer.h>
#include <linux/platform_device.h>
#include <linux/of.h>
#include <linux/of_gpio.h>
#include <linux/of_irq.h>
#include <linux/pm_runtime.h>
#include <linux/spi/spi.h>
#include <linux/spi/spi_bitbang.h>

/* SSC registers */
#define SSC_BRG				0x000
#define SSC_TBUF			0x004
#define SSC_RBUF			0x008
#define SSC_CTL				0x00C
#define SSC_IEN				0x010
#define SSC_I2C				0x018

/* SSC Control */
#define SSC_CTL_DATA_WIDTH_9		0x8
#define SSC_CTL_DATA_WIDTH_MSK		0xf
#define SSC_CTL_BM			0xf
#define SSC_CTL_HB			BIT(4)
#define SSC_CTL_PH			BIT(5)
#define SSC_CTL_PO			BIT(6)
#define SSC_CTL_SR			BIT(7)
#define SSC_CTL_MS			BIT(8)
#define SSC_CTL_EN			BIT(9)
#define SSC_CTL_LPB			BIT(10)
#define SSC_CTL_EN_TX_FIFO		BIT(11)
#define SSC_CTL_EN_RX_FIFO		BIT(12)
#define SSC_CTL_EN_CLST_RX		BIT(13)

/* SSC Interrupt Enable */
#define SSC_IEN_TEEN			BIT(2)

#define FIFO_SIZE			8

struct spi_st {
	/* SSC SPI Controller */
	void __iomem		*base;
	struct clk		*clk;
	struct device		*dev;

	/* SSC SPI current transaction */
	const u8		*tx_ptr;
	u8			*rx_ptr;
	u16			bytes_per_word;
	unsigned int		words_remaining;
	unsigned int		baud;
	struct completion	done;
};

static int spi_st_clk_enable(struct spi_st *spi_st)
{
	/*
	 * Current platforms use one of the core clocks for SPI and I2C.
	 * If we attempt to disable the clock, the system will hang.
	 *
	 * TODO: Remove this when platform supports power domains.
	 */
	return 0;

	return clk_prepare_enable(spi_st->clk);
}

static void spi_st_clk_disable(struct spi_st *spi_st)
{
	/*
	 * Current platforms use one of the core clocks for SPI and I2C.
	 * If we attempt to disable the clock, the system will hang.
	 *
	 * TODO: Remove this when platform supports power domains.
	 */
	return;

	clk_disable_unprepare(spi_st->clk);
}

/* Load the TX FIFO */
static void ssc_write_tx_fifo(struct spi_st *spi_st)
{
	unsigned int count, i;
	uint32_t word = 0;

	if (spi_st->words_remaining > FIFO_SIZE)
		count = FIFO_SIZE;
	else
		count = spi_st->words_remaining;

	for (i = 0; i < count; i++) {
		if (spi_st->tx_ptr) {
			if (spi_st->bytes_per_word == 1) {
				word = *spi_st->tx_ptr++;
			} else {
				word = *spi_st->tx_ptr++;
				word = *spi_st->tx_ptr++ | (word << 8);
			}
		}
		writel_relaxed(word, spi_st->base + SSC_TBUF);
	}
}

/* Read the RX FIFO */
static void ssc_read_rx_fifo(struct spi_st *spi_st)
{
	unsigned int count, i;
	uint32_t word = 0;

	if (spi_st->words_remaining > FIFO_SIZE)
		count = FIFO_SIZE;
	else
		count = spi_st->words_remaining;

	for (i = 0; i < count; i++) {
		word = readl_relaxed(spi_st->base + SSC_RBUF);

		if (spi_st->rx_ptr) {
			if (spi_st->bytes_per_word == 1) {
				*spi_st->rx_ptr++ = (uint8_t)word;
			} else {
				*spi_st->rx_ptr++ = (word >> 8);
				*spi_st->rx_ptr++ = word & 0xff;
			}
		}
	}
	spi_st->words_remaining -= count;
}

static int spi_st_transfer_one(struct spi_master *master,
			       struct spi_device *spi, struct spi_transfer *t)
{
	struct spi_st *spi_st = spi_master_get_devdata(master);
	uint32_t ctl = 0;

	/* Setup transfer */
	spi_st->tx_ptr = t->tx_buf;
	spi_st->rx_ptr = t->rx_buf;

	if (spi->bits_per_word > 8) {
		/*
		 * Anything greater than 8 bits-per-word requires 2
		 * bytes-per-word in the RX/TX buffers
		 */
		spi_st->bytes_per_word = 2;
		spi_st->words_remaining = t->len / 2;

	} else if (spi->bits_per_word == 8 && !(t->len & 0x1)) {
		/*
		 * If transfer is even-length, and 8 bits-per-word, then
		 * implement as half-length 16 bits-per-word transfer
		 */
		spi_st->bytes_per_word = 2;
		spi_st->words_remaining = t->len / 2;

		/* Set SSC_CTL to 16 bits-per-word */
		ctl = readl_relaxed(spi_st->base + SSC_CTL);
		writel_relaxed((ctl | 0xf), spi_st->base + SSC_CTL);

		readl_relaxed(spi_st->base + SSC_RBUF);

	} else {
		spi_st->bytes_per_word = 1;
		spi_st->words_remaining = t->len;
	}

	reinit_completion(&spi_st->done);

	/* Start transfer by writing to the TX FIFO */
	ssc_write_tx_fifo(spi_st);
	writel_relaxed(SSC_IEN_TEEN, spi_st->base + SSC_IEN);

	/* Wait for transfer to complete */
	wait_for_completion(&spi_st->done);

	/* Restore SSC_CTL if necessary */
	if (ctl)
		writel_relaxed(ctl, spi_st->base + SSC_CTL);

	spi_finalize_current_transfer(spi->master);

	return t->len;
}

static void spi_st_cleanup(struct spi_device *spi)
{
	int cs = spi->cs_gpio;

	if (gpio_is_valid(cs))
		devm_gpio_free(&spi->dev, cs);
}

/* the spi->mode bits understood by this driver: */
#define MODEBITS  (SPI_CPOL | SPI_CPHA | SPI_LSB_FIRST | SPI_LOOP | SPI_CS_HIGH)
static int spi_st_setup(struct spi_device *spi)
{
	struct spi_st *spi_st = spi_master_get_devdata(spi->master);
	u32 spi_st_clk, sscbrg, var;
	u32 hz = spi->max_speed_hz;
	int cs = spi->cs_gpio;
	int ret;

	if (!hz)  {
		dev_err(&spi->dev, "max_speed_hz unspecified\n");
		return -EINVAL;
	}

	if (!gpio_is_valid(cs)) {
		dev_err(&spi->dev, "%d is not a valid gpio\n", cs);
		return -EINVAL;
	}

	if (devm_gpio_request(&spi->dev, cs, dev_name(&spi->dev))) {
		dev_err(&spi->dev, "could not request gpio:%d\n", cs);
		return -EINVAL;
	}

	ret = gpio_direction_output(cs, spi->mode & SPI_CS_HIGH);
	if (ret)
		return ret;

	spi_st_clk = clk_get_rate(spi_st->clk);

	/* Set SSC_BRF */
	sscbrg = spi_st_clk / (2 * hz);
	if (sscbrg < 0x07 || sscbrg > BIT(16)) {
		dev_err(&spi->dev,
			"baudrate %d outside valid range %d\n", sscbrg, hz);
		return -EINVAL;
	}

	spi_st->baud = spi_st_clk / (2 * sscbrg);
	if (sscbrg == BIT(16)) /* 16-bit counter wraps */
		sscbrg = 0x0;

	writel_relaxed(sscbrg, spi_st->base + SSC_BRG);

	dev_dbg(&spi->dev,
		"setting baudrate:target= %u hz, actual= %u hz, sscbrg= %u\n",
		hz, spi_st->baud, sscbrg);

	 /* Set SSC_CTL and enable SSC */
	 var = readl_relaxed(spi_st->base + SSC_CTL);
	 var |= SSC_CTL_MS;

	 if (spi->mode & SPI_CPOL)
		var |= SSC_CTL_PO;
	 else
		var &= ~SSC_CTL_PO;

	 if (spi->mode & SPI_CPHA)
		var |= SSC_CTL_PH;
	 else
		var &= ~SSC_CTL_PH;

	 if ((spi->mode & SPI_LSB_FIRST) == 0)
		var |= SSC_CTL_HB;
	 else
		var &= ~SSC_CTL_HB;

	 if (spi->mode & SPI_LOOP)
		var |= SSC_CTL_LPB;
	 else
		var &= ~SSC_CTL_LPB;

	 var &= ~SSC_CTL_DATA_WIDTH_MSK;
	 var |= (spi->bits_per_word - 1);

	 var |= SSC_CTL_EN_TX_FIFO | SSC_CTL_EN_RX_FIFO;
	 var |= SSC_CTL_EN;

	 writel_relaxed(var, spi_st->base + SSC_CTL);

	 /* Clear the status register */
	 readl_relaxed(spi_st->base + SSC_RBUF);

	 return 0;
}

/* Interrupt fired when TX shift register becomes empty */
static irqreturn_t spi_st_irq(int irq, void *dev_id)
{
	struct spi_st *spi_st = (struct spi_st *)dev_id;

	/* Read RX FIFO */
	ssc_read_rx_fifo(spi_st);

	/* Fill TX FIFO */
	if (spi_st->words_remaining) {
		ssc_write_tx_fifo(spi_st);
	} else {
		/* TX/RX complete */
		writel_relaxed(0x0, spi_st->base + SSC_IEN);
		/*
		 * read SSC_IEN to ensure that this bit is set
		 * before re-enabling interrupt
		 */
		readl(spi_st->base + SSC_IEN);
		complete(&spi_st->done);
	}

	return IRQ_HANDLED;
}

static int spi_st_probe(struct platform_device *pdev)
{
	struct device_node *np = pdev->dev.of_node;
	struct spi_master *master;
	struct resource *res;
	struct spi_st *spi_st;
	int irq, ret = 0;
	u32 var;

	master = spi_alloc_master(&pdev->dev, sizeof(*spi_st));
	if (!master)
		return -ENOMEM;

	master->dev.of_node		= np;
	master->mode_bits		= MODEBITS;
	master->setup			= spi_st_setup;
	master->cleanup			= spi_st_cleanup;
	master->transfer_one		= spi_st_transfer_one;
	master->bits_per_word_mask	= SPI_BPW_MASK(8) | SPI_BPW_MASK(16);
	master->auto_runtime_pm		= true;
	master->bus_num			= pdev->id;
	spi_st				= spi_master_get_devdata(master);

	spi_st->clk = devm_clk_get(&pdev->dev, "ssc");
	if (IS_ERR(spi_st->clk)) {
		dev_err(&pdev->dev, "Unable to request clock\n");
		return PTR_ERR(spi_st->clk);
	}

	ret = spi_st_clk_enable(spi_st);
	if (ret)
		return ret;

	init_completion(&spi_st->done);

	/* Get resources */
	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	spi_st->base = devm_ioremap_resource(&pdev->dev, res);
	if (IS_ERR(spi_st->base)) {
		ret = PTR_ERR(spi_st->base);
		goto clk_disable;
	}

	/* Disable I2C and Reset SSC */
	writel_relaxed(0x0, spi_st->base + SSC_I2C);
	var = readw_relaxed(spi_st->base + SSC_CTL);
	var |= SSC_CTL_SR;
	writel_relaxed(var, spi_st->base + SSC_CTL);

	udelay(1);
	var = readl_relaxed(spi_st->base + SSC_CTL);
	var &= ~SSC_CTL_SR;
	writel_relaxed(var, spi_st->base + SSC_CTL);

	/* Set SSC into slave mode before reconfiguring PIO pins */
	var = readl_relaxed(spi_st->base + SSC_CTL);
	var &= ~SSC_CTL_MS;
	writel_relaxed(var, spi_st->base + SSC_CTL);

	irq = irq_of_parse_and_map(np, 0);
	if (!irq) {
		dev_err(&pdev->dev, "IRQ missing or invalid\n");
		ret = -EINVAL;
		goto clk_disable;
	}

	ret = devm_request_irq(&pdev->dev, irq, spi_st_irq, 0,
			       pdev->name, spi_st);
	if (ret) {
		dev_err(&pdev->dev, "Failed to request irq %d\n", irq);
		goto clk_disable;
	}

	/* by default the device is on */
	pm_runtime_set_active(&pdev->dev);
	pm_runtime_enable(&pdev->dev);

	platform_set_drvdata(pdev, master);

	ret = devm_spi_register_master(&pdev->dev, master);
	if (ret) {
		dev_err(&pdev->dev, "Failed to register master\n");
		goto clk_disable;
	}

	return 0;

clk_disable:
	spi_st_clk_disable(spi_st);

	return ret;
}

static int spi_st_remove(struct platform_device *pdev)
{
	struct spi_master *master = platform_get_drvdata(pdev);
	struct spi_st *spi_st = spi_master_get_devdata(master);

	spi_st_clk_disable(spi_st);

	pinctrl_pm_select_sleep_state(&pdev->dev);

	return 0;
}

#ifdef CONFIG_PM
static int spi_st_runtime_suspend(struct device *dev)
{
	struct spi_master *master = dev_get_drvdata(dev);
	struct spi_st *spi_st = spi_master_get_devdata(master);

	writel_relaxed(0, spi_st->base + SSC_IEN);
	pinctrl_pm_select_sleep_state(dev);

	spi_st_clk_disable(spi_st);

	return 0;
}

static int spi_st_runtime_resume(struct device *dev)
{
	struct spi_master *master = dev_get_drvdata(dev);
	struct spi_st *spi_st = spi_master_get_devdata(master);
	int ret;

	ret = spi_st_clk_enable(spi_st);
	pinctrl_pm_select_default_state(dev);

	return ret;
}
#endif

#ifdef CONFIG_PM_SLEEP
static int spi_st_suspend(struct device *dev)
{
	struct spi_master *master = dev_get_drvdata(dev);
	int ret;

	ret = spi_master_suspend(master);
	if (ret)
		return ret;

	return pm_runtime_force_suspend(dev);
}

static int spi_st_resume(struct device *dev)
{
	struct spi_master *master = dev_get_drvdata(dev);
	int ret;

	ret = spi_master_resume(master);
	if (ret)
		return ret;

	return pm_runtime_force_resume(dev);
}
#endif

static const struct dev_pm_ops spi_st_pm = {
	SET_SYSTEM_SLEEP_PM_OPS(spi_st_suspend, spi_st_resume)
	SET_RUNTIME_PM_OPS(spi_st_runtime_suspend, spi_st_runtime_resume, NULL)
};

static const struct of_device_id stm_spi_match[] = {
	{ .compatible = "st,comms-ssc4-spi", },
	{},
};
MODULE_DEVICE_TABLE(of, stm_spi_match);

static struct platform_driver spi_st_driver = {
	.driver = {
		.name = "spi-st",
		.pm = &spi_st_pm,
		.of_match_table = of_match_ptr(stm_spi_match),
	},
	.probe = spi_st_probe,
	.remove = spi_st_remove,
};
module_platform_driver(spi_st_driver);

MODULE_AUTHOR("Patrice Chotard <[email protected]>");
MODULE_DESCRIPTION("STM SSC SPI driver");
MODULE_LICENSE("GPL v2");
Commit	Line	Data
9e862375 LJ	1	/*
	2	* Copyright (c) 2008-2014 STMicroelectronics Limited
	3	*
	4	* Author: Angus Clark <[email protected]>
	5	* Patrice Chotard <[email protected]>
	6	* Lee Jones <[email protected]>
	7	*
	8	* SPI master mode controller driver, used in STMicroelectronics devices.
	9	*
	10	* May be copied or modified under the terms of the GNU General Public
	11	* License Version 2.0 only. See linux/COPYING for more information.
	12	*/
	13
	14	#include <linux/clk.h>
	15	#include <linux/delay.h>
	16	#include <linux/interrupt.h>
	17	#include <linux/io.h>
	18	#include <linux/module.h>
	19	#include <linux/pinctrl/consumer.h>
	20	#include <linux/platform_device.h>
	21	#include <linux/of.h>
	22	#include <linux/of_gpio.h>
	23	#include <linux/of_irq.h>
	24	#include <linux/pm_runtime.h>
	25	#include <linux/spi/spi.h>
	26	#include <linux/spi/spi_bitbang.h>
	27
	28	/* SSC registers */
	29	#define SSC_BRG 0x000
	30	#define SSC_TBUF 0x004
	31	#define SSC_RBUF 0x008
	32	#define SSC_CTL 0x00C
	33	#define SSC_IEN 0x010
	34	#define SSC_I2C 0x018
	35
	36	/* SSC Control */
	37	#define SSC_CTL_DATA_WIDTH_9 0x8
	38	#define SSC_CTL_DATA_WIDTH_MSK 0xf
	39	#define SSC_CTL_BM 0xf
	40	#define SSC_CTL_HB BIT(4)
	41	#define SSC_CTL_PH BIT(5)
	42	#define SSC_CTL_PO BIT(6)
	43	#define SSC_CTL_SR BIT(7)
	44	#define SSC_CTL_MS BIT(8)
	45	#define SSC_CTL_EN BIT(9)
	46	#define SSC_CTL_LPB BIT(10)
	47	#define SSC_CTL_EN_TX_FIFO BIT(11)
	48	#define SSC_CTL_EN_RX_FIFO BIT(12)
	49	#define SSC_CTL_EN_CLST_RX BIT(13)
	50
	51	/* SSC Interrupt Enable */
	52	#define SSC_IEN_TEEN BIT(2)
	53
	54	#define FIFO_SIZE 8
	55
	56	struct spi_st {
	57	/* SSC SPI Controller */
	58	void __iomem *base;
	59	struct clk *clk;
	60	struct device *dev;
	61
	62	/* SSC SPI current transaction */
	63	const u8 *tx_ptr;
	64	u8 *rx_ptr;
65	u16 bytes_per_word;
66	unsigned int words_remaining;
67	unsigned int baud;
68	struct completion done;
69	};
70
71	static int spi_st_clk_enable(struct spi_st *spi_st)
72	{
73	/*
74	* Current platforms use one of the core clocks for SPI and I2C.
75	* If we attempt to disable the clock, the system will hang.
76	*
77	* TODO: Remove this when platform supports power domains.
78	*/
79	return 0;
80
81	return clk_prepare_enable(spi_st->clk);
82	}
83
84	static void spi_st_clk_disable(struct spi_st *spi_st)
85	{
86	/*
87	* Current platforms use one of the core clocks for SPI and I2C.
88	* If we attempt to disable the clock, the system will hang.
89	*
90	* TODO: Remove this when platform supports power domains.
91	*/
92	return;
93
94	clk_disable_unprepare(spi_st->clk);
95	}
96
97	/* Load the TX FIFO */
98	static void ssc_write_tx_fifo(struct spi_st *spi_st)
99	{
100	unsigned int count, i;
101	uint32_t word = 0;
102
103	if (spi_st->words_remaining > FIFO_SIZE)
104	count = FIFO_SIZE;
105	else
106	count = spi_st->words_remaining;
107
108	for (i = 0; i < count; i++) {
109	if (spi_st->tx_ptr) {
110	if (spi_st->bytes_per_word == 1) {
111	word = *spi_st->tx_ptr++;
112	} else {
113	word = *spi_st->tx_ptr++;
114	word = *spi_st->tx_ptr++ \| (word << 8);
115	}
116	}
117	writel_relaxed(word, spi_st->base + SSC_TBUF);
118	}
119	}
120
121	/* Read the RX FIFO */
122	static void ssc_read_rx_fifo(struct spi_st *spi_st)
123	{
124	unsigned int count, i;
125	uint32_t word = 0;
126
127	if (spi_st->words_remaining > FIFO_SIZE)
128	count = FIFO_SIZE;
129	else
130	count = spi_st->words_remaining;
131
132	for (i = 0; i < count; i++) {
133	word = readl_relaxed(spi_st->base + SSC_RBUF);
134
135	if (spi_st->rx_ptr) {
136	if (spi_st->bytes_per_word == 1) {
137	*spi_st->rx_ptr++ = (uint8_t)word;
138	} else {
139	*spi_st->rx_ptr++ = (word >> 8);
140	*spi_st->rx_ptr++ = word & 0xff;
141	}
142	}
143	}
144	spi_st->words_remaining -= count;
145	}
146
147	static int spi_st_transfer_one(struct spi_master *master,
148	struct spi_device spi, struct spi_transfer t)
149	{
150	struct spi_st *spi_st = spi_master_get_devdata(master);
151	uint32_t ctl = 0;
152
153	/* Setup transfer */
154	spi_st->tx_ptr = t->tx_buf;
155	spi_st->rx_ptr = t->rx_buf;
156
157	if (spi->bits_per_word > 8) {
158	/*
159	* Anything greater than 8 bits-per-word requires 2
160	* bytes-per-word in the RX/TX buffers
161	*/
162	spi_st->bytes_per_word = 2;
163	spi_st->words_remaining = t->len / 2;
164
165	} else if (spi->bits_per_word == 8 && !(t->len & 0x1)) {
166	/*
167	* If transfer is even-length, and 8 bits-per-word, then
168	* implement as half-length 16 bits-per-word transfer
169	*/
170	spi_st->bytes_per_word = 2;
171	spi_st->words_remaining = t->len / 2;
172
173	/* Set SSC_CTL to 16 bits-per-word */
174	ctl = readl_relaxed(spi_st->base + SSC_CTL);
175	writel_relaxed((ctl \| 0xf), spi_st->base + SSC_CTL);
176
177	readl_relaxed(spi_st->base + SSC_RBUF);
178
179	} else {
180	spi_st->bytes_per_word = 1;
181	spi_st->words_remaining = t->len;
182	}
183
184	reinit_completion(&spi_st->done);
185
186	/* Start transfer by writing to the TX FIFO */
187	ssc_write_tx_fifo(spi_st);
188	writel_relaxed(SSC_IEN_TEEN, spi_st->base + SSC_IEN);
189
190	/* Wait for transfer to complete */
191	wait_for_completion(&spi_st->done);
192
193	/* Restore SSC_CTL if necessary */
194	if (ctl)
195	writel_relaxed(ctl, spi_st->base + SSC_CTL);
196
197	spi_finalize_current_transfer(spi->master);
198
199	return t->len;
200	}
201
202	static void spi_st_cleanup(struct spi_device *spi)
203	{
204	int cs = spi->cs_gpio;
205
206	if (gpio_is_valid(cs))
207	devm_gpio_free(&spi->dev, cs);
208	}
209
210	/* the spi->mode bits understood by this driver: */
211	#define MODEBITS (SPI_CPOL \| SPI_CPHA \| SPI_LSB_FIRST \| SPI_LOOP \| SPI_CS_HIGH)
212	static int spi_st_setup(struct spi_device *spi)
213	{
214	struct spi_st *spi_st = spi_master_get_devdata(spi->master);
215	u32 spi_st_clk, sscbrg, var;
216	u32 hz = spi->max_speed_hz;
217	int cs = spi->cs_gpio;
218	int ret;
219
9e862375 LJ	220	if (!hz) {
	221	dev_err(&spi->dev, "max_speed_hz unspecified\n");
	222	return -EINVAL;
	223	}
	224
	225	if (!gpio_is_valid(cs)) {
	226	dev_err(&spi->dev, "%d is not a valid gpio\n", cs);
	227	return -EINVAL;
	228	}
	229
	230	if (devm_gpio_request(&spi->dev, cs, dev_name(&spi->dev))) {
	231	dev_err(&spi->dev, "could not request gpio:%d\n", cs);
	232	return -EINVAL;
	233	}
	234
	235	ret = gpio_direction_output(cs, spi->mode & SPI_CS_HIGH);
	236	if (ret)
	237	return ret;
	238
	239	spi_st_clk = clk_get_rate(spi_st->clk);
	240
	241	/* Set SSC_BRF */
	242	sscbrg = spi_st_clk / (2 * hz);
	243	if (sscbrg < 0x07 \|\| sscbrg > BIT(16)) {
	244	dev_err(&spi->dev,
	245	"baudrate %d outside valid range %d\n", sscbrg, hz);
	246	return -EINVAL;
	247	}
	248
	249	spi_st->baud = spi_st_clk / (2 * sscbrg);
	250	if (sscbrg == BIT(16)) /* 16-bit counter wraps */
	251	sscbrg = 0x0;
	252
	253	writel_relaxed(sscbrg, spi_st->base + SSC_BRG);
	254
	255	dev_dbg(&spi->dev,
	256	"setting baudrate:target= %u hz, actual= %u hz, sscbrg= %u\n",
	257	hz, spi_st->baud, sscbrg);
	258
	259	/* Set SSC_CTL and enable SSC */
	260	var = readl_relaxed(spi_st->base + SSC_CTL);
	261	var \|= SSC_CTL_MS;
	262
	263	if (spi->mode & SPI_CPOL)
	264	var \|= SSC_CTL_PO;
	265	else
	266	var &= ~SSC_CTL_PO;
	267
	268	if (spi->mode & SPI_CPHA)
	269	var \|= SSC_CTL_PH;
	270	else
	271	var &= ~SSC_CTL_PH;
	272
	273	if ((spi->mode & SPI_LSB_FIRST) == 0)
	274	var \|= SSC_CTL_HB;
	275	else
	276	var &= ~SSC_CTL_HB;
	277
	278	if (spi->mode & SPI_LOOP)
	279	var \|= SSC_CTL_LPB;
	280	else
	281	var &= ~SSC_CTL_LPB;
	282
	283	var &= ~SSC_CTL_DATA_WIDTH_MSK;
284	var \|= (spi->bits_per_word - 1);
285
286	var \|= SSC_CTL_EN_TX_FIFO \| SSC_CTL_EN_RX_FIFO;
287	var \|= SSC_CTL_EN;
288
289	writel_relaxed(var, spi_st->base + SSC_CTL);
290
291	/* Clear the status register */
292	readl_relaxed(spi_st->base + SSC_RBUF);
293
294	return 0;
295	}
296
297	/* Interrupt fired when TX shift register becomes empty */
298	static irqreturn_t spi_st_irq(int irq, void *dev_id)
299	{
300	struct spi_st spi_st = (struct spi_st )dev_id;
301
302	/* Read RX FIFO */
303	ssc_read_rx_fifo(spi_st);
304
305	/* Fill TX FIFO */
306	if (spi_st->words_remaining) {
307	ssc_write_tx_fifo(spi_st);
308	} else {
309	/* TX/RX complete */
310	writel_relaxed(0x0, spi_st->base + SSC_IEN);
311	/*
312	* read SSC_IEN to ensure that this bit is set
313	* before re-enabling interrupt
314	*/
315	readl(spi_st->base + SSC_IEN);
316	complete(&spi_st->done);
317	}
318
319	return IRQ_HANDLED;
320	}
321
322	static int spi_st_probe(struct platform_device *pdev)
323	{
324	struct device_node *np = pdev->dev.of_node;
325	struct spi_master *master;
326	struct resource *res;
327	struct spi_st *spi_st;
328	int irq, ret = 0;
329	u32 var;
330
331	master = spi_alloc_master(&pdev->dev, sizeof(*spi_st));
332	if (!master)
333	return -ENOMEM;
334
335	master->dev.of_node = np;
336	master->mode_bits = MODEBITS;
337	master->setup = spi_st_setup;
338	master->cleanup = spi_st_cleanup;
339	master->transfer_one = spi_st_transfer_one;
340	master->bits_per_word_mask = SPI_BPW_MASK(8) \| SPI_BPW_MASK(16);
341	master->auto_runtime_pm = true;
342	master->bus_num = pdev->id;
343	spi_st = spi_master_get_devdata(master);
344
345	spi_st->clk = devm_clk_get(&pdev->dev, "ssc");
346	if (IS_ERR(spi_st->clk)) {
347	dev_err(&pdev->dev, "Unable to request clock\n");
348	return PTR_ERR(spi_st->clk);
349	}
350
351	ret = spi_st_clk_enable(spi_st);
352	if (ret)
353	return ret;
354
355	init_completion(&spi_st->done);
356
357	/* Get resources */
358	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
359	spi_st->base = devm_ioremap_resource(&pdev->dev, res);
360	if (IS_ERR(spi_st->base)) {
361	ret = PTR_ERR(spi_st->base);
362	goto clk_disable;
363	}
364
365	/* Disable I2C and Reset SSC */
366	writel_relaxed(0x0, spi_st->base + SSC_I2C);
367	var = readw_relaxed(spi_st->base + SSC_CTL);
368	var \|= SSC_CTL_SR;
369	writel_relaxed(var, spi_st->base + SSC_CTL);
370
371	udelay(1);
372	var = readl_relaxed(spi_st->base + SSC_CTL);
373	var &= ~SSC_CTL_SR;
374	writel_relaxed(var, spi_st->base + SSC_CTL);
375
376	/* Set SSC into slave mode before reconfiguring PIO pins */
377	var = readl_relaxed(spi_st->base + SSC_CTL);
378	var &= ~SSC_CTL_MS;
379	writel_relaxed(var, spi_st->base + SSC_CTL);
380
381	irq = irq_of_parse_and_map(np, 0);
382	if (!irq) {
383	dev_err(&pdev->dev, "IRQ missing or invalid\n");
384	ret = -EINVAL;
385	goto clk_disable;
386	}
387
388	ret = devm_request_irq(&pdev->dev, irq, spi_st_irq, 0,
389	pdev->name, spi_st);
390	if (ret) {
391	dev_err(&pdev->dev, "Failed to request irq %d\n", irq);
392	goto clk_disable;
393	}
394
395	/* by default the device is on */
396	pm_runtime_set_active(&pdev->dev);
397	pm_runtime_enable(&pdev->dev);
398
399	platform_set_drvdata(pdev, master);
400
401	ret = devm_spi_register_master(&pdev->dev, master);
402	if (ret) {
403	dev_err(&pdev->dev, "Failed to register master\n");
404	goto clk_disable;
405	}
406
407	return 0;
408
409	clk_disable:
410	spi_st_clk_disable(spi_st);
411
412	return ret;
413	}
414
415	static int spi_st_remove(struct platform_device *pdev)
416	{
417	struct spi_master *master = platform_get_drvdata(pdev);
418	struct spi_st *spi_st = spi_master_get_devdata(master);
419
420	spi_st_clk_disable(spi_st);
421
422	pinctrl_pm_select_sleep_state(&pdev->dev);
423
424	return 0;
425	}
426
427	#ifdef CONFIG_PM
428	static int spi_st_runtime_suspend(struct device *dev)
429	{
430	struct spi_master *master = dev_get_drvdata(dev);
431	struct spi_st *spi_st = spi_master_get_devdata(master);
432
433	writel_relaxed(0, spi_st->base + SSC_IEN);
434	pinctrl_pm_select_sleep_state(dev);
435
436	spi_st_clk_disable(spi_st);
437
438	return 0;
439	}
440
441	static int spi_st_runtime_resume(struct device *dev)
442	{
443	struct spi_master *master = dev_get_drvdata(dev);
444	struct spi_st *spi_st = spi_master_get_devdata(master);
445	int ret;
446
447	ret = spi_st_clk_enable(spi_st);
448	pinctrl_pm_select_default_state(dev);
449
450	return ret;
451	}
452	#endif
453
454	#ifdef CONFIG_PM_SLEEP
455	static int spi_st_suspend(struct device *dev)
456	{
457	struct spi_master *master = dev_get_drvdata(dev);
458	int ret;
459
460	ret = spi_master_suspend(master);
461	if (ret)
462	return ret;
463
464	return pm_runtime_force_suspend(dev);
465	}
466
467	static int spi_st_resume(struct device *dev)
468	{
469	struct spi_master *master = dev_get_drvdata(dev);
470	int ret;
471
472	ret = spi_master_resume(master);
473	if (ret)
474	return ret;
475
476	return pm_runtime_force_resume(dev);
477	}
478	#endif
479
480	static const struct dev_pm_ops spi_st_pm = {
481	SET_SYSTEM_SLEEP_PM_OPS(spi_st_suspend, spi_st_resume)
482	SET_RUNTIME_PM_OPS(spi_st_runtime_suspend, spi_st_runtime_resume, NULL)
483	};
484
09355402	485	static const struct of_device_id stm_spi_match[] = {
9e862375 LJ	486	{ .compatible = "st,comms-ssc4-spi", },
	487	{},
	488	};
	489	MODULE_DEVICE_TABLE(of, stm_spi_match);
	490
	491	static struct platform_driver spi_st_driver = {
	492	.driver = {
	493	.name = "spi-st",
	494	.pm = &spi_st_pm,
	495	.of_match_table = of_match_ptr(stm_spi_match),
	496	},
	497	.probe = spi_st_probe,
	498	.remove = spi_st_remove,
	499	};
	500	module_platform_driver(spi_st_driver);
	501
	502	MODULE_AUTHOR("Patrice Chotard <[email protected]>");
	503	MODULE_DESCRIPTION("STM SSC SPI driver");
	504	MODULE_LICENSE("GPL v2");