blob: 54e3eb0b37239cd40402fcd2437c881df805ca04 [file] [log] [blame]
Linus Walleije8689e62010-09-28 15:57:37 +02001/*
2 * Copyright (c) 2006 ARM Ltd.
3 * Copyright (c) 2010 ST-Ericsson SA
4 *
5 * Author: Peter Pearse <peter.pearse@arm.com>
6 * Author: Linus Walleij <linus.walleij@stericsson.com>
7 *
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the Free
10 * Software Foundation; either version 2 of the License, or (at your option)
11 * any later version.
12 *
13 * This program is distributed in the hope that it will be useful, but WITHOUT
14 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
15 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
16 * more details.
17 *
18 * You should have received a copy of the GNU General Public License along with
19 * this program; if not, write to the Free Software Foundation, Inc., 59
20 * Temple Place - Suite 330, Boston, MA 02111-1307, USA.
21 *
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +000022 * The full GNU General Public License is in this distribution in the file
23 * called COPYING.
Linus Walleije8689e62010-09-28 15:57:37 +020024 *
25 * Documentation: ARM DDI 0196G == PL080
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +000026 * Documentation: ARM DDI 0218E == PL081
Linus Walleije8689e62010-09-28 15:57:37 +020027 *
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +000028 * PL080 & PL081 both have 16 sets of DMA signals that can be routed to any
29 * channel.
Linus Walleije8689e62010-09-28 15:57:37 +020030 *
31 * The PL080 has 8 channels available for simultaneous use, and the PL081
32 * has only two channels. So on these DMA controllers the number of channels
33 * and the number of incoming DMA signals are two totally different things.
34 * It is usually not possible to theoretically handle all physical signals,
35 * so a multiplexing scheme with possible denial of use is necessary.
36 *
37 * The PL080 has a dual bus master, PL081 has a single master.
38 *
39 * Memory to peripheral transfer may be visualized as
40 * Get data from memory to DMAC
41 * Until no data left
42 * On burst request from peripheral
43 * Destination burst from DMAC to peripheral
44 * Clear burst request
45 * Raise terminal count interrupt
46 *
47 * For peripherals with a FIFO:
48 * Source burst size == half the depth of the peripheral FIFO
49 * Destination burst size == the depth of the peripheral FIFO
50 *
51 * (Bursts are irrelevant for mem to mem transfers - there are no burst
52 * signals, the DMA controller will simply facilitate its AHB master.)
53 *
54 * ASSUMES default (little) endianness for DMA transfers
55 *
Russell King - ARM Linux9dc2c202011-01-03 22:33:06 +000056 * The PL08x has two flow control settings:
57 * - DMAC flow control: the transfer size defines the number of transfers
58 * which occur for the current LLI entry, and the DMAC raises TC at the
59 * end of every LLI entry. Observed behaviour shows the DMAC listening
60 * to both the BREQ and SREQ signals (contrary to documented),
61 * transferring data if either is active. The LBREQ and LSREQ signals
62 * are ignored.
63 *
64 * - Peripheral flow control: the transfer size is ignored (and should be
65 * zero). The data is transferred from the current LLI entry, until
66 * after the final transfer signalled by LBREQ or LSREQ. The DMAC
67 * will then move to the next LLI entry.
68 *
Linus Walleije8689e62010-09-28 15:57:37 +020069 * Global TODO:
70 * - Break out common code from arch/arm/mach-s3c64xx and share
71 */
Russell King - ARM Linux730404a2011-01-03 22:34:07 +000072#include <linux/amba/bus.h>
Linus Walleije8689e62010-09-28 15:57:37 +020073#include <linux/amba/pl08x.h>
74#include <linux/debugfs.h>
Viresh Kumar0c38d702011-08-05 15:32:28 +053075#include <linux/delay.h>
76#include <linux/device.h>
77#include <linux/dmaengine.h>
78#include <linux/dmapool.h>
Vinod Koul8516f522011-09-02 16:43:44 +053079#include <linux/dma-mapping.h>
Viresh Kumar0c38d702011-08-05 15:32:28 +053080#include <linux/init.h>
81#include <linux/interrupt.h>
82#include <linux/module.h>
Viresh Kumarb7b60182011-08-05 15:32:33 +053083#include <linux/pm_runtime.h>
Linus Walleije8689e62010-09-28 15:57:37 +020084#include <linux/seq_file.h>
Viresh Kumar0c38d702011-08-05 15:32:28 +053085#include <linux/slab.h>
Linus Walleije8689e62010-09-28 15:57:37 +020086#include <asm/hardware/pl080.h>
Linus Walleije8689e62010-09-28 15:57:37 +020087
Russell King - ARM Linuxd2ebfb32012-03-06 22:34:26 +000088#include "dmaengine.h"
89
Linus Walleije8689e62010-09-28 15:57:37 +020090#define DRIVER_NAME "pl08xdmac"
91
Russell King - ARM Linux7703eac2011-08-31 09:34:35 +010092static struct amba_driver pl08x_amba_driver;
Russell Kingb23f2042012-05-16 10:48:44 +010093struct pl08x_driver_data;
Russell King - ARM Linux7703eac2011-08-31 09:34:35 +010094
Linus Walleije8689e62010-09-28 15:57:37 +020095/**
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +000096 * struct vendor_data - vendor-specific config parameters for PL08x derivatives
Linus Walleije8689e62010-09-28 15:57:37 +020097 * @channels: the number of channels available in this variant
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +000098 * @dualmaster: whether this version supports dual AHB masters or not.
Linus Walleijaffa1152012-04-12 09:01:49 +020099 * @nomadik: whether the channels have Nomadik security extension bits
100 * that need to be checked for permission before use and some registers are
101 * missing
Linus Walleije8689e62010-09-28 15:57:37 +0200102 */
103struct vendor_data {
Linus Walleije8689e62010-09-28 15:57:37 +0200104 u8 channels;
105 bool dualmaster;
Linus Walleijaffa1152012-04-12 09:01:49 +0200106 bool nomadik;
Linus Walleije8689e62010-09-28 15:57:37 +0200107};
108
109/*
110 * PL08X private data structures
Russell King - ARM Linuxe8b5e112011-01-03 22:30:24 +0000111 * An LLI struct - see PL08x TRM. Note that next uses bit[0] as a bus bit,
Russell King - ARM Linuxe25761d2011-01-03 22:37:52 +0000112 * start & end do not - their bus bit info is in cctl. Also note that these
113 * are fixed 32-bit quantities.
Linus Walleije8689e62010-09-28 15:57:37 +0200114 */
Russell King - ARM Linux7cb72ad2011-01-03 22:35:28 +0000115struct pl08x_lli {
Russell King - ARM Linuxe25761d2011-01-03 22:37:52 +0000116 u32 src;
117 u32 dst;
Russell King - ARM Linuxbfddfb42011-01-03 22:38:12 +0000118 u32 lli;
Linus Walleije8689e62010-09-28 15:57:37 +0200119 u32 cctl;
120};
121
122/**
Russell Kingb23f2042012-05-16 10:48:44 +0100123 * struct pl08x_bus_data - information of source or destination
124 * busses for a transfer
125 * @addr: current address
126 * @maxwidth: the maximum width of a transfer on this bus
127 * @buswidth: the width of this bus in bytes: 1, 2 or 4
128 */
129struct pl08x_bus_data {
130 dma_addr_t addr;
131 u8 maxwidth;
132 u8 buswidth;
133};
134
135/**
136 * struct pl08x_phy_chan - holder for the physical channels
137 * @id: physical index to this channel
138 * @lock: a lock to use when altering an instance of this struct
Russell Kingb23f2042012-05-16 10:48:44 +0100139 * @serving: the virtual channel currently being served by this physical
140 * channel
Russell Kingad0de2a2012-05-25 11:15:15 +0100141 * @locked: channel unavailable for the system, e.g. dedicated to secure
142 * world
Russell Kingb23f2042012-05-16 10:48:44 +0100143 */
144struct pl08x_phy_chan {
145 unsigned int id;
146 void __iomem *base;
147 spinlock_t lock;
Russell Kingb23f2042012-05-16 10:48:44 +0100148 struct pl08x_dma_chan *serving;
Russell Kingad0de2a2012-05-25 11:15:15 +0100149 bool locked;
Russell Kingb23f2042012-05-16 10:48:44 +0100150};
151
152/**
153 * struct pl08x_sg - structure containing data per sg
154 * @src_addr: src address of sg
155 * @dst_addr: dst address of sg
156 * @len: transfer len in bytes
157 * @node: node for txd's dsg_list
158 */
159struct pl08x_sg {
160 dma_addr_t src_addr;
161 dma_addr_t dst_addr;
162 size_t len;
163 struct list_head node;
164};
165
166/**
167 * struct pl08x_txd - wrapper for struct dma_async_tx_descriptor
168 * @tx: async tx descriptor
169 * @node: node for txd list for channels
170 * @dsg_list: list of children sg's
171 * @direction: direction of transfer
172 * @llis_bus: DMA memory address (physical) start for the LLIs
173 * @llis_va: virtual memory address start for the LLIs
174 * @cctl: control reg values for current txd
175 * @ccfg: config reg values for current txd
176 */
177struct pl08x_txd {
178 struct dma_async_tx_descriptor tx;
179 struct list_head node;
180 struct list_head dsg_list;
181 enum dma_transfer_direction direction;
182 dma_addr_t llis_bus;
183 struct pl08x_lli *llis_va;
184 /* Default cctl value for LLIs */
185 u32 cctl;
186 /*
187 * Settings to be put into the physical channel when we
188 * trigger this txd. Other registers are in llis_va[0].
189 */
190 u32 ccfg;
191};
192
193/**
194 * struct pl08x_dma_chan_state - holds the PL08x specific virtual channel
195 * states
196 * @PL08X_CHAN_IDLE: the channel is idle
197 * @PL08X_CHAN_RUNNING: the channel has allocated a physical transport
198 * channel and is running a transfer on it
199 * @PL08X_CHAN_PAUSED: the channel has allocated a physical transport
200 * channel, but the transfer is currently paused
201 * @PL08X_CHAN_WAITING: the channel is waiting for a physical transport
202 * channel to become available (only pertains to memcpy channels)
203 */
204enum pl08x_dma_chan_state {
205 PL08X_CHAN_IDLE,
206 PL08X_CHAN_RUNNING,
207 PL08X_CHAN_PAUSED,
208 PL08X_CHAN_WAITING,
209};
210
211/**
212 * struct pl08x_dma_chan - this structure wraps a DMA ENGINE channel
213 * @chan: wrappped abstract channel
214 * @phychan: the physical channel utilized by this channel, if there is one
215 * @phychan_hold: if non-zero, hold on to the physical channel even if we
216 * have no pending entries
217 * @tasklet: tasklet scheduled by the IRQ to handle actual work etc
218 * @name: name of channel
219 * @cd: channel platform data
220 * @runtime_addr: address for RX/TX according to the runtime config
Russell Kingb23f2042012-05-16 10:48:44 +0100221 * @pend_list: queued transactions pending on this channel
Russell Kinga936e792012-05-25 10:51:19 +0100222 * @done_list: list of completed transactions
Russell Kingb23f2042012-05-16 10:48:44 +0100223 * @at: active transaction on this channel
224 * @lock: a lock for this channel data
225 * @host: a pointer to the host (internal use)
226 * @state: whether the channel is idle, paused, running etc
227 * @slave: whether this channel is a device (slave) or for memcpy
Russell Kingb23f2042012-05-16 10:48:44 +0100228 * @waiting: a TX descriptor on this channel which is waiting for a physical
229 * channel to become available
Russell Kingad0de2a2012-05-25 11:15:15 +0100230 * @signal: the physical DMA request signal which this channel is using
Russell King5e2479b2012-05-25 11:32:45 +0100231 * @mux_use: count of descriptors using this DMA request signal setting
Russell Kingb23f2042012-05-16 10:48:44 +0100232 */
233struct pl08x_dma_chan {
234 struct dma_chan chan;
235 struct pl08x_phy_chan *phychan;
236 int phychan_hold;
237 struct tasklet_struct tasklet;
Russell King550ec362012-05-28 10:18:55 +0100238 const char *name;
Russell Kingb23f2042012-05-16 10:48:44 +0100239 const struct pl08x_channel_data *cd;
Russell Kinged91c132012-05-16 11:02:40 +0100240 struct dma_slave_config cfg;
Russell Kingb23f2042012-05-16 10:48:44 +0100241 struct list_head pend_list;
Russell Kinga936e792012-05-25 10:51:19 +0100242 struct list_head done_list;
Russell Kingb23f2042012-05-16 10:48:44 +0100243 struct pl08x_txd *at;
244 spinlock_t lock;
245 struct pl08x_driver_data *host;
246 enum pl08x_dma_chan_state state;
247 bool slave;
Russell Kingb23f2042012-05-16 10:48:44 +0100248 struct pl08x_txd *waiting;
Russell Kingad0de2a2012-05-25 11:15:15 +0100249 int signal;
Russell King5e2479b2012-05-25 11:32:45 +0100250 unsigned mux_use;
Russell Kingb23f2042012-05-16 10:48:44 +0100251};
252
253/**
Linus Walleije8689e62010-09-28 15:57:37 +0200254 * struct pl08x_driver_data - the local state holder for the PL08x
255 * @slave: slave engine for this instance
256 * @memcpy: memcpy engine for this instance
257 * @base: virtual memory base (remapped) for the PL08x
258 * @adev: the corresponding AMBA (PrimeCell) bus entry
259 * @vd: vendor data for this PL08x variant
260 * @pd: platform data passed in from the platform/machine
261 * @phy_chans: array of data for the physical channels
262 * @pool: a pool for the LLI descriptors
263 * @pool_ctr: counter of LLIs in the pool
Viresh Kumar3e27ee82011-08-05 15:32:27 +0530264 * @lli_buses: bitmask to or in to LLI pointer selecting AHB port for LLI
265 * fetches
Russell King - ARM Linux30749cb2011-01-03 22:41:13 +0000266 * @mem_buses: set to indicate memory transfers on AHB2.
Linus Walleije8689e62010-09-28 15:57:37 +0200267 * @lock: a spinlock for this struct
268 */
269struct pl08x_driver_data {
270 struct dma_device slave;
271 struct dma_device memcpy;
272 void __iomem *base;
273 struct amba_device *adev;
Russell King - ARM Linuxf96ca9ec2011-01-03 22:35:08 +0000274 const struct vendor_data *vd;
Linus Walleije8689e62010-09-28 15:57:37 +0200275 struct pl08x_platform_data *pd;
276 struct pl08x_phy_chan *phy_chans;
277 struct dma_pool *pool;
278 int pool_ctr;
Russell King - ARM Linux30749cb2011-01-03 22:41:13 +0000279 u8 lli_buses;
280 u8 mem_buses;
Linus Walleije8689e62010-09-28 15:57:37 +0200281};
282
283/*
284 * PL08X specific defines
285 */
286
Linus Walleije8689e62010-09-28 15:57:37 +0200287/* Size (bytes) of each LLI buffer allocated for one transfer */
288# define PL08X_LLI_TSFR_SIZE 0x2000
289
Russell King - ARM Linuxe8b5e112011-01-03 22:30:24 +0000290/* Maximum times we call dma_pool_alloc on this pool without freeing */
Russell King - ARM Linux7cb72ad2011-01-03 22:35:28 +0000291#define MAX_NUM_TSFR_LLIS (PL08X_LLI_TSFR_SIZE/sizeof(struct pl08x_lli))
Linus Walleije8689e62010-09-28 15:57:37 +0200292#define PL08X_ALIGN 8
293
294static inline struct pl08x_dma_chan *to_pl08x_chan(struct dma_chan *chan)
295{
296 return container_of(chan, struct pl08x_dma_chan, chan);
297}
298
Russell King - ARM Linux501e67e2011-01-03 22:44:57 +0000299static inline struct pl08x_txd *to_pl08x_txd(struct dma_async_tx_descriptor *tx)
300{
301 return container_of(tx, struct pl08x_txd, tx);
302}
303
Linus Walleije8689e62010-09-28 15:57:37 +0200304/*
Russell King6b16c8b2012-05-25 11:10:58 +0100305 * Mux handling.
306 *
307 * This gives us the DMA request input to the PL08x primecell which the
308 * peripheral described by the channel data will be routed to, possibly
309 * via a board/SoC specific external MUX. One important point to note
310 * here is that this does not depend on the physical channel.
311 */
Russell Kingad0de2a2012-05-25 11:15:15 +0100312static int pl08x_request_mux(struct pl08x_dma_chan *plchan)
Russell King6b16c8b2012-05-25 11:10:58 +0100313{
314 const struct pl08x_platform_data *pd = plchan->host->pd;
315 int ret;
316
Russell King5e2479b2012-05-25 11:32:45 +0100317 if (plchan->mux_use++ == 0 && pd->get_signal) {
Russell King6b16c8b2012-05-25 11:10:58 +0100318 ret = pd->get_signal(plchan->cd);
Russell King5e2479b2012-05-25 11:32:45 +0100319 if (ret < 0) {
320 plchan->mux_use = 0;
Russell King6b16c8b2012-05-25 11:10:58 +0100321 return ret;
Russell King5e2479b2012-05-25 11:32:45 +0100322 }
Russell King6b16c8b2012-05-25 11:10:58 +0100323
Russell Kingad0de2a2012-05-25 11:15:15 +0100324 plchan->signal = ret;
Russell King6b16c8b2012-05-25 11:10:58 +0100325 }
326 return 0;
327}
328
329static void pl08x_release_mux(struct pl08x_dma_chan *plchan)
330{
331 const struct pl08x_platform_data *pd = plchan->host->pd;
332
Russell King5e2479b2012-05-25 11:32:45 +0100333 if (plchan->signal >= 0) {
334 WARN_ON(plchan->mux_use == 0);
335
336 if (--plchan->mux_use == 0 && pd->put_signal) {
337 pd->put_signal(plchan->cd, plchan->signal);
338 plchan->signal = -1;
339 }
Russell King6b16c8b2012-05-25 11:10:58 +0100340 }
341}
342
343/*
Linus Walleije8689e62010-09-28 15:57:37 +0200344 * Physical channel handling
345 */
346
347/* Whether a certain channel is busy or not */
348static int pl08x_phy_channel_busy(struct pl08x_phy_chan *ch)
349{
350 unsigned int val;
351
352 val = readl(ch->base + PL080_CH_CONFIG);
353 return val & PL080_CONFIG_ACTIVE;
354}
355
356/*
357 * Set the initial DMA register values i.e. those for the first LLI
Russell King - ARM Linuxe8b5e112011-01-03 22:30:24 +0000358 * The next LLI pointer and the configuration interrupt bit have
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +0000359 * been set when the LLIs were constructed. Poke them into the hardware
360 * and start the transfer.
Linus Walleije8689e62010-09-28 15:57:37 +0200361 */
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +0000362static void pl08x_start_txd(struct pl08x_dma_chan *plchan,
363 struct pl08x_txd *txd)
Linus Walleije8689e62010-09-28 15:57:37 +0200364{
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +0000365 struct pl08x_driver_data *pl08x = plchan->host;
Linus Walleije8689e62010-09-28 15:57:37 +0200366 struct pl08x_phy_chan *phychan = plchan->phychan;
Russell King - ARM Linux19524d72011-01-03 22:39:13 +0000367 struct pl08x_lli *lli = &txd->llis_va[0];
Russell King - ARM Linux09b3c322011-01-03 22:39:53 +0000368 u32 val;
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +0000369
370 plchan->at = txd;
Linus Walleije8689e62010-09-28 15:57:37 +0200371
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +0000372 /* Wait for channel inactive */
373 while (pl08x_phy_channel_busy(phychan))
Russell King - ARM Linux19386b322011-01-03 22:36:29 +0000374 cpu_relax();
Linus Walleije8689e62010-09-28 15:57:37 +0200375
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +0000376 dev_vdbg(&pl08x->adev->dev,
377 "WRITE channel %d: csrc=0x%08x, cdst=0x%08x, "
Russell King - ARM Linux19524d72011-01-03 22:39:13 +0000378 "clli=0x%08x, cctl=0x%08x, ccfg=0x%08x\n",
379 phychan->id, lli->src, lli->dst, lli->lli, lli->cctl,
Russell King - ARM Linux09b3c322011-01-03 22:39:53 +0000380 txd->ccfg);
Linus Walleije8689e62010-09-28 15:57:37 +0200381
Russell King - ARM Linux19524d72011-01-03 22:39:13 +0000382 writel(lli->src, phychan->base + PL080_CH_SRC_ADDR);
383 writel(lli->dst, phychan->base + PL080_CH_DST_ADDR);
384 writel(lli->lli, phychan->base + PL080_CH_LLI);
385 writel(lli->cctl, phychan->base + PL080_CH_CONTROL);
Russell King - ARM Linux09b3c322011-01-03 22:39:53 +0000386 writel(txd->ccfg, phychan->base + PL080_CH_CONFIG);
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +0000387
388 /* Enable the DMA channel */
389 /* Do not access config register until channel shows as disabled */
390 while (readl(pl08x->base + PL080_EN_CHAN) & (1 << phychan->id))
391 cpu_relax();
392
393 /* Do not access config register until channel shows as inactive */
394 val = readl(phychan->base + PL080_CH_CONFIG);
395 while ((val & PL080_CONFIG_ACTIVE) || (val & PL080_CONFIG_ENABLE))
396 val = readl(phychan->base + PL080_CH_CONFIG);
397
398 writel(val | PL080_CONFIG_ENABLE, phychan->base + PL080_CH_CONFIG);
Linus Walleije8689e62010-09-28 15:57:37 +0200399}
400
401/*
Russell King - ARM Linux81796612011-01-27 12:37:44 +0000402 * Pause the channel by setting the HALT bit.
Linus Walleije8689e62010-09-28 15:57:37 +0200403 *
Russell King - ARM Linux81796612011-01-27 12:37:44 +0000404 * For M->P transfers, pause the DMAC first and then stop the peripheral -
405 * the FIFO can only drain if the peripheral is still requesting data.
406 * (note: this can still timeout if the DMAC FIFO never drains of data.)
Linus Walleije8689e62010-09-28 15:57:37 +0200407 *
Russell King - ARM Linux81796612011-01-27 12:37:44 +0000408 * For P->M transfers, disable the peripheral first to stop it filling
409 * the DMAC FIFO, and then pause the DMAC.
Linus Walleije8689e62010-09-28 15:57:37 +0200410 */
411static void pl08x_pause_phy_chan(struct pl08x_phy_chan *ch)
412{
413 u32 val;
Russell King - ARM Linux81796612011-01-27 12:37:44 +0000414 int timeout;
Linus Walleije8689e62010-09-28 15:57:37 +0200415
416 /* Set the HALT bit and wait for the FIFO to drain */
417 val = readl(ch->base + PL080_CH_CONFIG);
418 val |= PL080_CONFIG_HALT;
419 writel(val, ch->base + PL080_CH_CONFIG);
420
421 /* Wait for channel inactive */
Russell King - ARM Linux81796612011-01-27 12:37:44 +0000422 for (timeout = 1000; timeout; timeout--) {
423 if (!pl08x_phy_channel_busy(ch))
424 break;
425 udelay(1);
426 }
427 if (pl08x_phy_channel_busy(ch))
428 pr_err("pl08x: channel%u timeout waiting for pause\n", ch->id);
Linus Walleije8689e62010-09-28 15:57:37 +0200429}
430
431static void pl08x_resume_phy_chan(struct pl08x_phy_chan *ch)
432{
433 u32 val;
434
435 /* Clear the HALT bit */
436 val = readl(ch->base + PL080_CH_CONFIG);
437 val &= ~PL080_CONFIG_HALT;
438 writel(val, ch->base + PL080_CH_CONFIG);
439}
440
Russell King - ARM Linuxfb526212011-01-27 12:32:53 +0000441/*
442 * pl08x_terminate_phy_chan() stops the channel, clears the FIFO and
443 * clears any pending interrupt status. This should not be used for
444 * an on-going transfer, but as a method of shutting down a channel
445 * (eg, when it's no longer used) or terminating a transfer.
446 */
447static void pl08x_terminate_phy_chan(struct pl08x_driver_data *pl08x,
448 struct pl08x_phy_chan *ch)
Linus Walleije8689e62010-09-28 15:57:37 +0200449{
Russell King - ARM Linuxfb526212011-01-27 12:32:53 +0000450 u32 val = readl(ch->base + PL080_CH_CONFIG);
Linus Walleije8689e62010-09-28 15:57:37 +0200451
Russell King - ARM Linuxfb526212011-01-27 12:32:53 +0000452 val &= ~(PL080_CONFIG_ENABLE | PL080_CONFIG_ERR_IRQ_MASK |
453 PL080_CONFIG_TC_IRQ_MASK);
Linus Walleije8689e62010-09-28 15:57:37 +0200454
Linus Walleije8689e62010-09-28 15:57:37 +0200455 writel(val, ch->base + PL080_CH_CONFIG);
Russell King - ARM Linuxfb526212011-01-27 12:32:53 +0000456
457 writel(1 << ch->id, pl08x->base + PL080_ERR_CLEAR);
458 writel(1 << ch->id, pl08x->base + PL080_TC_CLEAR);
Linus Walleije8689e62010-09-28 15:57:37 +0200459}
460
461static inline u32 get_bytes_in_cctl(u32 cctl)
462{
463 /* The source width defines the number of bytes */
464 u32 bytes = cctl & PL080_CONTROL_TRANSFER_SIZE_MASK;
465
466 switch (cctl >> PL080_CONTROL_SWIDTH_SHIFT) {
467 case PL080_WIDTH_8BIT:
468 break;
469 case PL080_WIDTH_16BIT:
470 bytes *= 2;
471 break;
472 case PL080_WIDTH_32BIT:
473 bytes *= 4;
474 break;
475 }
476 return bytes;
477}
478
479/* The channel should be paused when calling this */
480static u32 pl08x_getbytes_chan(struct pl08x_dma_chan *plchan)
481{
482 struct pl08x_phy_chan *ch;
Linus Walleije8689e62010-09-28 15:57:37 +0200483 struct pl08x_txd *txd;
484 unsigned long flags;
Russell King - ARM Linuxcace6582011-01-03 22:37:31 +0000485 size_t bytes = 0;
Linus Walleije8689e62010-09-28 15:57:37 +0200486
487 spin_lock_irqsave(&plchan->lock, flags);
Linus Walleije8689e62010-09-28 15:57:37 +0200488 ch = plchan->phychan;
489 txd = plchan->at;
490
491 /*
Russell King - ARM Linuxdb9f1362011-01-03 22:38:32 +0000492 * Follow the LLIs to get the number of remaining
493 * bytes in the currently active transaction.
Linus Walleije8689e62010-09-28 15:57:37 +0200494 */
495 if (ch && txd) {
Russell King - ARM Linux4c0df6a2011-01-03 22:36:50 +0000496 u32 clli = readl(ch->base + PL080_CH_LLI) & ~PL080_LLI_LM_AHB2;
Linus Walleije8689e62010-09-28 15:57:37 +0200497
Russell King - ARM Linuxdb9f1362011-01-03 22:38:32 +0000498 /* First get the remaining bytes in the active transfer */
Linus Walleije8689e62010-09-28 15:57:37 +0200499 bytes = get_bytes_in_cctl(readl(ch->base + PL080_CH_CONTROL));
500
501 if (clli) {
Russell King - ARM Linuxdb9f1362011-01-03 22:38:32 +0000502 struct pl08x_lli *llis_va = txd->llis_va;
503 dma_addr_t llis_bus = txd->llis_bus;
504 int index;
Linus Walleije8689e62010-09-28 15:57:37 +0200505
Russell King - ARM Linuxdb9f1362011-01-03 22:38:32 +0000506 BUG_ON(clli < llis_bus || clli >= llis_bus +
507 sizeof(struct pl08x_lli) * MAX_NUM_TSFR_LLIS);
Linus Walleije8689e62010-09-28 15:57:37 +0200508
Russell King - ARM Linuxdb9f1362011-01-03 22:38:32 +0000509 /*
510 * Locate the next LLI - as this is an array,
511 * it's simple maths to find.
512 */
513 index = (clli - llis_bus) / sizeof(struct pl08x_lli);
514
515 for (; index < MAX_NUM_TSFR_LLIS; index++) {
516 bytes += get_bytes_in_cctl(llis_va[index].cctl);
517
Linus Walleije8689e62010-09-28 15:57:37 +0200518 /*
Russell King - ARM Linuxe8b5e112011-01-03 22:30:24 +0000519 * A LLI pointer of 0 terminates the LLI list
Linus Walleije8689e62010-09-28 15:57:37 +0200520 */
Russell King - ARM Linuxdb9f1362011-01-03 22:38:32 +0000521 if (!llis_va[index].lli)
522 break;
Linus Walleije8689e62010-09-28 15:57:37 +0200523 }
524 }
525 }
526
527 /* Sum up all queued transactions */
Russell King - ARM Linux15c17232011-01-03 22:44:36 +0000528 if (!list_empty(&plchan->pend_list)) {
Russell King - ARM Linuxdb9f1362011-01-03 22:38:32 +0000529 struct pl08x_txd *txdi;
Russell King - ARM Linux15c17232011-01-03 22:44:36 +0000530 list_for_each_entry(txdi, &plchan->pend_list, node) {
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530531 struct pl08x_sg *dsg;
532 list_for_each_entry(dsg, &txd->dsg_list, node)
533 bytes += dsg->len;
Linus Walleije8689e62010-09-28 15:57:37 +0200534 }
Linus Walleije8689e62010-09-28 15:57:37 +0200535 }
536
537 spin_unlock_irqrestore(&plchan->lock, flags);
538
539 return bytes;
540}
541
542/*
543 * Allocate a physical channel for a virtual channel
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +0000544 *
545 * Try to locate a physical channel to be used for this transfer. If all
546 * are taken return NULL and the requester will have to cope by using
547 * some fallback PIO mode or retrying later.
Linus Walleije8689e62010-09-28 15:57:37 +0200548 */
549static struct pl08x_phy_chan *
550pl08x_get_phy_channel(struct pl08x_driver_data *pl08x,
551 struct pl08x_dma_chan *virt_chan)
552{
553 struct pl08x_phy_chan *ch = NULL;
554 unsigned long flags;
555 int i;
556
Linus Walleije8689e62010-09-28 15:57:37 +0200557 for (i = 0; i < pl08x->vd->channels; i++) {
558 ch = &pl08x->phy_chans[i];
559
560 spin_lock_irqsave(&ch->lock, flags);
561
Linus Walleijaffa1152012-04-12 09:01:49 +0200562 if (!ch->locked && !ch->serving) {
Linus Walleije8689e62010-09-28 15:57:37 +0200563 ch->serving = virt_chan;
Linus Walleije8689e62010-09-28 15:57:37 +0200564 spin_unlock_irqrestore(&ch->lock, flags);
565 break;
566 }
567
568 spin_unlock_irqrestore(&ch->lock, flags);
569 }
570
571 if (i == pl08x->vd->channels) {
572 /* No physical channel available, cope with it */
573 return NULL;
574 }
575
576 return ch;
577}
578
579static inline void pl08x_put_phy_channel(struct pl08x_driver_data *pl08x,
580 struct pl08x_phy_chan *ch)
581{
582 unsigned long flags;
583
Russell King - ARM Linuxfb526212011-01-27 12:32:53 +0000584 spin_lock_irqsave(&ch->lock, flags);
585
Linus Walleije8689e62010-09-28 15:57:37 +0200586 /* Stop the channel and clear its interrupts */
Russell King - ARM Linuxfb526212011-01-27 12:32:53 +0000587 pl08x_terminate_phy_chan(pl08x, ch);
Linus Walleije8689e62010-09-28 15:57:37 +0200588
589 /* Mark it as free */
Linus Walleije8689e62010-09-28 15:57:37 +0200590 ch->serving = NULL;
591 spin_unlock_irqrestore(&ch->lock, flags);
592}
593
594/*
595 * LLI handling
596 */
597
598static inline unsigned int pl08x_get_bytes_for_cctl(unsigned int coded)
599{
600 switch (coded) {
601 case PL080_WIDTH_8BIT:
602 return 1;
603 case PL080_WIDTH_16BIT:
604 return 2;
605 case PL080_WIDTH_32BIT:
606 return 4;
607 default:
608 break;
609 }
610 BUG();
611 return 0;
612}
613
614static inline u32 pl08x_cctl_bits(u32 cctl, u8 srcwidth, u8 dstwidth,
Russell King - ARM Linuxcace6582011-01-03 22:37:31 +0000615 size_t tsize)
Linus Walleije8689e62010-09-28 15:57:37 +0200616{
617 u32 retbits = cctl;
618
Russell King - ARM Linuxe8b5e112011-01-03 22:30:24 +0000619 /* Remove all src, dst and transfer size bits */
Linus Walleije8689e62010-09-28 15:57:37 +0200620 retbits &= ~PL080_CONTROL_DWIDTH_MASK;
621 retbits &= ~PL080_CONTROL_SWIDTH_MASK;
622 retbits &= ~PL080_CONTROL_TRANSFER_SIZE_MASK;
623
624 /* Then set the bits according to the parameters */
625 switch (srcwidth) {
626 case 1:
627 retbits |= PL080_WIDTH_8BIT << PL080_CONTROL_SWIDTH_SHIFT;
628 break;
629 case 2:
630 retbits |= PL080_WIDTH_16BIT << PL080_CONTROL_SWIDTH_SHIFT;
631 break;
632 case 4:
633 retbits |= PL080_WIDTH_32BIT << PL080_CONTROL_SWIDTH_SHIFT;
634 break;
635 default:
636 BUG();
637 break;
638 }
639
640 switch (dstwidth) {
641 case 1:
642 retbits |= PL080_WIDTH_8BIT << PL080_CONTROL_DWIDTH_SHIFT;
643 break;
644 case 2:
645 retbits |= PL080_WIDTH_16BIT << PL080_CONTROL_DWIDTH_SHIFT;
646 break;
647 case 4:
648 retbits |= PL080_WIDTH_32BIT << PL080_CONTROL_DWIDTH_SHIFT;
649 break;
650 default:
651 BUG();
652 break;
653 }
654
655 retbits |= tsize << PL080_CONTROL_TRANSFER_SIZE_SHIFT;
656 return retbits;
657}
658
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000659struct pl08x_lli_build_data {
660 struct pl08x_txd *txd;
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000661 struct pl08x_bus_data srcbus;
662 struct pl08x_bus_data dstbus;
663 size_t remainder;
Russell King - ARM Linux25c94f72011-07-21 17:11:46 +0100664 u32 lli_bus;
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000665};
666
Linus Walleije8689e62010-09-28 15:57:37 +0200667/*
Viresh Kumar0532e6f2011-08-05 15:32:31 +0530668 * Autoselect a master bus to use for the transfer. Slave will be the chosen as
669 * victim in case src & dest are not similarly aligned. i.e. If after aligning
670 * masters address with width requirements of transfer (by sending few byte by
671 * byte data), slave is still not aligned, then its width will be reduced to
672 * BYTE.
673 * - prefers the destination bus if both available
Viresh Kumar036f05f2011-08-05 15:32:41 +0530674 * - prefers bus with fixed address (i.e. peripheral)
Linus Walleije8689e62010-09-28 15:57:37 +0200675 */
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000676static void pl08x_choose_master_bus(struct pl08x_lli_build_data *bd,
677 struct pl08x_bus_data **mbus, struct pl08x_bus_data **sbus, u32 cctl)
Linus Walleije8689e62010-09-28 15:57:37 +0200678{
679 if (!(cctl & PL080_CONTROL_DST_INCR)) {
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000680 *mbus = &bd->dstbus;
681 *sbus = &bd->srcbus;
Viresh Kumar036f05f2011-08-05 15:32:41 +0530682 } else if (!(cctl & PL080_CONTROL_SRC_INCR)) {
683 *mbus = &bd->srcbus;
684 *sbus = &bd->dstbus;
Linus Walleije8689e62010-09-28 15:57:37 +0200685 } else {
Viresh Kumar036f05f2011-08-05 15:32:41 +0530686 if (bd->dstbus.buswidth >= bd->srcbus.buswidth) {
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000687 *mbus = &bd->dstbus;
688 *sbus = &bd->srcbus;
Linus Walleije8689e62010-09-28 15:57:37 +0200689 } else {
Viresh Kumar036f05f2011-08-05 15:32:41 +0530690 *mbus = &bd->srcbus;
691 *sbus = &bd->dstbus;
Linus Walleije8689e62010-09-28 15:57:37 +0200692 }
693 }
694}
695
696/*
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +0000697 * Fills in one LLI for a certain transfer descriptor and advance the counter
Linus Walleije8689e62010-09-28 15:57:37 +0200698 */
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000699static void pl08x_fill_lli_for_desc(struct pl08x_lli_build_data *bd,
700 int num_llis, int len, u32 cctl)
Linus Walleije8689e62010-09-28 15:57:37 +0200701{
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000702 struct pl08x_lli *llis_va = bd->txd->llis_va;
703 dma_addr_t llis_bus = bd->txd->llis_bus;
Linus Walleije8689e62010-09-28 15:57:37 +0200704
705 BUG_ON(num_llis >= MAX_NUM_TSFR_LLIS);
706
Russell King - ARM Linux30749cb2011-01-03 22:41:13 +0000707 llis_va[num_llis].cctl = cctl;
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000708 llis_va[num_llis].src = bd->srcbus.addr;
709 llis_va[num_llis].dst = bd->dstbus.addr;
Viresh Kumar3e27ee82011-08-05 15:32:27 +0530710 llis_va[num_llis].lli = llis_bus + (num_llis + 1) *
711 sizeof(struct pl08x_lli);
Russell King - ARM Linux25c94f72011-07-21 17:11:46 +0100712 llis_va[num_llis].lli |= bd->lli_bus;
Linus Walleije8689e62010-09-28 15:57:37 +0200713
714 if (cctl & PL080_CONTROL_SRC_INCR)
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000715 bd->srcbus.addr += len;
Linus Walleije8689e62010-09-28 15:57:37 +0200716 if (cctl & PL080_CONTROL_DST_INCR)
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000717 bd->dstbus.addr += len;
Linus Walleije8689e62010-09-28 15:57:37 +0200718
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000719 BUG_ON(bd->remainder < len);
Russell King - ARM Linuxcace6582011-01-03 22:37:31 +0000720
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000721 bd->remainder -= len;
Linus Walleije8689e62010-09-28 15:57:37 +0200722}
723
Viresh Kumar03af5002011-08-05 15:32:39 +0530724static inline void prep_byte_width_lli(struct pl08x_lli_build_data *bd,
725 u32 *cctl, u32 len, int num_llis, size_t *total_bytes)
Linus Walleije8689e62010-09-28 15:57:37 +0200726{
Viresh Kumar03af5002011-08-05 15:32:39 +0530727 *cctl = pl08x_cctl_bits(*cctl, 1, 1, len);
728 pl08x_fill_lli_for_desc(bd, num_llis, len, *cctl);
729 (*total_bytes) += len;
Linus Walleije8689e62010-09-28 15:57:37 +0200730}
731
732/*
733 * This fills in the table of LLIs for the transfer descriptor
734 * Note that we assume we never have to change the burst sizes
735 * Return 0 for error
736 */
737static int pl08x_fill_llis_for_desc(struct pl08x_driver_data *pl08x,
738 struct pl08x_txd *txd)
739{
Linus Walleije8689e62010-09-28 15:57:37 +0200740 struct pl08x_bus_data *mbus, *sbus;
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000741 struct pl08x_lli_build_data bd;
Linus Walleije8689e62010-09-28 15:57:37 +0200742 int num_llis = 0;
Viresh Kumar03af5002011-08-05 15:32:39 +0530743 u32 cctl, early_bytes = 0;
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530744 size_t max_bytes_per_lli, total_bytes;
Russell King - ARM Linux7cb72ad2011-01-03 22:35:28 +0000745 struct pl08x_lli *llis_va;
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530746 struct pl08x_sg *dsg;
Linus Walleije8689e62010-09-28 15:57:37 +0200747
Viresh Kumar3e27ee82011-08-05 15:32:27 +0530748 txd->llis_va = dma_pool_alloc(pl08x->pool, GFP_NOWAIT, &txd->llis_bus);
Linus Walleije8689e62010-09-28 15:57:37 +0200749 if (!txd->llis_va) {
750 dev_err(&pl08x->adev->dev, "%s no memory for llis\n", __func__);
751 return 0;
752 }
753
754 pl08x->pool_ctr++;
755
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000756 bd.txd = txd;
Russell King - ARM Linux25c94f72011-07-21 17:11:46 +0100757 bd.lli_bus = (pl08x->lli_buses & PL08X_AHB2) ? PL080_LLI_LM_AHB2 : 0;
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530758 cctl = txd->cctl;
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000759
Linus Walleije8689e62010-09-28 15:57:37 +0200760 /* Find maximum width of the source bus */
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000761 bd.srcbus.maxwidth =
Linus Walleije8689e62010-09-28 15:57:37 +0200762 pl08x_get_bytes_for_cctl((cctl & PL080_CONTROL_SWIDTH_MASK) >>
763 PL080_CONTROL_SWIDTH_SHIFT);
764
765 /* Find maximum width of the destination bus */
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000766 bd.dstbus.maxwidth =
Linus Walleije8689e62010-09-28 15:57:37 +0200767 pl08x_get_bytes_for_cctl((cctl & PL080_CONTROL_DWIDTH_MASK) >>
768 PL080_CONTROL_DWIDTH_SHIFT);
769
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530770 list_for_each_entry(dsg, &txd->dsg_list, node) {
771 total_bytes = 0;
772 cctl = txd->cctl;
Linus Walleije8689e62010-09-28 15:57:37 +0200773
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530774 bd.srcbus.addr = dsg->src_addr;
775 bd.dstbus.addr = dsg->dst_addr;
776 bd.remainder = dsg->len;
777 bd.srcbus.buswidth = bd.srcbus.maxwidth;
778 bd.dstbus.buswidth = bd.dstbus.maxwidth;
Linus Walleije8689e62010-09-28 15:57:37 +0200779
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530780 pl08x_choose_master_bus(&bd, &mbus, &sbus, cctl);
Linus Walleije8689e62010-09-28 15:57:37 +0200781
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530782 dev_vdbg(&pl08x->adev->dev, "src=0x%08x%s/%u dst=0x%08x%s/%u len=%zu\n",
783 bd.srcbus.addr, cctl & PL080_CONTROL_SRC_INCR ? "+" : "",
784 bd.srcbus.buswidth,
785 bd.dstbus.addr, cctl & PL080_CONTROL_DST_INCR ? "+" : "",
786 bd.dstbus.buswidth,
787 bd.remainder);
788 dev_vdbg(&pl08x->adev->dev, "mbus=%s sbus=%s\n",
789 mbus == &bd.srcbus ? "src" : "dst",
790 sbus == &bd.srcbus ? "src" : "dst");
Russell King - ARM Linuxfc74eb72011-07-21 17:12:06 +0100791
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530792 /*
793 * Zero length is only allowed if all these requirements are
794 * met:
795 * - flow controller is peripheral.
796 * - src.addr is aligned to src.width
797 * - dst.addr is aligned to dst.width
798 *
799 * sg_len == 1 should be true, as there can be two cases here:
800 *
801 * - Memory addresses are contiguous and are not scattered.
802 * Here, Only one sg will be passed by user driver, with
803 * memory address and zero length. We pass this to controller
804 * and after the transfer it will receive the last burst
805 * request from peripheral and so transfer finishes.
806 *
807 * - Memory addresses are scattered and are not contiguous.
808 * Here, Obviously as DMA controller doesn't know when a lli's
809 * transfer gets over, it can't load next lli. So in this
810 * case, there has to be an assumption that only one lli is
811 * supported. Thus, we can't have scattered addresses.
812 */
813 if (!bd.remainder) {
814 u32 fc = (txd->ccfg & PL080_CONFIG_FLOW_CONTROL_MASK) >>
815 PL080_CONFIG_FLOW_CONTROL_SHIFT;
816 if (!((fc >= PL080_FLOW_SRC2DST_DST) &&
Viresh Kumar0a235652011-08-05 15:32:42 +0530817 (fc <= PL080_FLOW_SRC2DST_SRC))) {
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530818 dev_err(&pl08x->adev->dev, "%s sg len can't be zero",
819 __func__);
820 return 0;
821 }
Linus Walleije8689e62010-09-28 15:57:37 +0200822
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530823 if ((bd.srcbus.addr % bd.srcbus.buswidth) ||
Julia Lawall880db3f2012-01-12 22:49:29 +0100824 (bd.dstbus.addr % bd.dstbus.buswidth)) {
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530825 dev_err(&pl08x->adev->dev,
826 "%s src & dst address must be aligned to src"
827 " & dst width if peripheral is flow controller",
828 __func__);
829 return 0;
830 }
Linus Walleije8689e62010-09-28 15:57:37 +0200831
Viresh Kumar16a2e7d2011-08-05 15:32:37 +0530832 cctl = pl08x_cctl_bits(cctl, bd.srcbus.buswidth,
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530833 bd.dstbus.buswidth, 0);
834 pl08x_fill_lli_for_desc(&bd, num_llis++, 0, cctl);
835 break;
Linus Walleije8689e62010-09-28 15:57:37 +0200836 }
837
838 /*
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530839 * Send byte by byte for following cases
840 * - Less than a bus width available
841 * - until master bus is aligned
Linus Walleije8689e62010-09-28 15:57:37 +0200842 */
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530843 if (bd.remainder < mbus->buswidth)
844 early_bytes = bd.remainder;
845 else if ((mbus->addr) % (mbus->buswidth)) {
846 early_bytes = mbus->buswidth - (mbus->addr) %
847 (mbus->buswidth);
848 if ((bd.remainder - early_bytes) < mbus->buswidth)
849 early_bytes = bd.remainder;
Linus Walleije8689e62010-09-28 15:57:37 +0200850 }
Viresh Kumar16a2e7d2011-08-05 15:32:37 +0530851
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530852 if (early_bytes) {
853 dev_vdbg(&pl08x->adev->dev,
854 "%s byte width LLIs (remain 0x%08x)\n",
855 __func__, bd.remainder);
856 prep_byte_width_lli(&bd, &cctl, early_bytes, num_llis++,
857 &total_bytes);
858 }
Linus Walleije8689e62010-09-28 15:57:37 +0200859
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530860 if (bd.remainder) {
861 /*
862 * Master now aligned
863 * - if slave is not then we must set its width down
864 */
865 if (sbus->addr % sbus->buswidth) {
866 dev_dbg(&pl08x->adev->dev,
867 "%s set down bus width to one byte\n",
868 __func__);
869
870 sbus->buswidth = 1;
871 }
872
873 /*
874 * Bytes transferred = tsize * src width, not
875 * MIN(buswidths)
876 */
877 max_bytes_per_lli = bd.srcbus.buswidth *
878 PL080_CONTROL_TRANSFER_SIZE_MASK;
879 dev_vdbg(&pl08x->adev->dev,
880 "%s max bytes per lli = %zu\n",
881 __func__, max_bytes_per_lli);
882
883 /*
884 * Make largest possible LLIs until less than one bus
885 * width left
886 */
887 while (bd.remainder > (mbus->buswidth - 1)) {
888 size_t lli_len, tsize, width;
889
890 /*
891 * If enough left try to send max possible,
892 * otherwise try to send the remainder
893 */
894 lli_len = min(bd.remainder, max_bytes_per_lli);
895
896 /*
897 * Check against maximum bus alignment:
898 * Calculate actual transfer size in relation to
899 * bus width an get a maximum remainder of the
900 * highest bus width - 1
901 */
902 width = max(mbus->buswidth, sbus->buswidth);
903 lli_len = (lli_len / width) * width;
904 tsize = lli_len / bd.srcbus.buswidth;
905
906 dev_vdbg(&pl08x->adev->dev,
907 "%s fill lli with single lli chunk of "
908 "size 0x%08zx (remainder 0x%08zx)\n",
909 __func__, lli_len, bd.remainder);
910
911 cctl = pl08x_cctl_bits(cctl, bd.srcbus.buswidth,
912 bd.dstbus.buswidth, tsize);
913 pl08x_fill_lli_for_desc(&bd, num_llis++,
914 lli_len, cctl);
915 total_bytes += lli_len;
916 }
917
918 /*
919 * Send any odd bytes
920 */
921 if (bd.remainder) {
922 dev_vdbg(&pl08x->adev->dev,
923 "%s align with boundary, send odd bytes (remain %zu)\n",
924 __func__, bd.remainder);
925 prep_byte_width_lli(&bd, &cctl, bd.remainder,
926 num_llis++, &total_bytes);
927 }
928 }
929
930 if (total_bytes != dsg->len) {
931 dev_err(&pl08x->adev->dev,
932 "%s size of encoded lli:s don't match total txd, transferred 0x%08zx from size 0x%08zx\n",
933 __func__, total_bytes, dsg->len);
934 return 0;
935 }
936
937 if (num_llis >= MAX_NUM_TSFR_LLIS) {
938 dev_err(&pl08x->adev->dev,
939 "%s need to increase MAX_NUM_TSFR_LLIS from 0x%08x\n",
940 __func__, (u32) MAX_NUM_TSFR_LLIS);
941 return 0;
942 }
Linus Walleije8689e62010-09-28 15:57:37 +0200943 }
Linus Walleije8689e62010-09-28 15:57:37 +0200944
Russell King - ARM Linuxb58b6b52011-01-03 22:34:48 +0000945 llis_va = txd->llis_va;
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +0000946 /* The final LLI terminates the LLI. */
Russell King - ARM Linuxbfddfb42011-01-03 22:38:12 +0000947 llis_va[num_llis - 1].lli = 0;
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +0000948 /* The final LLI element shall also fire an interrupt. */
Russell King - ARM Linuxb58b6b52011-01-03 22:34:48 +0000949 llis_va[num_llis - 1].cctl |= PL080_CONTROL_TC_IRQ_EN;
Linus Walleije8689e62010-09-28 15:57:37 +0200950
Linus Walleije8689e62010-09-28 15:57:37 +0200951#ifdef VERBOSE_DEBUG
952 {
953 int i;
954
Russell King - ARM Linuxfc74eb72011-07-21 17:12:06 +0100955 dev_vdbg(&pl08x->adev->dev,
956 "%-3s %-9s %-10s %-10s %-10s %s\n",
957 "lli", "", "csrc", "cdst", "clli", "cctl");
Linus Walleije8689e62010-09-28 15:57:37 +0200958 for (i = 0; i < num_llis; i++) {
959 dev_vdbg(&pl08x->adev->dev,
Russell King - ARM Linuxfc74eb72011-07-21 17:12:06 +0100960 "%3d @%p: 0x%08x 0x%08x 0x%08x 0x%08x\n",
961 i, &llis_va[i], llis_va[i].src,
962 llis_va[i].dst, llis_va[i].lli, llis_va[i].cctl
Linus Walleije8689e62010-09-28 15:57:37 +0200963 );
964 }
965 }
966#endif
967
968 return num_llis;
969}
970
971/* You should call this with the struct pl08x lock held */
972static void pl08x_free_txd(struct pl08x_driver_data *pl08x,
973 struct pl08x_txd *txd)
974{
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530975 struct pl08x_sg *dsg, *_dsg;
976
Linus Walleije8689e62010-09-28 15:57:37 +0200977 /* Free the LLI */
Viresh Kumarc1205642011-08-05 15:32:44 +0530978 if (txd->llis_va)
979 dma_pool_free(pl08x->pool, txd->llis_va, txd->llis_bus);
Linus Walleije8689e62010-09-28 15:57:37 +0200980
981 pl08x->pool_ctr--;
982
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530983 list_for_each_entry_safe(dsg, _dsg, &txd->dsg_list, node) {
984 list_del(&dsg->node);
985 kfree(dsg);
986 }
987
Linus Walleije8689e62010-09-28 15:57:37 +0200988 kfree(txd);
989}
990
991static void pl08x_free_txd_list(struct pl08x_driver_data *pl08x,
992 struct pl08x_dma_chan *plchan)
993{
994 struct pl08x_txd *txdi = NULL;
995 struct pl08x_txd *next;
996
Russell King - ARM Linux15c17232011-01-03 22:44:36 +0000997 if (!list_empty(&plchan->pend_list)) {
Linus Walleije8689e62010-09-28 15:57:37 +0200998 list_for_each_entry_safe(txdi,
Russell King - ARM Linux15c17232011-01-03 22:44:36 +0000999 next, &plchan->pend_list, node) {
Linus Walleije8689e62010-09-28 15:57:37 +02001000 list_del(&txdi->node);
1001 pl08x_free_txd(pl08x, txdi);
1002 }
Linus Walleije8689e62010-09-28 15:57:37 +02001003 }
1004}
1005
1006/*
1007 * The DMA ENGINE API
1008 */
1009static int pl08x_alloc_chan_resources(struct dma_chan *chan)
1010{
1011 return 0;
1012}
1013
1014static void pl08x_free_chan_resources(struct dma_chan *chan)
1015{
1016}
1017
1018/*
1019 * This should be called with the channel plchan->lock held
1020 */
1021static int prep_phy_channel(struct pl08x_dma_chan *plchan,
1022 struct pl08x_txd *txd)
1023{
1024 struct pl08x_driver_data *pl08x = plchan->host;
1025 struct pl08x_phy_chan *ch;
1026 int ret;
1027
1028 /* Check if we already have a channel */
Viresh Kumar8f0d30f2011-11-29 12:56:50 +05301029 if (plchan->phychan) {
1030 ch = plchan->phychan;
1031 goto got_channel;
1032 }
Linus Walleije8689e62010-09-28 15:57:37 +02001033
1034 ch = pl08x_get_phy_channel(pl08x, plchan);
1035 if (!ch) {
1036 /* No physical channel available, cope with it */
1037 dev_dbg(&pl08x->adev->dev, "no physical channel available for xfer on %s\n", plchan->name);
1038 return -EBUSY;
1039 }
1040
1041 /*
1042 * OK we have a physical channel: for memcpy() this is all we
1043 * need, but for slaves the physical signals may be muxed!
1044 * Can the platform allow us to use this channel?
1045 */
Russell King6b16c8b2012-05-25 11:10:58 +01001046 if (plchan->slave) {
Russell Kingad0de2a2012-05-25 11:15:15 +01001047 ret = pl08x_request_mux(plchan);
Linus Walleije8689e62010-09-28 15:57:37 +02001048 if (ret < 0) {
1049 dev_dbg(&pl08x->adev->dev,
1050 "unable to use physical channel %d for transfer on %s due to platform restrictions\n",
1051 ch->id, plchan->name);
1052 /* Release physical channel & return */
1053 pl08x_put_phy_channel(pl08x, ch);
1054 return -EBUSY;
1055 }
Linus Walleije8689e62010-09-28 15:57:37 +02001056 }
1057
Viresh Kumar8f0d30f2011-11-29 12:56:50 +05301058 plchan->phychan = ch;
Linus Walleije8689e62010-09-28 15:57:37 +02001059 dev_dbg(&pl08x->adev->dev, "allocated physical channel %d and signal %d for xfer on %s\n",
1060 ch->id,
Russell Kingad0de2a2012-05-25 11:15:15 +01001061 plchan->signal,
Linus Walleije8689e62010-09-28 15:57:37 +02001062 plchan->name);
1063
Viresh Kumar8f0d30f2011-11-29 12:56:50 +05301064got_channel:
1065 /* Assign the flow control signal to this channel */
1066 if (txd->direction == DMA_MEM_TO_DEV)
Russell Kingad0de2a2012-05-25 11:15:15 +01001067 txd->ccfg |= plchan->signal << PL080_CONFIG_DST_SEL_SHIFT;
Viresh Kumar8f0d30f2011-11-29 12:56:50 +05301068 else if (txd->direction == DMA_DEV_TO_MEM)
Russell Kingad0de2a2012-05-25 11:15:15 +01001069 txd->ccfg |= plchan->signal << PL080_CONFIG_SRC_SEL_SHIFT;
Viresh Kumar8f0d30f2011-11-29 12:56:50 +05301070
Russell King - ARM Linux8087aac2011-01-03 22:45:17 +00001071 plchan->phychan_hold++;
Linus Walleije8689e62010-09-28 15:57:37 +02001072
1073 return 0;
1074}
1075
Russell King - ARM Linux8c8cc2b2011-01-03 22:36:09 +00001076static void release_phy_channel(struct pl08x_dma_chan *plchan)
1077{
1078 struct pl08x_driver_data *pl08x = plchan->host;
1079
Russell King6b16c8b2012-05-25 11:10:58 +01001080 pl08x_release_mux(plchan);
Russell King - ARM Linux8c8cc2b2011-01-03 22:36:09 +00001081 pl08x_put_phy_channel(pl08x, plchan->phychan);
1082 plchan->phychan = NULL;
1083}
1084
Linus Walleije8689e62010-09-28 15:57:37 +02001085static dma_cookie_t pl08x_tx_submit(struct dma_async_tx_descriptor *tx)
1086{
1087 struct pl08x_dma_chan *plchan = to_pl08x_chan(tx->chan);
Russell King - ARM Linux501e67e2011-01-03 22:44:57 +00001088 struct pl08x_txd *txd = to_pl08x_txd(tx);
Russell King - ARM Linuxc370e592011-01-03 22:45:37 +00001089 unsigned long flags;
Russell King - ARM Linux884485e2012-03-06 22:34:46 +00001090 dma_cookie_t cookie;
Russell King - ARM Linuxc370e592011-01-03 22:45:37 +00001091
1092 spin_lock_irqsave(&plchan->lock, flags);
Russell King - ARM Linux884485e2012-03-06 22:34:46 +00001093 cookie = dma_cookie_assign(tx);
Russell King - ARM Linux501e67e2011-01-03 22:44:57 +00001094
1095 /* Put this onto the pending list */
1096 list_add_tail(&txd->node, &plchan->pend_list);
1097
1098 /*
1099 * If there was no physical channel available for this memcpy,
1100 * stack the request up and indicate that the channel is waiting
1101 * for a free physical channel.
1102 */
1103 if (!plchan->slave && !plchan->phychan) {
1104 /* Do this memcpy whenever there is a channel ready */
1105 plchan->state = PL08X_CHAN_WAITING;
1106 plchan->waiting = txd;
Russell King - ARM Linux8087aac2011-01-03 22:45:17 +00001107 } else {
1108 plchan->phychan_hold--;
Russell King - ARM Linux501e67e2011-01-03 22:44:57 +00001109 }
1110
Russell King - ARM Linuxc370e592011-01-03 22:45:37 +00001111 spin_unlock_irqrestore(&plchan->lock, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001112
Russell King - ARM Linux884485e2012-03-06 22:34:46 +00001113 return cookie;
Linus Walleije8689e62010-09-28 15:57:37 +02001114}
1115
1116static struct dma_async_tx_descriptor *pl08x_prep_dma_interrupt(
1117 struct dma_chan *chan, unsigned long flags)
1118{
1119 struct dma_async_tx_descriptor *retval = NULL;
1120
1121 return retval;
1122}
1123
1124/*
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +00001125 * Code accessing dma_async_is_complete() in a tight loop may give problems.
1126 * If slaves are relying on interrupts to signal completion this function
1127 * must not be called with interrupts disabled.
Linus Walleije8689e62010-09-28 15:57:37 +02001128 */
Viresh Kumar3e27ee82011-08-05 15:32:27 +05301129static enum dma_status pl08x_dma_tx_status(struct dma_chan *chan,
1130 dma_cookie_t cookie, struct dma_tx_state *txstate)
Linus Walleije8689e62010-09-28 15:57:37 +02001131{
1132 struct pl08x_dma_chan *plchan = to_pl08x_chan(chan);
Linus Walleije8689e62010-09-28 15:57:37 +02001133 enum dma_status ret;
Linus Walleije8689e62010-09-28 15:57:37 +02001134
Russell King - ARM Linux96a2af42012-03-06 22:35:27 +00001135 ret = dma_cookie_status(chan, cookie, txstate);
1136 if (ret == DMA_SUCCESS)
Linus Walleije8689e62010-09-28 15:57:37 +02001137 return ret;
Linus Walleije8689e62010-09-28 15:57:37 +02001138
1139 /*
Linus Walleije8689e62010-09-28 15:57:37 +02001140 * This cookie not complete yet
Russell King - ARM Linux96a2af42012-03-06 22:35:27 +00001141 * Get number of bytes left in the active transactions and queue
Linus Walleije8689e62010-09-28 15:57:37 +02001142 */
Russell King - ARM Linux96a2af42012-03-06 22:35:27 +00001143 dma_set_residue(txstate, pl08x_getbytes_chan(plchan));
Linus Walleije8689e62010-09-28 15:57:37 +02001144
1145 if (plchan->state == PL08X_CHAN_PAUSED)
1146 return DMA_PAUSED;
1147
1148 /* Whether waiting or running, we're in progress */
1149 return DMA_IN_PROGRESS;
1150}
1151
1152/* PrimeCell DMA extension */
1153struct burst_table {
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001154 u32 burstwords;
Linus Walleije8689e62010-09-28 15:57:37 +02001155 u32 reg;
1156};
1157
1158static const struct burst_table burst_sizes[] = {
1159 {
1160 .burstwords = 256,
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001161 .reg = PL080_BSIZE_256,
Linus Walleije8689e62010-09-28 15:57:37 +02001162 },
1163 {
1164 .burstwords = 128,
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001165 .reg = PL080_BSIZE_128,
Linus Walleije8689e62010-09-28 15:57:37 +02001166 },
1167 {
1168 .burstwords = 64,
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001169 .reg = PL080_BSIZE_64,
Linus Walleije8689e62010-09-28 15:57:37 +02001170 },
1171 {
1172 .burstwords = 32,
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001173 .reg = PL080_BSIZE_32,
Linus Walleije8689e62010-09-28 15:57:37 +02001174 },
1175 {
1176 .burstwords = 16,
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001177 .reg = PL080_BSIZE_16,
Linus Walleije8689e62010-09-28 15:57:37 +02001178 },
1179 {
1180 .burstwords = 8,
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001181 .reg = PL080_BSIZE_8,
Linus Walleije8689e62010-09-28 15:57:37 +02001182 },
1183 {
1184 .burstwords = 4,
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001185 .reg = PL080_BSIZE_4,
Linus Walleije8689e62010-09-28 15:57:37 +02001186 },
1187 {
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001188 .burstwords = 0,
1189 .reg = PL080_BSIZE_1,
Linus Walleije8689e62010-09-28 15:57:37 +02001190 },
1191};
1192
Russell King - ARM Linux121c8472011-07-21 17:13:48 +01001193/*
1194 * Given the source and destination available bus masks, select which
1195 * will be routed to each port. We try to have source and destination
1196 * on separate ports, but always respect the allowable settings.
1197 */
1198static u32 pl08x_select_bus(u8 src, u8 dst)
1199{
1200 u32 cctl = 0;
1201
1202 if (!(dst & PL08X_AHB1) || ((dst & PL08X_AHB2) && (src & PL08X_AHB1)))
1203 cctl |= PL080_CONTROL_DST_AHB2;
1204 if (!(src & PL08X_AHB1) || ((src & PL08X_AHB2) && !(dst & PL08X_AHB2)))
1205 cctl |= PL080_CONTROL_SRC_AHB2;
1206
1207 return cctl;
1208}
1209
Russell King - ARM Linuxf14c4262011-07-21 17:12:47 +01001210static u32 pl08x_cctl(u32 cctl)
1211{
1212 cctl &= ~(PL080_CONTROL_SRC_AHB2 | PL080_CONTROL_DST_AHB2 |
1213 PL080_CONTROL_SRC_INCR | PL080_CONTROL_DST_INCR |
1214 PL080_CONTROL_PROT_MASK);
1215
1216 /* Access the cell in privileged mode, non-bufferable, non-cacheable */
1217 return cctl | PL080_CONTROL_PROT_SYS;
1218}
1219
Russell King - ARM Linuxaa88cda2011-07-21 17:13:28 +01001220static u32 pl08x_width(enum dma_slave_buswidth width)
1221{
1222 switch (width) {
1223 case DMA_SLAVE_BUSWIDTH_1_BYTE:
1224 return PL080_WIDTH_8BIT;
1225 case DMA_SLAVE_BUSWIDTH_2_BYTES:
1226 return PL080_WIDTH_16BIT;
1227 case DMA_SLAVE_BUSWIDTH_4_BYTES:
1228 return PL080_WIDTH_32BIT;
Vinod Koulf32807f2011-07-25 19:22:01 +05301229 default:
1230 return ~0;
Russell King - ARM Linuxaa88cda2011-07-21 17:13:28 +01001231 }
Russell King - ARM Linuxaa88cda2011-07-21 17:13:28 +01001232}
1233
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001234static u32 pl08x_burst(u32 maxburst)
1235{
1236 int i;
1237
1238 for (i = 0; i < ARRAY_SIZE(burst_sizes); i++)
1239 if (burst_sizes[i].burstwords <= maxburst)
1240 break;
1241
1242 return burst_sizes[i].reg;
1243}
1244
Russell King9862ba12012-05-16 11:16:03 +01001245static u32 pl08x_get_cctl(struct pl08x_dma_chan *plchan,
1246 enum dma_slave_buswidth addr_width, u32 maxburst)
1247{
1248 u32 width, burst, cctl = 0;
1249
1250 width = pl08x_width(addr_width);
1251 if (width == ~0)
1252 return ~0;
1253
1254 cctl |= width << PL080_CONTROL_SWIDTH_SHIFT;
1255 cctl |= width << PL080_CONTROL_DWIDTH_SHIFT;
1256
1257 /*
1258 * If this channel will only request single transfers, set this
1259 * down to ONE element. Also select one element if no maxburst
1260 * is specified.
1261 */
1262 if (plchan->cd->single)
1263 maxburst = 1;
1264
1265 burst = pl08x_burst(maxburst);
1266 cctl |= burst << PL080_CONTROL_SB_SIZE_SHIFT;
1267 cctl |= burst << PL080_CONTROL_DB_SIZE_SHIFT;
1268
1269 return pl08x_cctl(cctl);
1270}
1271
Russell King - ARM Linuxf0fd9442011-01-03 22:45:57 +00001272static int dma_set_runtime_config(struct dma_chan *chan,
1273 struct dma_slave_config *config)
Linus Walleije8689e62010-09-28 15:57:37 +02001274{
1275 struct pl08x_dma_chan *plchan = to_pl08x_chan(chan);
Linus Walleije8689e62010-09-28 15:57:37 +02001276
Russell King - ARM Linuxb7f75862011-01-03 22:46:17 +00001277 if (!plchan->slave)
1278 return -EINVAL;
1279
Russell Kingdc8d5f82012-05-16 12:20:55 +01001280 /* Reject definitely invalid configurations */
1281 if (config->src_addr_width == DMA_SLAVE_BUSWIDTH_8_BYTES ||
1282 config->dst_addr_width == DMA_SLAVE_BUSWIDTH_8_BYTES)
Russell King - ARM Linuxf0fd9442011-01-03 22:45:57 +00001283 return -EINVAL;
Linus Walleije8689e62010-09-28 15:57:37 +02001284
Russell Kinged91c132012-05-16 11:02:40 +01001285 plchan->cfg = *config;
1286
Russell King - ARM Linuxf0fd9442011-01-03 22:45:57 +00001287 return 0;
Linus Walleije8689e62010-09-28 15:57:37 +02001288}
1289
1290/*
1291 * Slave transactions callback to the slave device to allow
1292 * synchronization of slave DMA signals with the DMAC enable
1293 */
1294static void pl08x_issue_pending(struct dma_chan *chan)
1295{
1296 struct pl08x_dma_chan *plchan = to_pl08x_chan(chan);
Linus Walleije8689e62010-09-28 15:57:37 +02001297 unsigned long flags;
1298
1299 spin_lock_irqsave(&plchan->lock, flags);
Russell King - ARM Linux9c0bb432011-01-03 22:32:05 +00001300 /* Something is already active, or we're waiting for a channel... */
1301 if (plchan->at || plchan->state == PL08X_CHAN_WAITING) {
1302 spin_unlock_irqrestore(&plchan->lock, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001303 return;
Russell King - ARM Linux9c0bb432011-01-03 22:32:05 +00001304 }
Linus Walleije8689e62010-09-28 15:57:37 +02001305
1306 /* Take the first element in the queue and execute it */
Russell King - ARM Linux15c17232011-01-03 22:44:36 +00001307 if (!list_empty(&plchan->pend_list)) {
Linus Walleije8689e62010-09-28 15:57:37 +02001308 struct pl08x_txd *next;
1309
Russell King - ARM Linux15c17232011-01-03 22:44:36 +00001310 next = list_first_entry(&plchan->pend_list,
Linus Walleije8689e62010-09-28 15:57:37 +02001311 struct pl08x_txd,
1312 node);
1313 list_del(&next->node);
Linus Walleije8689e62010-09-28 15:57:37 +02001314 plchan->state = PL08X_CHAN_RUNNING;
1315
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +00001316 pl08x_start_txd(plchan, next);
Linus Walleije8689e62010-09-28 15:57:37 +02001317 }
1318
1319 spin_unlock_irqrestore(&plchan->lock, flags);
1320}
1321
1322static int pl08x_prep_channel_resources(struct pl08x_dma_chan *plchan,
1323 struct pl08x_txd *txd)
1324{
Linus Walleije8689e62010-09-28 15:57:37 +02001325 struct pl08x_driver_data *pl08x = plchan->host;
Russell King - ARM Linuxc370e592011-01-03 22:45:37 +00001326 unsigned long flags;
1327 int num_llis, ret;
Linus Walleije8689e62010-09-28 15:57:37 +02001328
1329 num_llis = pl08x_fill_llis_for_desc(pl08x, txd);
Russell King - ARM Linuxdafa7312011-01-03 22:31:45 +00001330 if (!num_llis) {
Viresh Kumar57001a62011-08-05 15:32:45 +05301331 spin_lock_irqsave(&plchan->lock, flags);
1332 pl08x_free_txd(pl08x, txd);
1333 spin_unlock_irqrestore(&plchan->lock, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001334 return -EINVAL;
Russell King - ARM Linuxdafa7312011-01-03 22:31:45 +00001335 }
Linus Walleije8689e62010-09-28 15:57:37 +02001336
Russell King - ARM Linuxc370e592011-01-03 22:45:37 +00001337 spin_lock_irqsave(&plchan->lock, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001338
Linus Walleije8689e62010-09-28 15:57:37 +02001339 /*
1340 * See if we already have a physical channel allocated,
1341 * else this is the time to try to get one.
1342 */
1343 ret = prep_phy_channel(plchan, txd);
1344 if (ret) {
1345 /*
Russell King - ARM Linux501e67e2011-01-03 22:44:57 +00001346 * No physical channel was available.
1347 *
1348 * memcpy transfers can be sorted out at submission time.
1349 *
1350 * Slave transfers may have been denied due to platform
1351 * channel muxing restrictions. Since there is no guarantee
1352 * that this will ever be resolved, and the signal must be
1353 * acquired AFTER acquiring the physical channel, we will let
1354 * them be NACK:ed with -EBUSY here. The drivers can retry
1355 * the prep() call if they are eager on doing this using DMA.
Linus Walleije8689e62010-09-28 15:57:37 +02001356 */
1357 if (plchan->slave) {
1358 pl08x_free_txd_list(pl08x, plchan);
Russell King - ARM Linux501e67e2011-01-03 22:44:57 +00001359 pl08x_free_txd(pl08x, txd);
Russell King - ARM Linuxc370e592011-01-03 22:45:37 +00001360 spin_unlock_irqrestore(&plchan->lock, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001361 return -EBUSY;
1362 }
Linus Walleije8689e62010-09-28 15:57:37 +02001363 } else
1364 /*
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +00001365 * Else we're all set, paused and ready to roll, status
1366 * will switch to PL08X_CHAN_RUNNING when we call
1367 * issue_pending(). If there is something running on the
1368 * channel already we don't change its state.
Linus Walleije8689e62010-09-28 15:57:37 +02001369 */
1370 if (plchan->state == PL08X_CHAN_IDLE)
1371 plchan->state = PL08X_CHAN_PAUSED;
1372
Russell King - ARM Linuxc370e592011-01-03 22:45:37 +00001373 spin_unlock_irqrestore(&plchan->lock, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001374
1375 return 0;
1376}
1377
Russell King - ARM Linuxc0428792011-01-03 22:43:56 +00001378static struct pl08x_txd *pl08x_get_txd(struct pl08x_dma_chan *plchan,
1379 unsigned long flags)
Russell King - ARM Linuxac3cd202011-01-03 22:35:49 +00001380{
Viresh Kumarb201c112011-08-05 15:32:29 +05301381 struct pl08x_txd *txd = kzalloc(sizeof(*txd), GFP_NOWAIT);
Russell King - ARM Linuxac3cd202011-01-03 22:35:49 +00001382
1383 if (txd) {
1384 dma_async_tx_descriptor_init(&txd->tx, &plchan->chan);
Russell King - ARM Linuxc0428792011-01-03 22:43:56 +00001385 txd->tx.flags = flags;
Russell King - ARM Linuxac3cd202011-01-03 22:35:49 +00001386 txd->tx.tx_submit = pl08x_tx_submit;
1387 INIT_LIST_HEAD(&txd->node);
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301388 INIT_LIST_HEAD(&txd->dsg_list);
Russell King - ARM Linux4983a042011-01-03 22:39:33 +00001389
1390 /* Always enable error and terminal interrupts */
1391 txd->ccfg = PL080_CONFIG_ERR_IRQ_MASK |
1392 PL080_CONFIG_TC_IRQ_MASK;
Russell King - ARM Linuxac3cd202011-01-03 22:35:49 +00001393 }
1394 return txd;
1395}
1396
Linus Walleije8689e62010-09-28 15:57:37 +02001397/*
1398 * Initialize a descriptor to be used by memcpy submit
1399 */
1400static struct dma_async_tx_descriptor *pl08x_prep_dma_memcpy(
1401 struct dma_chan *chan, dma_addr_t dest, dma_addr_t src,
1402 size_t len, unsigned long flags)
1403{
1404 struct pl08x_dma_chan *plchan = to_pl08x_chan(chan);
1405 struct pl08x_driver_data *pl08x = plchan->host;
1406 struct pl08x_txd *txd;
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301407 struct pl08x_sg *dsg;
Linus Walleije8689e62010-09-28 15:57:37 +02001408 int ret;
1409
Russell King - ARM Linuxc0428792011-01-03 22:43:56 +00001410 txd = pl08x_get_txd(plchan, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001411 if (!txd) {
1412 dev_err(&pl08x->adev->dev,
1413 "%s no memory for descriptor\n", __func__);
1414 return NULL;
1415 }
1416
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301417 dsg = kzalloc(sizeof(struct pl08x_sg), GFP_NOWAIT);
1418 if (!dsg) {
1419 pl08x_free_txd(pl08x, txd);
1420 dev_err(&pl08x->adev->dev, "%s no memory for pl080 sg\n",
1421 __func__);
1422 return NULL;
1423 }
1424 list_add_tail(&dsg->node, &txd->dsg_list);
1425
Russell King92d2fd62012-05-25 14:37:56 +01001426 txd->direction = DMA_MEM_TO_MEM;
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301427 dsg->src_addr = src;
1428 dsg->dst_addr = dest;
1429 dsg->len = len;
Linus Walleije8689e62010-09-28 15:57:37 +02001430
1431 /* Set platform data for m2m */
Russell King - ARM Linux4983a042011-01-03 22:39:33 +00001432 txd->ccfg |= PL080_FLOW_MEM2MEM << PL080_CONFIG_FLOW_CONTROL_SHIFT;
Russell Kingdc8d5f82012-05-16 12:20:55 +01001433 txd->cctl = pl08x->pd->memcpy_channel.cctl_memcpy &
Russell King - ARM Linuxc7da9a52011-01-03 22:40:53 +00001434 ~(PL080_CONTROL_DST_AHB2 | PL080_CONTROL_SRC_AHB2);
Russell King - ARM Linux4983a042011-01-03 22:39:33 +00001435
Linus Walleije8689e62010-09-28 15:57:37 +02001436 /* Both to be incremented or the code will break */
Russell King - ARM Linux70b5ed62011-01-03 22:40:13 +00001437 txd->cctl |= PL080_CONTROL_SRC_INCR | PL080_CONTROL_DST_INCR;
Russell King - ARM Linuxc7da9a52011-01-03 22:40:53 +00001438
Russell King - ARM Linuxc7da9a52011-01-03 22:40:53 +00001439 if (pl08x->vd->dualmaster)
Russell King - ARM Linux121c8472011-07-21 17:13:48 +01001440 txd->cctl |= pl08x_select_bus(pl08x->mem_buses,
1441 pl08x->mem_buses);
Linus Walleije8689e62010-09-28 15:57:37 +02001442
Linus Walleije8689e62010-09-28 15:57:37 +02001443 ret = pl08x_prep_channel_resources(plchan, txd);
1444 if (ret)
1445 return NULL;
Linus Walleije8689e62010-09-28 15:57:37 +02001446
1447 return &txd->tx;
1448}
1449
Russell King - ARM Linux3e2a0372011-01-03 22:32:46 +00001450static struct dma_async_tx_descriptor *pl08x_prep_slave_sg(
Linus Walleije8689e62010-09-28 15:57:37 +02001451 struct dma_chan *chan, struct scatterlist *sgl,
Vinod Kouldb8196d2011-10-13 22:34:23 +05301452 unsigned int sg_len, enum dma_transfer_direction direction,
Alexandre Bounine185ecb52012-03-08 15:35:13 -05001453 unsigned long flags, void *context)
Linus Walleije8689e62010-09-28 15:57:37 +02001454{
1455 struct pl08x_dma_chan *plchan = to_pl08x_chan(chan);
1456 struct pl08x_driver_data *pl08x = plchan->host;
1457 struct pl08x_txd *txd;
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301458 struct pl08x_sg *dsg;
1459 struct scatterlist *sg;
Russell Kingdc8d5f82012-05-16 12:20:55 +01001460 enum dma_slave_buswidth addr_width;
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301461 dma_addr_t slave_addr;
Viresh Kumar0a235652011-08-05 15:32:42 +05301462 int ret, tmp;
Russell King409ec8d2012-05-16 11:08:43 +01001463 u8 src_buses, dst_buses;
Russell Kingdc8d5f82012-05-16 12:20:55 +01001464 u32 maxburst, cctl;
Linus Walleije8689e62010-09-28 15:57:37 +02001465
Linus Walleije8689e62010-09-28 15:57:37 +02001466 dev_dbg(&pl08x->adev->dev, "%s prepare transaction of %d bytes from %s\n",
Lars-Peter Clausenfdaf9c42012-04-25 20:50:52 +02001467 __func__, sg_dma_len(sgl), plchan->name);
Linus Walleije8689e62010-09-28 15:57:37 +02001468
Russell King - ARM Linuxc0428792011-01-03 22:43:56 +00001469 txd = pl08x_get_txd(plchan, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001470 if (!txd) {
1471 dev_err(&pl08x->adev->dev, "%s no txd\n", __func__);
1472 return NULL;
1473 }
1474
Linus Walleije8689e62010-09-28 15:57:37 +02001475 /*
1476 * Set up addresses, the PrimeCell configured address
1477 * will take precedence since this may configure the
1478 * channel target address dynamically at runtime.
1479 */
1480 txd->direction = direction;
Russell King - ARM Linuxc7da9a52011-01-03 22:40:53 +00001481
Vinod Kouldb8196d2011-10-13 22:34:23 +05301482 if (direction == DMA_MEM_TO_DEV) {
Russell Kingdc8d5f82012-05-16 12:20:55 +01001483 cctl = PL080_CONTROL_SRC_INCR;
Russell Kinged91c132012-05-16 11:02:40 +01001484 slave_addr = plchan->cfg.dst_addr;
Russell Kingdc8d5f82012-05-16 12:20:55 +01001485 addr_width = plchan->cfg.dst_addr_width;
1486 maxburst = plchan->cfg.dst_maxburst;
Russell King409ec8d2012-05-16 11:08:43 +01001487 src_buses = pl08x->mem_buses;
1488 dst_buses = plchan->cd->periph_buses;
Vinod Kouldb8196d2011-10-13 22:34:23 +05301489 } else if (direction == DMA_DEV_TO_MEM) {
Russell Kingdc8d5f82012-05-16 12:20:55 +01001490 cctl = PL080_CONTROL_DST_INCR;
Russell Kinged91c132012-05-16 11:02:40 +01001491 slave_addr = plchan->cfg.src_addr;
Russell Kingdc8d5f82012-05-16 12:20:55 +01001492 addr_width = plchan->cfg.src_addr_width;
1493 maxburst = plchan->cfg.src_maxburst;
Russell King409ec8d2012-05-16 11:08:43 +01001494 src_buses = plchan->cd->periph_buses;
1495 dst_buses = pl08x->mem_buses;
Linus Walleije8689e62010-09-28 15:57:37 +02001496 } else {
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301497 pl08x_free_txd(pl08x, txd);
Linus Walleije8689e62010-09-28 15:57:37 +02001498 dev_err(&pl08x->adev->dev,
1499 "%s direction unsupported\n", __func__);
1500 return NULL;
1501 }
Linus Walleije8689e62010-09-28 15:57:37 +02001502
Russell Kingdc8d5f82012-05-16 12:20:55 +01001503 cctl |= pl08x_get_cctl(plchan, addr_width, maxburst);
Russell King800d6832012-05-16 11:33:31 +01001504 if (cctl == ~0) {
1505 pl08x_free_txd(pl08x, txd);
1506 dev_err(&pl08x->adev->dev,
1507 "DMA slave configuration botched?\n");
1508 return NULL;
1509 }
1510
Russell King409ec8d2012-05-16 11:08:43 +01001511 txd->cctl = cctl | pl08x_select_bus(src_buses, dst_buses);
1512
Russell King95442b22012-05-16 11:05:09 +01001513 if (plchan->cfg.device_fc)
Vinod Kouldb8196d2011-10-13 22:34:23 +05301514 tmp = (direction == DMA_MEM_TO_DEV) ? PL080_FLOW_MEM2PER_PER :
Viresh Kumar0a235652011-08-05 15:32:42 +05301515 PL080_FLOW_PER2MEM_PER;
1516 else
Vinod Kouldb8196d2011-10-13 22:34:23 +05301517 tmp = (direction == DMA_MEM_TO_DEV) ? PL080_FLOW_MEM2PER :
Viresh Kumar0a235652011-08-05 15:32:42 +05301518 PL080_FLOW_PER2MEM;
1519
1520 txd->ccfg |= tmp << PL080_CONFIG_FLOW_CONTROL_SHIFT;
1521
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301522 for_each_sg(sgl, sg, sg_len, tmp) {
1523 dsg = kzalloc(sizeof(struct pl08x_sg), GFP_NOWAIT);
1524 if (!dsg) {
1525 pl08x_free_txd(pl08x, txd);
1526 dev_err(&pl08x->adev->dev, "%s no mem for pl080 sg\n",
1527 __func__);
1528 return NULL;
1529 }
1530 list_add_tail(&dsg->node, &txd->dsg_list);
1531
1532 dsg->len = sg_dma_len(sg);
Vinod Kouldb8196d2011-10-13 22:34:23 +05301533 if (direction == DMA_MEM_TO_DEV) {
Lars-Peter Clausencbb796c2012-04-25 20:50:51 +02001534 dsg->src_addr = sg_dma_address(sg);
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301535 dsg->dst_addr = slave_addr;
1536 } else {
1537 dsg->src_addr = slave_addr;
Lars-Peter Clausencbb796c2012-04-25 20:50:51 +02001538 dsg->dst_addr = sg_dma_address(sg);
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301539 }
1540 }
1541
Linus Walleije8689e62010-09-28 15:57:37 +02001542 ret = pl08x_prep_channel_resources(plchan, txd);
1543 if (ret)
1544 return NULL;
Linus Walleije8689e62010-09-28 15:57:37 +02001545
1546 return &txd->tx;
1547}
1548
1549static int pl08x_control(struct dma_chan *chan, enum dma_ctrl_cmd cmd,
1550 unsigned long arg)
1551{
1552 struct pl08x_dma_chan *plchan = to_pl08x_chan(chan);
1553 struct pl08x_driver_data *pl08x = plchan->host;
1554 unsigned long flags;
1555 int ret = 0;
1556
1557 /* Controls applicable to inactive channels */
1558 if (cmd == DMA_SLAVE_CONFIG) {
Russell King - ARM Linuxf0fd9442011-01-03 22:45:57 +00001559 return dma_set_runtime_config(chan,
1560 (struct dma_slave_config *)arg);
Linus Walleije8689e62010-09-28 15:57:37 +02001561 }
1562
1563 /*
1564 * Anything succeeds on channels with no physical allocation and
1565 * no queued transfers.
1566 */
1567 spin_lock_irqsave(&plchan->lock, flags);
1568 if (!plchan->phychan && !plchan->at) {
1569 spin_unlock_irqrestore(&plchan->lock, flags);
1570 return 0;
1571 }
1572
1573 switch (cmd) {
1574 case DMA_TERMINATE_ALL:
1575 plchan->state = PL08X_CHAN_IDLE;
1576
1577 if (plchan->phychan) {
Russell King - ARM Linuxfb526212011-01-27 12:32:53 +00001578 pl08x_terminate_phy_chan(pl08x, plchan->phychan);
Linus Walleije8689e62010-09-28 15:57:37 +02001579
1580 /*
1581 * Mark physical channel as free and free any slave
1582 * signal
1583 */
Russell King - ARM Linux8c8cc2b2011-01-03 22:36:09 +00001584 release_phy_channel(plchan);
Davide Ciminaghi88c08a32012-04-19 12:20:24 +02001585 plchan->phychan_hold = 0;
Linus Walleije8689e62010-09-28 15:57:37 +02001586 }
Linus Walleije8689e62010-09-28 15:57:37 +02001587 /* Dequeue jobs and free LLIs */
1588 if (plchan->at) {
1589 pl08x_free_txd(pl08x, plchan->at);
1590 plchan->at = NULL;
1591 }
1592 /* Dequeue jobs not yet fired as well */
1593 pl08x_free_txd_list(pl08x, plchan);
1594 break;
1595 case DMA_PAUSE:
1596 pl08x_pause_phy_chan(plchan->phychan);
1597 plchan->state = PL08X_CHAN_PAUSED;
1598 break;
1599 case DMA_RESUME:
1600 pl08x_resume_phy_chan(plchan->phychan);
1601 plchan->state = PL08X_CHAN_RUNNING;
1602 break;
1603 default:
1604 /* Unknown command */
1605 ret = -ENXIO;
1606 break;
1607 }
1608
1609 spin_unlock_irqrestore(&plchan->lock, flags);
1610
1611 return ret;
1612}
1613
1614bool pl08x_filter_id(struct dma_chan *chan, void *chan_id)
1615{
Russell King - ARM Linux7703eac2011-08-31 09:34:35 +01001616 struct pl08x_dma_chan *plchan;
Linus Walleije8689e62010-09-28 15:57:37 +02001617 char *name = chan_id;
1618
Russell King - ARM Linux7703eac2011-08-31 09:34:35 +01001619 /* Reject channels for devices not bound to this driver */
1620 if (chan->device->dev->driver != &pl08x_amba_driver.drv)
1621 return false;
1622
1623 plchan = to_pl08x_chan(chan);
1624
Linus Walleije8689e62010-09-28 15:57:37 +02001625 /* Check that the channel is not taken! */
1626 if (!strcmp(plchan->name, name))
1627 return true;
1628
1629 return false;
1630}
1631
1632/*
1633 * Just check that the device is there and active
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +00001634 * TODO: turn this bit on/off depending on the number of physical channels
1635 * actually used, if it is zero... well shut it off. That will save some
1636 * power. Cut the clock at the same time.
Linus Walleije8689e62010-09-28 15:57:37 +02001637 */
1638static void pl08x_ensure_on(struct pl08x_driver_data *pl08x)
1639{
Linus Walleijaffa1152012-04-12 09:01:49 +02001640 /* The Nomadik variant does not have the config register */
1641 if (pl08x->vd->nomadik)
1642 return;
Viresh Kumar48a59ef2011-08-05 15:32:34 +05301643 writel(PL080_CONFIG_ENABLE, pl08x->base + PL080_CONFIG);
Linus Walleije8689e62010-09-28 15:57:37 +02001644}
1645
Russell King - ARM Linux3d992e12011-01-03 22:44:16 +00001646static void pl08x_unmap_buffers(struct pl08x_txd *txd)
1647{
1648 struct device *dev = txd->tx.chan->device->dev;
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301649 struct pl08x_sg *dsg;
Russell King - ARM Linux3d992e12011-01-03 22:44:16 +00001650
1651 if (!(txd->tx.flags & DMA_COMPL_SKIP_SRC_UNMAP)) {
1652 if (txd->tx.flags & DMA_COMPL_SRC_UNMAP_SINGLE)
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301653 list_for_each_entry(dsg, &txd->dsg_list, node)
1654 dma_unmap_single(dev, dsg->src_addr, dsg->len,
1655 DMA_TO_DEVICE);
1656 else {
1657 list_for_each_entry(dsg, &txd->dsg_list, node)
1658 dma_unmap_page(dev, dsg->src_addr, dsg->len,
1659 DMA_TO_DEVICE);
1660 }
Russell King - ARM Linux3d992e12011-01-03 22:44:16 +00001661 }
1662 if (!(txd->tx.flags & DMA_COMPL_SKIP_DEST_UNMAP)) {
1663 if (txd->tx.flags & DMA_COMPL_DEST_UNMAP_SINGLE)
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301664 list_for_each_entry(dsg, &txd->dsg_list, node)
1665 dma_unmap_single(dev, dsg->dst_addr, dsg->len,
1666 DMA_FROM_DEVICE);
Russell King - ARM Linux3d992e12011-01-03 22:44:16 +00001667 else
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301668 list_for_each_entry(dsg, &txd->dsg_list, node)
1669 dma_unmap_page(dev, dsg->dst_addr, dsg->len,
1670 DMA_FROM_DEVICE);
Russell King - ARM Linux3d992e12011-01-03 22:44:16 +00001671 }
1672}
1673
Linus Walleije8689e62010-09-28 15:57:37 +02001674static void pl08x_tasklet(unsigned long data)
1675{
1676 struct pl08x_dma_chan *plchan = (struct pl08x_dma_chan *) data;
Linus Walleije8689e62010-09-28 15:57:37 +02001677 struct pl08x_driver_data *pl08x = plchan->host;
Russell King - ARM Linuxbf072af2011-01-03 22:31:24 +00001678 unsigned long flags;
Russell Kinga936e792012-05-25 10:51:19 +01001679 LIST_HEAD(head);
Linus Walleije8689e62010-09-28 15:57:37 +02001680
Russell King - ARM Linuxbf072af2011-01-03 22:31:24 +00001681 spin_lock_irqsave(&plchan->lock, flags);
Russell Kinga936e792012-05-25 10:51:19 +01001682 list_splice_tail_init(&plchan->done_list, &head);
Russell King - ARM Linux8087aac2011-01-03 22:45:17 +00001683
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +00001684 /* If a new descriptor is queued, set it up plchan->at is NULL here */
Russell King - ARM Linux15c17232011-01-03 22:44:36 +00001685 if (!list_empty(&plchan->pend_list)) {
Linus Walleije8689e62010-09-28 15:57:37 +02001686 struct pl08x_txd *next;
1687
Russell King - ARM Linux15c17232011-01-03 22:44:36 +00001688 next = list_first_entry(&plchan->pend_list,
Linus Walleije8689e62010-09-28 15:57:37 +02001689 struct pl08x_txd,
1690 node);
1691 list_del(&next->node);
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +00001692
1693 pl08x_start_txd(plchan, next);
Russell King - ARM Linux8087aac2011-01-03 22:45:17 +00001694 } else if (plchan->phychan_hold) {
1695 /*
1696 * This channel is still in use - we have a new txd being
1697 * prepared and will soon be queued. Don't give up the
1698 * physical channel.
1699 */
Linus Walleije8689e62010-09-28 15:57:37 +02001700 } else {
1701 struct pl08x_dma_chan *waiting = NULL;
1702
1703 /*
1704 * No more jobs, so free up the physical channel
1705 * Free any allocated signal on slave transfers too
1706 */
Russell King - ARM Linux8c8cc2b2011-01-03 22:36:09 +00001707 release_phy_channel(plchan);
Linus Walleije8689e62010-09-28 15:57:37 +02001708 plchan->state = PL08X_CHAN_IDLE;
1709
1710 /*
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +00001711 * And NOW before anyone else can grab that free:d up
1712 * physical channel, see if there is some memcpy pending
1713 * that seriously needs to start because of being stacked
1714 * up while we were choking the physical channels with data.
Linus Walleije8689e62010-09-28 15:57:37 +02001715 */
1716 list_for_each_entry(waiting, &pl08x->memcpy.channels,
1717 chan.device_node) {
Viresh Kumar3e27ee82011-08-05 15:32:27 +05301718 if (waiting->state == PL08X_CHAN_WAITING &&
1719 waiting->waiting != NULL) {
Linus Walleije8689e62010-09-28 15:57:37 +02001720 int ret;
1721
1722 /* This should REALLY not fail now */
1723 ret = prep_phy_channel(waiting,
1724 waiting->waiting);
1725 BUG_ON(ret);
Russell King - ARM Linux8087aac2011-01-03 22:45:17 +00001726 waiting->phychan_hold--;
Linus Walleije8689e62010-09-28 15:57:37 +02001727 waiting->state = PL08X_CHAN_RUNNING;
1728 waiting->waiting = NULL;
1729 pl08x_issue_pending(&waiting->chan);
1730 break;
1731 }
1732 }
1733 }
1734
Russell King - ARM Linuxbf072af2011-01-03 22:31:24 +00001735 spin_unlock_irqrestore(&plchan->lock, flags);
Russell King - ARM Linux858c21c2011-01-03 22:41:34 +00001736
Russell Kinga936e792012-05-25 10:51:19 +01001737 while (!list_empty(&head)) {
1738 struct pl08x_txd *txd = list_first_entry(&head,
1739 struct pl08x_txd, node);
Russell King - ARM Linux3d992e12011-01-03 22:44:16 +00001740 dma_async_tx_callback callback = txd->tx.callback;
1741 void *callback_param = txd->tx.callback_param;
1742
Russell Kinga936e792012-05-25 10:51:19 +01001743 list_del(&txd->node);
1744
Russell King - ARM Linux3d992e12011-01-03 22:44:16 +00001745 /* Don't try to unmap buffers on slave channels */
1746 if (!plchan->slave)
1747 pl08x_unmap_buffers(txd);
1748
1749 /* Free the descriptor */
1750 spin_lock_irqsave(&plchan->lock, flags);
1751 pl08x_free_txd(pl08x, txd);
1752 spin_unlock_irqrestore(&plchan->lock, flags);
1753
1754 /* Callback to signal completion */
1755 if (callback)
1756 callback(callback_param);
1757 }
Linus Walleije8689e62010-09-28 15:57:37 +02001758}
1759
1760static irqreturn_t pl08x_irq(int irq, void *dev)
1761{
1762 struct pl08x_driver_data *pl08x = dev;
Viresh Kumar28da2832011-08-05 15:32:36 +05301763 u32 mask = 0, err, tc, i;
Linus Walleije8689e62010-09-28 15:57:37 +02001764
Viresh Kumar28da2832011-08-05 15:32:36 +05301765 /* check & clear - ERR & TC interrupts */
1766 err = readl(pl08x->base + PL080_ERR_STATUS);
1767 if (err) {
1768 dev_err(&pl08x->adev->dev, "%s error interrupt, register value 0x%08x\n",
1769 __func__, err);
1770 writel(err, pl08x->base + PL080_ERR_CLEAR);
Linus Walleije8689e62010-09-28 15:57:37 +02001771 }
Linus Walleijd29bf012012-04-09 22:53:21 +02001772 tc = readl(pl08x->base + PL080_TC_STATUS);
Viresh Kumar28da2832011-08-05 15:32:36 +05301773 if (tc)
1774 writel(tc, pl08x->base + PL080_TC_CLEAR);
1775
1776 if (!err && !tc)
1777 return IRQ_NONE;
1778
Linus Walleije8689e62010-09-28 15:57:37 +02001779 for (i = 0; i < pl08x->vd->channels; i++) {
Viresh Kumar28da2832011-08-05 15:32:36 +05301780 if (((1 << i) & err) || ((1 << i) & tc)) {
Linus Walleije8689e62010-09-28 15:57:37 +02001781 /* Locate physical channel */
1782 struct pl08x_phy_chan *phychan = &pl08x->phy_chans[i];
1783 struct pl08x_dma_chan *plchan = phychan->serving;
Russell Kinga936e792012-05-25 10:51:19 +01001784 struct pl08x_txd *tx;
Linus Walleije8689e62010-09-28 15:57:37 +02001785
Viresh Kumar28da2832011-08-05 15:32:36 +05301786 if (!plchan) {
1787 dev_err(&pl08x->adev->dev,
1788 "%s Error TC interrupt on unused channel: 0x%08x\n",
1789 __func__, i);
1790 continue;
1791 }
1792
Russell Kinga936e792012-05-25 10:51:19 +01001793 spin_lock(&plchan->lock);
1794 tx = plchan->at;
1795 if (tx) {
1796 plchan->at = NULL;
1797 dma_cookie_complete(&tx->tx);
1798 list_add_tail(&tx->node, &plchan->done_list);
1799 }
1800 spin_unlock(&plchan->lock);
1801
Linus Walleije8689e62010-09-28 15:57:37 +02001802 /* Schedule tasklet on this channel */
1803 tasklet_schedule(&plchan->tasklet);
Linus Walleije8689e62010-09-28 15:57:37 +02001804 mask |= (1 << i);
1805 }
1806 }
Linus Walleije8689e62010-09-28 15:57:37 +02001807
1808 return mask ? IRQ_HANDLED : IRQ_NONE;
1809}
1810
Russell King - ARM Linux121c8472011-07-21 17:13:48 +01001811static void pl08x_dma_slave_init(struct pl08x_dma_chan *chan)
1812{
Russell King - ARM Linux121c8472011-07-21 17:13:48 +01001813 chan->slave = true;
1814 chan->name = chan->cd->bus_id;
Russell Kinged91c132012-05-16 11:02:40 +01001815 chan->cfg.src_addr = chan->cd->addr;
1816 chan->cfg.dst_addr = chan->cd->addr;
Russell King - ARM Linux121c8472011-07-21 17:13:48 +01001817}
1818
Linus Walleije8689e62010-09-28 15:57:37 +02001819/*
1820 * Initialise the DMAC memcpy/slave channels.
1821 * Make a local wrapper to hold required data
1822 */
1823static int pl08x_dma_init_virtual_channels(struct pl08x_driver_data *pl08x,
Viresh Kumar3e27ee82011-08-05 15:32:27 +05301824 struct dma_device *dmadev, unsigned int channels, bool slave)
Linus Walleije8689e62010-09-28 15:57:37 +02001825{
1826 struct pl08x_dma_chan *chan;
1827 int i;
1828
1829 INIT_LIST_HEAD(&dmadev->channels);
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +00001830
Linus Walleije8689e62010-09-28 15:57:37 +02001831 /*
1832 * Register as many many memcpy as we have physical channels,
1833 * we won't always be able to use all but the code will have
1834 * to cope with that situation.
1835 */
1836 for (i = 0; i < channels; i++) {
Viresh Kumarb201c112011-08-05 15:32:29 +05301837 chan = kzalloc(sizeof(*chan), GFP_KERNEL);
Linus Walleije8689e62010-09-28 15:57:37 +02001838 if (!chan) {
1839 dev_err(&pl08x->adev->dev,
1840 "%s no memory for channel\n", __func__);
1841 return -ENOMEM;
1842 }
1843
1844 chan->host = pl08x;
1845 chan->state = PL08X_CHAN_IDLE;
Russell Kingad0de2a2012-05-25 11:15:15 +01001846 chan->signal = -1;
Linus Walleije8689e62010-09-28 15:57:37 +02001847
1848 if (slave) {
Linus Walleije8689e62010-09-28 15:57:37 +02001849 chan->cd = &pl08x->pd->slave_channels[i];
Russell King - ARM Linux121c8472011-07-21 17:13:48 +01001850 pl08x_dma_slave_init(chan);
Linus Walleije8689e62010-09-28 15:57:37 +02001851 } else {
1852 chan->cd = &pl08x->pd->memcpy_channel;
1853 chan->name = kasprintf(GFP_KERNEL, "memcpy%d", i);
1854 if (!chan->name) {
1855 kfree(chan);
1856 return -ENOMEM;
1857 }
1858 }
Viresh Kumar175a5e62011-08-05 15:32:32 +05301859 dev_dbg(&pl08x->adev->dev,
Linus Walleije8689e62010-09-28 15:57:37 +02001860 "initialize virtual channel \"%s\"\n",
1861 chan->name);
1862
1863 chan->chan.device = dmadev;
Russell King - ARM Linuxd3ee98cdc2012-03-06 22:35:47 +00001864 dma_cookie_init(&chan->chan);
Linus Walleije8689e62010-09-28 15:57:37 +02001865
1866 spin_lock_init(&chan->lock);
Russell King - ARM Linux15c17232011-01-03 22:44:36 +00001867 INIT_LIST_HEAD(&chan->pend_list);
Russell Kinga936e792012-05-25 10:51:19 +01001868 INIT_LIST_HEAD(&chan->done_list);
Linus Walleije8689e62010-09-28 15:57:37 +02001869 tasklet_init(&chan->tasklet, pl08x_tasklet,
1870 (unsigned long) chan);
1871
1872 list_add_tail(&chan->chan.device_node, &dmadev->channels);
1873 }
1874 dev_info(&pl08x->adev->dev, "initialized %d virtual %s channels\n",
1875 i, slave ? "slave" : "memcpy");
1876 return i;
1877}
1878
1879static void pl08x_free_virtual_channels(struct dma_device *dmadev)
1880{
1881 struct pl08x_dma_chan *chan = NULL;
1882 struct pl08x_dma_chan *next;
1883
1884 list_for_each_entry_safe(chan,
1885 next, &dmadev->channels, chan.device_node) {
1886 list_del(&chan->chan.device_node);
1887 kfree(chan);
1888 }
1889}
1890
1891#ifdef CONFIG_DEBUG_FS
1892static const char *pl08x_state_str(enum pl08x_dma_chan_state state)
1893{
1894 switch (state) {
1895 case PL08X_CHAN_IDLE:
1896 return "idle";
1897 case PL08X_CHAN_RUNNING:
1898 return "running";
1899 case PL08X_CHAN_PAUSED:
1900 return "paused";
1901 case PL08X_CHAN_WAITING:
1902 return "waiting";
1903 default:
1904 break;
1905 }
1906 return "UNKNOWN STATE";
1907}
1908
1909static int pl08x_debugfs_show(struct seq_file *s, void *data)
1910{
1911 struct pl08x_driver_data *pl08x = s->private;
1912 struct pl08x_dma_chan *chan;
1913 struct pl08x_phy_chan *ch;
1914 unsigned long flags;
1915 int i;
1916
1917 seq_printf(s, "PL08x physical channels:\n");
1918 seq_printf(s, "CHANNEL:\tUSER:\n");
1919 seq_printf(s, "--------\t-----\n");
1920 for (i = 0; i < pl08x->vd->channels; i++) {
1921 struct pl08x_dma_chan *virt_chan;
1922
1923 ch = &pl08x->phy_chans[i];
1924
1925 spin_lock_irqsave(&ch->lock, flags);
1926 virt_chan = ch->serving;
1927
Linus Walleijaffa1152012-04-12 09:01:49 +02001928 seq_printf(s, "%d\t\t%s%s\n",
1929 ch->id,
1930 virt_chan ? virt_chan->name : "(none)",
1931 ch->locked ? " LOCKED" : "");
Linus Walleije8689e62010-09-28 15:57:37 +02001932
1933 spin_unlock_irqrestore(&ch->lock, flags);
1934 }
1935
1936 seq_printf(s, "\nPL08x virtual memcpy channels:\n");
1937 seq_printf(s, "CHANNEL:\tSTATE:\n");
1938 seq_printf(s, "--------\t------\n");
1939 list_for_each_entry(chan, &pl08x->memcpy.channels, chan.device_node) {
Russell King - ARM Linux3e2a0372011-01-03 22:32:46 +00001940 seq_printf(s, "%s\t\t%s\n", chan->name,
Linus Walleije8689e62010-09-28 15:57:37 +02001941 pl08x_state_str(chan->state));
1942 }
1943
1944 seq_printf(s, "\nPL08x virtual slave channels:\n");
1945 seq_printf(s, "CHANNEL:\tSTATE:\n");
1946 seq_printf(s, "--------\t------\n");
1947 list_for_each_entry(chan, &pl08x->slave.channels, chan.device_node) {
Russell King - ARM Linux3e2a0372011-01-03 22:32:46 +00001948 seq_printf(s, "%s\t\t%s\n", chan->name,
Linus Walleije8689e62010-09-28 15:57:37 +02001949 pl08x_state_str(chan->state));
1950 }
1951
1952 return 0;
1953}
1954
1955static int pl08x_debugfs_open(struct inode *inode, struct file *file)
1956{
1957 return single_open(file, pl08x_debugfs_show, inode->i_private);
1958}
1959
1960static const struct file_operations pl08x_debugfs_operations = {
1961 .open = pl08x_debugfs_open,
1962 .read = seq_read,
1963 .llseek = seq_lseek,
1964 .release = single_release,
1965};
1966
1967static void init_pl08x_debugfs(struct pl08x_driver_data *pl08x)
1968{
1969 /* Expose a simple debugfs interface to view all clocks */
Viresh Kumar3e27ee82011-08-05 15:32:27 +05301970 (void) debugfs_create_file(dev_name(&pl08x->adev->dev),
1971 S_IFREG | S_IRUGO, NULL, pl08x,
1972 &pl08x_debugfs_operations);
Linus Walleije8689e62010-09-28 15:57:37 +02001973}
1974
1975#else
1976static inline void init_pl08x_debugfs(struct pl08x_driver_data *pl08x)
1977{
1978}
1979#endif
1980
Russell Kingaa25afa2011-02-19 15:55:00 +00001981static int pl08x_probe(struct amba_device *adev, const struct amba_id *id)
Linus Walleije8689e62010-09-28 15:57:37 +02001982{
1983 struct pl08x_driver_data *pl08x;
Russell King - ARM Linuxf96ca9ec2011-01-03 22:35:08 +00001984 const struct vendor_data *vd = id->data;
Linus Walleije8689e62010-09-28 15:57:37 +02001985 int ret = 0;
1986 int i;
1987
1988 ret = amba_request_regions(adev, NULL);
1989 if (ret)
1990 return ret;
1991
1992 /* Create the driver state holder */
Viresh Kumarb201c112011-08-05 15:32:29 +05301993 pl08x = kzalloc(sizeof(*pl08x), GFP_KERNEL);
Linus Walleije8689e62010-09-28 15:57:37 +02001994 if (!pl08x) {
1995 ret = -ENOMEM;
1996 goto out_no_pl08x;
1997 }
1998
1999 /* Initialize memcpy engine */
2000 dma_cap_set(DMA_MEMCPY, pl08x->memcpy.cap_mask);
2001 pl08x->memcpy.dev = &adev->dev;
2002 pl08x->memcpy.device_alloc_chan_resources = pl08x_alloc_chan_resources;
2003 pl08x->memcpy.device_free_chan_resources = pl08x_free_chan_resources;
2004 pl08x->memcpy.device_prep_dma_memcpy = pl08x_prep_dma_memcpy;
2005 pl08x->memcpy.device_prep_dma_interrupt = pl08x_prep_dma_interrupt;
2006 pl08x->memcpy.device_tx_status = pl08x_dma_tx_status;
2007 pl08x->memcpy.device_issue_pending = pl08x_issue_pending;
2008 pl08x->memcpy.device_control = pl08x_control;
2009
2010 /* Initialize slave engine */
2011 dma_cap_set(DMA_SLAVE, pl08x->slave.cap_mask);
2012 pl08x->slave.dev = &adev->dev;
2013 pl08x->slave.device_alloc_chan_resources = pl08x_alloc_chan_resources;
2014 pl08x->slave.device_free_chan_resources = pl08x_free_chan_resources;
2015 pl08x->slave.device_prep_dma_interrupt = pl08x_prep_dma_interrupt;
2016 pl08x->slave.device_tx_status = pl08x_dma_tx_status;
2017 pl08x->slave.device_issue_pending = pl08x_issue_pending;
2018 pl08x->slave.device_prep_slave_sg = pl08x_prep_slave_sg;
2019 pl08x->slave.device_control = pl08x_control;
2020
2021 /* Get the platform data */
2022 pl08x->pd = dev_get_platdata(&adev->dev);
2023 if (!pl08x->pd) {
2024 dev_err(&adev->dev, "no platform data supplied\n");
2025 goto out_no_platdata;
2026 }
2027
2028 /* Assign useful pointers to the driver state */
2029 pl08x->adev = adev;
2030 pl08x->vd = vd;
2031
Russell King - ARM Linux30749cb2011-01-03 22:41:13 +00002032 /* By default, AHB1 only. If dualmaster, from platform */
2033 pl08x->lli_buses = PL08X_AHB1;
2034 pl08x->mem_buses = PL08X_AHB1;
2035 if (pl08x->vd->dualmaster) {
2036 pl08x->lli_buses = pl08x->pd->lli_buses;
2037 pl08x->mem_buses = pl08x->pd->mem_buses;
2038 }
2039
Linus Walleije8689e62010-09-28 15:57:37 +02002040 /* A DMA memory pool for LLIs, align on 1-byte boundary */
2041 pl08x->pool = dma_pool_create(DRIVER_NAME, &pl08x->adev->dev,
2042 PL08X_LLI_TSFR_SIZE, PL08X_ALIGN, 0);
2043 if (!pl08x->pool) {
2044 ret = -ENOMEM;
2045 goto out_no_lli_pool;
2046 }
2047
Linus Walleije8689e62010-09-28 15:57:37 +02002048 pl08x->base = ioremap(adev->res.start, resource_size(&adev->res));
2049 if (!pl08x->base) {
2050 ret = -ENOMEM;
2051 goto out_no_ioremap;
2052 }
2053
2054 /* Turn on the PL08x */
2055 pl08x_ensure_on(pl08x);
2056
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +00002057 /* Attach the interrupt handler */
Linus Walleije8689e62010-09-28 15:57:37 +02002058 writel(0x000000FF, pl08x->base + PL080_ERR_CLEAR);
2059 writel(0x000000FF, pl08x->base + PL080_TC_CLEAR);
2060
2061 ret = request_irq(adev->irq[0], pl08x_irq, IRQF_DISABLED,
Russell King - ARM Linuxb05cd8f2011-01-03 22:33:26 +00002062 DRIVER_NAME, pl08x);
Linus Walleije8689e62010-09-28 15:57:37 +02002063 if (ret) {
2064 dev_err(&adev->dev, "%s failed to request interrupt %d\n",
2065 __func__, adev->irq[0]);
2066 goto out_no_irq;
2067 }
2068
2069 /* Initialize physical channels */
Linus Walleijaffa1152012-04-12 09:01:49 +02002070 pl08x->phy_chans = kzalloc((vd->channels * sizeof(*pl08x->phy_chans)),
Linus Walleije8689e62010-09-28 15:57:37 +02002071 GFP_KERNEL);
2072 if (!pl08x->phy_chans) {
2073 dev_err(&adev->dev, "%s failed to allocate "
2074 "physical channel holders\n",
2075 __func__);
2076 goto out_no_phychans;
2077 }
2078
2079 for (i = 0; i < vd->channels; i++) {
2080 struct pl08x_phy_chan *ch = &pl08x->phy_chans[i];
2081
2082 ch->id = i;
2083 ch->base = pl08x->base + PL080_Cx_BASE(i);
2084 spin_lock_init(&ch->lock);
Linus Walleijaffa1152012-04-12 09:01:49 +02002085
2086 /*
2087 * Nomadik variants can have channels that are locked
2088 * down for the secure world only. Lock up these channels
2089 * by perpetually serving a dummy virtual channel.
2090 */
2091 if (vd->nomadik) {
2092 u32 val;
2093
2094 val = readl(ch->base + PL080_CH_CONFIG);
2095 if (val & (PL080N_CONFIG_ITPROT | PL080N_CONFIG_SECPROT)) {
2096 dev_info(&adev->dev, "physical channel %d reserved for secure access only\n", i);
2097 ch->locked = true;
2098 }
2099 }
2100
Viresh Kumar175a5e62011-08-05 15:32:32 +05302101 dev_dbg(&adev->dev, "physical channel %d is %s\n",
2102 i, pl08x_phy_channel_busy(ch) ? "BUSY" : "FREE");
Linus Walleije8689e62010-09-28 15:57:37 +02002103 }
2104
2105 /* Register as many memcpy channels as there are physical channels */
2106 ret = pl08x_dma_init_virtual_channels(pl08x, &pl08x->memcpy,
2107 pl08x->vd->channels, false);
2108 if (ret <= 0) {
2109 dev_warn(&pl08x->adev->dev,
2110 "%s failed to enumerate memcpy channels - %d\n",
2111 __func__, ret);
2112 goto out_no_memcpy;
2113 }
2114 pl08x->memcpy.chancnt = ret;
2115
2116 /* Register slave channels */
2117 ret = pl08x_dma_init_virtual_channels(pl08x, &pl08x->slave,
Viresh Kumar3e27ee82011-08-05 15:32:27 +05302118 pl08x->pd->num_slave_channels, true);
Linus Walleije8689e62010-09-28 15:57:37 +02002119 if (ret <= 0) {
2120 dev_warn(&pl08x->adev->dev,
2121 "%s failed to enumerate slave channels - %d\n",
2122 __func__, ret);
2123 goto out_no_slave;
2124 }
2125 pl08x->slave.chancnt = ret;
2126
2127 ret = dma_async_device_register(&pl08x->memcpy);
2128 if (ret) {
2129 dev_warn(&pl08x->adev->dev,
2130 "%s failed to register memcpy as an async device - %d\n",
2131 __func__, ret);
2132 goto out_no_memcpy_reg;
2133 }
2134
2135 ret = dma_async_device_register(&pl08x->slave);
2136 if (ret) {
2137 dev_warn(&pl08x->adev->dev,
2138 "%s failed to register slave as an async device - %d\n",
2139 __func__, ret);
2140 goto out_no_slave_reg;
2141 }
2142
2143 amba_set_drvdata(adev, pl08x);
2144 init_pl08x_debugfs(pl08x);
Russell King - ARM Linuxb05cd8f2011-01-03 22:33:26 +00002145 dev_info(&pl08x->adev->dev, "DMA: PL%03x rev%u at 0x%08llx irq %d\n",
2146 amba_part(adev), amba_rev(adev),
2147 (unsigned long long)adev->res.start, adev->irq[0]);
Viresh Kumarb7b60182011-08-05 15:32:33 +05302148
Linus Walleije8689e62010-09-28 15:57:37 +02002149 return 0;
2150
2151out_no_slave_reg:
2152 dma_async_device_unregister(&pl08x->memcpy);
2153out_no_memcpy_reg:
2154 pl08x_free_virtual_channels(&pl08x->slave);
2155out_no_slave:
2156 pl08x_free_virtual_channels(&pl08x->memcpy);
2157out_no_memcpy:
2158 kfree(pl08x->phy_chans);
2159out_no_phychans:
2160 free_irq(adev->irq[0], pl08x);
2161out_no_irq:
2162 iounmap(pl08x->base);
2163out_no_ioremap:
2164 dma_pool_destroy(pl08x->pool);
2165out_no_lli_pool:
2166out_no_platdata:
2167 kfree(pl08x);
2168out_no_pl08x:
2169 amba_release_regions(adev);
2170 return ret;
2171}
2172
2173/* PL080 has 8 channels and the PL080 have just 2 */
2174static struct vendor_data vendor_pl080 = {
Linus Walleije8689e62010-09-28 15:57:37 +02002175 .channels = 8,
2176 .dualmaster = true,
2177};
2178
Linus Walleijaffa1152012-04-12 09:01:49 +02002179static struct vendor_data vendor_nomadik = {
2180 .channels = 8,
2181 .dualmaster = true,
2182 .nomadik = true,
2183};
2184
Linus Walleije8689e62010-09-28 15:57:37 +02002185static struct vendor_data vendor_pl081 = {
Linus Walleije8689e62010-09-28 15:57:37 +02002186 .channels = 2,
2187 .dualmaster = false,
2188};
2189
2190static struct amba_id pl08x_ids[] = {
2191 /* PL080 */
2192 {
2193 .id = 0x00041080,
2194 .mask = 0x000fffff,
2195 .data = &vendor_pl080,
2196 },
2197 /* PL081 */
2198 {
2199 .id = 0x00041081,
2200 .mask = 0x000fffff,
2201 .data = &vendor_pl081,
2202 },
2203 /* Nomadik 8815 PL080 variant */
2204 {
Linus Walleijaffa1152012-04-12 09:01:49 +02002205 .id = 0x00280080,
Linus Walleije8689e62010-09-28 15:57:37 +02002206 .mask = 0x00ffffff,
Linus Walleijaffa1152012-04-12 09:01:49 +02002207 .data = &vendor_nomadik,
Linus Walleije8689e62010-09-28 15:57:37 +02002208 },
2209 { 0, 0 },
2210};
2211
Dave Martin037566d2011-10-05 15:15:20 +01002212MODULE_DEVICE_TABLE(amba, pl08x_ids);
2213
Linus Walleije8689e62010-09-28 15:57:37 +02002214static struct amba_driver pl08x_amba_driver = {
2215 .drv.name = DRIVER_NAME,
2216 .id_table = pl08x_ids,
2217 .probe = pl08x_probe,
2218};
2219
2220static int __init pl08x_init(void)
2221{
2222 int retval;
2223 retval = amba_driver_register(&pl08x_amba_driver);
2224 if (retval)
2225 printk(KERN_WARNING DRIVER_NAME
Russell King - ARM Linuxe8b5e112011-01-03 22:30:24 +00002226 "failed to register as an AMBA device (%d)\n",
Linus Walleije8689e62010-09-28 15:57:37 +02002227 retval);
2228 return retval;
2229}
2230subsys_initcall(pl08x_init);