Linux Audio

Check our new training course

Loading...
v3.1
  1/*
  2 * Special handling for DW core on Intel MID platform
  3 *
  4 * Copyright (c) 2009, Intel Corporation.
  5 *
  6 * This program is free software; you can redistribute it and/or modify it
  7 * under the terms and conditions of the GNU General Public License,
  8 * version 2, as published by the Free Software Foundation.
  9 *
 10 * This program is distributed in the hope it will be useful, but WITHOUT
 11 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 12 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 13 * more details.
 14 *
 15 * You should have received a copy of the GNU General Public License along
 16 * with this program; if not, write to the Free Software Foundation,
 17 * Inc., 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
 18 */
 19
 20#include <linux/dma-mapping.h>
 21#include <linux/dmaengine.h>
 22#include <linux/interrupt.h>
 23#include <linux/slab.h>
 24#include <linux/spi/spi.h>
 
 25
 26#include "spi-dw.h"
 27
 28#ifdef CONFIG_SPI_DW_MID_DMA
 29#include <linux/intel_mid_dma.h>
 30#include <linux/pci.h>
 
 31
 32struct mid_dma {
 33	struct intel_mid_dma_slave	dmas_tx;
 34	struct intel_mid_dma_slave	dmas_rx;
 35};
 
 36
 37static bool mid_spi_dma_chan_filter(struct dma_chan *chan, void *param)
 38{
 39	struct dw_spi *dws = param;
 40
 41	return dws->dmac && (&dws->dmac->dev == chan->device->dev);
 
 
 
 
 42}
 43
 44static int mid_spi_dma_init(struct dw_spi *dws)
 45{
 46	struct mid_dma *dw_dma = dws->dma_priv;
 47	struct intel_mid_dma_slave *rxs, *txs;
 
 48	dma_cap_mask_t mask;
 49
 50	/*
 51	 * Get pci device for DMA controller, currently it could only
 52	 * be the DMA controller of either Moorestown or Medfield
 53	 */
 54	dws->dmac = pci_get_device(PCI_VENDOR_ID_INTEL, 0x0813, NULL);
 55	if (!dws->dmac)
 56		dws->dmac = pci_get_device(PCI_VENDOR_ID_INTEL, 0x0827, NULL);
 57
 58	dma_cap_zero(mask);
 59	dma_cap_set(DMA_SLAVE, mask);
 60
 61	/* 1. Init rx channel */
 62	dws->rxchan = dma_request_channel(mask, mid_spi_dma_chan_filter, dws);
 
 63	if (!dws->rxchan)
 64		goto err_exit;
 65	rxs = &dw_dma->dmas_rx;
 66	rxs->hs_mode = LNW_DMA_HW_HS;
 67	rxs->cfg_mode = LNW_DMA_PER_TO_MEM;
 68	dws->rxchan->private = rxs;
 69
 70	/* 2. Init tx channel */
 71	dws->txchan = dma_request_channel(mask, mid_spi_dma_chan_filter, dws);
 
 72	if (!dws->txchan)
 73		goto free_rxchan;
 74	txs = &dw_dma->dmas_tx;
 75	txs->hs_mode = LNW_DMA_HW_HS;
 76	txs->cfg_mode = LNW_DMA_MEM_TO_PER;
 77	dws->txchan->private = txs;
 78
 79	dws->dma_inited = 1;
 80	return 0;
 81
 82free_rxchan:
 83	dma_release_channel(dws->rxchan);
 84err_exit:
 85	return -1;
 86
 87}
 88
 89static void mid_spi_dma_exit(struct dw_spi *dws)
 90{
 
 
 
 
 91	dma_release_channel(dws->txchan);
 
 
 92	dma_release_channel(dws->rxchan);
 93}
 94
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 95/*
 96 * dws->dma_chan_done is cleared before the dma transfer starts,
 97 * callback for rx/tx channel will each increment it by 1.
 98 * Reaching 2 means the whole spi transaction is done.
 99 */
100static void dw_spi_dma_done(void *arg)
101{
102	struct dw_spi *dws = arg;
103
104	if (++dws->dma_chan_done != 2)
 
105		return;
106	dw_spi_xfer_done(dws);
107}
108
109static int mid_spi_dma_transfer(struct dw_spi *dws, int cs_change)
 
110{
111	struct dma_async_tx_descriptor *txdesc = NULL, *rxdesc = NULL;
112	struct dma_chan *txchan, *rxchan;
113	struct dma_slave_config txconf, rxconf;
114	u16 dma_ctrl = 0;
115
116	/* 1. setup DMA related registers */
117	if (cs_change) {
118		spi_enable_chip(dws, 0);
119		dw_writew(dws, dmardlr, 0xf);
120		dw_writew(dws, dmatdlr, 0x10);
121		if (dws->tx_dma)
122			dma_ctrl |= 0x2;
123		if (dws->rx_dma)
124			dma_ctrl |= 0x1;
125		dw_writew(dws, dmacr, dma_ctrl);
126		spi_enable_chip(dws, 1);
127	}
128
129	dws->dma_chan_done = 0;
130	txchan = dws->txchan;
131	rxchan = dws->rxchan;
132
133	/* 2. Prepare the TX dma transfer */
134	txconf.direction = DMA_TO_DEVICE;
135	txconf.dst_addr = dws->dma_addr;
136	txconf.dst_maxburst = LNW_DMA_MSIZE_16;
137	txconf.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
138	txconf.dst_addr_width = DMA_SLAVE_BUSWIDTH_2_BYTES;
 
 
 
139
140	txchan->device->device_control(txchan, DMA_SLAVE_CONFIG,
141				       (unsigned long) &txconf);
 
 
 
 
 
142
143	memset(&dws->tx_sgl, 0, sizeof(dws->tx_sgl));
144	dws->tx_sgl.dma_address = dws->tx_dma;
145	dws->tx_sgl.length = dws->len;
146
147	txdesc = txchan->device->device_prep_slave_sg(txchan,
148				&dws->tx_sgl,
149				1,
150				DMA_TO_DEVICE,
151				DMA_PREP_INTERRUPT | DMA_COMPL_SKIP_DEST_UNMAP);
152	txdesc->callback = dw_spi_dma_done;
153	txdesc->callback_param = dws;
154
155	/* 3. Prepare the RX dma transfer */
156	rxconf.direction = DMA_FROM_DEVICE;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
157	rxconf.src_addr = dws->dma_addr;
158	rxconf.src_maxburst = LNW_DMA_MSIZE_16;
159	rxconf.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
160	rxconf.src_addr_width = DMA_SLAVE_BUSWIDTH_2_BYTES;
 
161
162	rxchan->device->device_control(rxchan, DMA_SLAVE_CONFIG,
163				       (unsigned long) &rxconf);
164
165	memset(&dws->rx_sgl, 0, sizeof(dws->rx_sgl));
166	dws->rx_sgl.dma_address = dws->rx_dma;
167	dws->rx_sgl.length = dws->len;
168
169	rxdesc = rxchan->device->device_prep_slave_sg(rxchan,
170				&dws->rx_sgl,
171				1,
172				DMA_FROM_DEVICE,
173				DMA_PREP_INTERRUPT | DMA_COMPL_SKIP_DEST_UNMAP);
174	rxdesc->callback = dw_spi_dma_done;
175	rxdesc->callback_param = dws;
176
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
177	/* rx must be started before tx due to spi instinct */
178	rxdesc->tx_submit(rxdesc);
179	txdesc->tx_submit(txdesc);
 
 
 
 
 
 
 
 
 
 
180	return 0;
181}
182
183static struct dw_spi_dma_ops mid_dma_ops = {
 
 
 
 
 
 
 
 
 
 
 
 
184	.dma_init	= mid_spi_dma_init,
185	.dma_exit	= mid_spi_dma_exit,
 
 
186	.dma_transfer	= mid_spi_dma_transfer,
 
187};
188#endif
189
190/* Some specific info for SPI0 controller on Moorestown */
191
192/* HW info for MRST CLk Control Unit, one 32b reg */
193#define MRST_SPI_CLK_BASE	100000000	/* 100m */
194#define MRST_CLK_SPI0_REG	0xff11d86c
195#define CLK_SPI_BDIV_OFFSET	0
196#define CLK_SPI_BDIV_MASK	0x00000007
197#define CLK_SPI_CDIV_OFFSET	9
198#define CLK_SPI_CDIV_MASK	0x00000e00
199#define CLK_SPI_DISABLE_OFFSET	8
200
201int dw_spi_mid_init(struct dw_spi *dws)
202{
203	u32 *clk_reg, clk_cdiv;
 
204
205	clk_reg = ioremap_nocache(MRST_CLK_SPI0_REG, 16);
206	if (!clk_reg)
207		return -ENOMEM;
208
209	/* get SPI controller operating freq info */
210	clk_cdiv  = (readl(clk_reg) & CLK_SPI_CDIV_MASK) >> CLK_SPI_CDIV_OFFSET;
 
 
211	dws->max_freq = MRST_SPI_CLK_BASE / (clk_cdiv + 1);
212	iounmap(clk_reg);
213
214	dws->num_cs = 16;
215	dws->fifo_len = 40;	/* FIFO has 40 words buffer */
216
217#ifdef CONFIG_SPI_DW_MID_DMA
218	dws->dma_priv = kzalloc(sizeof(struct mid_dma), GFP_KERNEL);
219	if (!dws->dma_priv)
220		return -ENOMEM;
221	dws->dma_ops = &mid_dma_ops;
222#endif
223	return 0;
224}
v4.17
  1/*
  2 * Special handling for DW core on Intel MID platform
  3 *
  4 * Copyright (c) 2009, 2014 Intel Corporation.
  5 *
  6 * This program is free software; you can redistribute it and/or modify it
  7 * under the terms and conditions of the GNU General Public License,
  8 * version 2, as published by the Free Software Foundation.
  9 *
 10 * This program is distributed in the hope it will be useful, but WITHOUT
 11 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 12 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 13 * more details.
 
 
 
 
 14 */
 15
 16#include <linux/dma-mapping.h>
 17#include <linux/dmaengine.h>
 18#include <linux/interrupt.h>
 19#include <linux/slab.h>
 20#include <linux/spi/spi.h>
 21#include <linux/types.h>
 22
 23#include "spi-dw.h"
 24
 25#ifdef CONFIG_SPI_DW_MID_DMA
 
 26#include <linux/pci.h>
 27#include <linux/platform_data/dma-dw.h>
 28
 29#define RX_BUSY		0
 30#define TX_BUSY		1
 31
 32static struct dw_dma_slave mid_dma_tx = { .dst_id = 1 };
 33static struct dw_dma_slave mid_dma_rx = { .src_id = 0 };
 34
 35static bool mid_spi_dma_chan_filter(struct dma_chan *chan, void *param)
 36{
 37	struct dw_dma_slave *s = param;
 38
 39	if (s->dma_dev != chan->device->dev)
 40		return false;
 41
 42	chan->private = s;
 43	return true;
 44}
 45
 46static int mid_spi_dma_init(struct dw_spi *dws)
 47{
 48	struct pci_dev *dma_dev;
 49	struct dw_dma_slave *tx = dws->dma_tx;
 50	struct dw_dma_slave *rx = dws->dma_rx;
 51	dma_cap_mask_t mask;
 52
 53	/*
 54	 * Get pci device for DMA controller, currently it could only
 55	 * be the DMA controller of Medfield
 56	 */
 57	dma_dev = pci_get_device(PCI_VENDOR_ID_INTEL, 0x0827, NULL);
 58	if (!dma_dev)
 59		return -ENODEV;
 60
 61	dma_cap_zero(mask);
 62	dma_cap_set(DMA_SLAVE, mask);
 63
 64	/* 1. Init rx channel */
 65	rx->dma_dev = &dma_dev->dev;
 66	dws->rxchan = dma_request_channel(mask, mid_spi_dma_chan_filter, rx);
 67	if (!dws->rxchan)
 68		goto err_exit;
 69	dws->master->dma_rx = dws->rxchan;
 
 
 
 70
 71	/* 2. Init tx channel */
 72	tx->dma_dev = &dma_dev->dev;
 73	dws->txchan = dma_request_channel(mask, mid_spi_dma_chan_filter, tx);
 74	if (!dws->txchan)
 75		goto free_rxchan;
 76	dws->master->dma_tx = dws->txchan;
 
 
 
 77
 78	dws->dma_inited = 1;
 79	return 0;
 80
 81free_rxchan:
 82	dma_release_channel(dws->rxchan);
 83err_exit:
 84	return -EBUSY;
 
 85}
 86
 87static void mid_spi_dma_exit(struct dw_spi *dws)
 88{
 89	if (!dws->dma_inited)
 90		return;
 91
 92	dmaengine_terminate_sync(dws->txchan);
 93	dma_release_channel(dws->txchan);
 94
 95	dmaengine_terminate_sync(dws->rxchan);
 96	dma_release_channel(dws->rxchan);
 97}
 98
 99static irqreturn_t dma_transfer(struct dw_spi *dws)
100{
101	u16 irq_status = dw_readl(dws, DW_SPI_ISR);
102
103	if (!irq_status)
104		return IRQ_NONE;
105
106	dw_readl(dws, DW_SPI_ICR);
107	spi_reset_chip(dws);
108
109	dev_err(&dws->master->dev, "%s: FIFO overrun/underrun\n", __func__);
110	dws->master->cur_msg->status = -EIO;
111	spi_finalize_current_transfer(dws->master);
112	return IRQ_HANDLED;
113}
114
115static bool mid_spi_can_dma(struct spi_controller *master,
116		struct spi_device *spi, struct spi_transfer *xfer)
117{
118	struct dw_spi *dws = spi_controller_get_devdata(master);
119
120	if (!dws->dma_inited)
121		return false;
122
123	return xfer->len > dws->fifo_len;
124}
125
126static enum dma_slave_buswidth convert_dma_width(u32 dma_width) {
127	if (dma_width == 1)
128		return DMA_SLAVE_BUSWIDTH_1_BYTE;
129	else if (dma_width == 2)
130		return DMA_SLAVE_BUSWIDTH_2_BYTES;
131
132	return DMA_SLAVE_BUSWIDTH_UNDEFINED;
133}
134
135/*
136 * dws->dma_chan_busy is set before the dma transfer starts, callback for tx
137 * channel will clear a corresponding bit.
 
138 */
139static void dw_spi_dma_tx_done(void *arg)
140{
141	struct dw_spi *dws = arg;
142
143	clear_bit(TX_BUSY, &dws->dma_chan_busy);
144	if (test_bit(RX_BUSY, &dws->dma_chan_busy))
145		return;
146	spi_finalize_current_transfer(dws->master);
147}
148
149static struct dma_async_tx_descriptor *dw_spi_dma_prepare_tx(struct dw_spi *dws,
150		struct spi_transfer *xfer)
151{
152	struct dma_slave_config txconf;
153	struct dma_async_tx_descriptor *txdesc;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
154
155	if (!xfer->tx_buf)
156		return NULL;
 
157
158	txconf.direction = DMA_MEM_TO_DEV;
 
159	txconf.dst_addr = dws->dma_addr;
160	txconf.dst_maxburst = 16;
161	txconf.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
162	txconf.dst_addr_width = convert_dma_width(dws->dma_width);
163	txconf.device_fc = false;
164
165	dmaengine_slave_config(dws->txchan, &txconf);
166
167	txdesc = dmaengine_prep_slave_sg(dws->txchan,
168				xfer->tx_sg.sgl,
169				xfer->tx_sg.nents,
170				DMA_MEM_TO_DEV,
171				DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
172	if (!txdesc)
173		return NULL;
174
175	txdesc->callback = dw_spi_dma_tx_done;
 
 
 
 
 
 
 
 
 
176	txdesc->callback_param = dws;
177
178	return txdesc;
179}
180
181/*
182 * dws->dma_chan_busy is set before the dma transfer starts, callback for rx
183 * channel will clear a corresponding bit.
184 */
185static void dw_spi_dma_rx_done(void *arg)
186{
187	struct dw_spi *dws = arg;
188
189	clear_bit(RX_BUSY, &dws->dma_chan_busy);
190	if (test_bit(TX_BUSY, &dws->dma_chan_busy))
191		return;
192	spi_finalize_current_transfer(dws->master);
193}
194
195static struct dma_async_tx_descriptor *dw_spi_dma_prepare_rx(struct dw_spi *dws,
196		struct spi_transfer *xfer)
197{
198	struct dma_slave_config rxconf;
199	struct dma_async_tx_descriptor *rxdesc;
200
201	if (!xfer->rx_buf)
202		return NULL;
203
204	rxconf.direction = DMA_DEV_TO_MEM;
205	rxconf.src_addr = dws->dma_addr;
206	rxconf.src_maxburst = 16;
207	rxconf.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
208	rxconf.src_addr_width = convert_dma_width(dws->dma_width);
209	rxconf.device_fc = false;
210
211	dmaengine_slave_config(dws->rxchan, &rxconf);
 
212
213	rxdesc = dmaengine_prep_slave_sg(dws->rxchan,
214				xfer->rx_sg.sgl,
215				xfer->rx_sg.nents,
216				DMA_DEV_TO_MEM,
217				DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
218	if (!rxdesc)
219		return NULL;
220
221	rxdesc->callback = dw_spi_dma_rx_done;
 
222	rxdesc->callback_param = dws;
223
224	return rxdesc;
225}
226
227static int mid_spi_dma_setup(struct dw_spi *dws, struct spi_transfer *xfer)
228{
229	u16 dma_ctrl = 0;
230
231	dw_writel(dws, DW_SPI_DMARDLR, 0xf);
232	dw_writel(dws, DW_SPI_DMATDLR, 0x10);
233
234	if (xfer->tx_buf)
235		dma_ctrl |= SPI_DMA_TDMAE;
236	if (xfer->rx_buf)
237		dma_ctrl |= SPI_DMA_RDMAE;
238	dw_writel(dws, DW_SPI_DMACR, dma_ctrl);
239
240	/* Set the interrupt mask */
241	spi_umask_intr(dws, SPI_INT_TXOI | SPI_INT_RXUI | SPI_INT_RXOI);
242
243	dws->transfer_handler = dma_transfer;
244
245	return 0;
246}
247
248static int mid_spi_dma_transfer(struct dw_spi *dws, struct spi_transfer *xfer)
249{
250	struct dma_async_tx_descriptor *txdesc, *rxdesc;
251
252	/* Prepare the TX dma transfer */
253	txdesc = dw_spi_dma_prepare_tx(dws, xfer);
254
255	/* Prepare the RX dma transfer */
256	rxdesc = dw_spi_dma_prepare_rx(dws, xfer);
257
258	/* rx must be started before tx due to spi instinct */
259	if (rxdesc) {
260		set_bit(RX_BUSY, &dws->dma_chan_busy);
261		dmaengine_submit(rxdesc);
262		dma_async_issue_pending(dws->rxchan);
263	}
264
265	if (txdesc) {
266		set_bit(TX_BUSY, &dws->dma_chan_busy);
267		dmaengine_submit(txdesc);
268		dma_async_issue_pending(dws->txchan);
269	}
270
271	return 0;
272}
273
274static void mid_spi_dma_stop(struct dw_spi *dws)
275{
276	if (test_bit(TX_BUSY, &dws->dma_chan_busy)) {
277		dmaengine_terminate_sync(dws->txchan);
278		clear_bit(TX_BUSY, &dws->dma_chan_busy);
279	}
280	if (test_bit(RX_BUSY, &dws->dma_chan_busy)) {
281		dmaengine_terminate_sync(dws->rxchan);
282		clear_bit(RX_BUSY, &dws->dma_chan_busy);
283	}
284}
285
286static const struct dw_spi_dma_ops mid_dma_ops = {
287	.dma_init	= mid_spi_dma_init,
288	.dma_exit	= mid_spi_dma_exit,
289	.dma_setup	= mid_spi_dma_setup,
290	.can_dma	= mid_spi_can_dma,
291	.dma_transfer	= mid_spi_dma_transfer,
292	.dma_stop	= mid_spi_dma_stop,
293};
294#endif
295
296/* Some specific info for SPI0 controller on Intel MID */
297
298/* HW info for MRST Clk Control Unit, 32b reg per controller */
299#define MRST_SPI_CLK_BASE	100000000	/* 100m */
300#define MRST_CLK_SPI_REG	0xff11d86c
301#define CLK_SPI_BDIV_OFFSET	0
302#define CLK_SPI_BDIV_MASK	0x00000007
303#define CLK_SPI_CDIV_OFFSET	9
304#define CLK_SPI_CDIV_MASK	0x00000e00
305#define CLK_SPI_DISABLE_OFFSET	8
306
307int dw_spi_mid_init(struct dw_spi *dws)
308{
309	void __iomem *clk_reg;
310	u32 clk_cdiv;
311
312	clk_reg = ioremap_nocache(MRST_CLK_SPI_REG, 16);
313	if (!clk_reg)
314		return -ENOMEM;
315
316	/* Get SPI controller operating freq info */
317	clk_cdiv = readl(clk_reg + dws->bus_num * sizeof(u32));
318	clk_cdiv &= CLK_SPI_CDIV_MASK;
319	clk_cdiv >>= CLK_SPI_CDIV_OFFSET;
320	dws->max_freq = MRST_SPI_CLK_BASE / (clk_cdiv + 1);
 
321
322	iounmap(clk_reg);
 
323
324#ifdef CONFIG_SPI_DW_MID_DMA
325	dws->dma_tx = &mid_dma_tx;
326	dws->dma_rx = &mid_dma_rx;
 
327	dws->dma_ops = &mid_dma_ops;
328#endif
329	return 0;
330}