blob: ac9fdccb2c19d064ba0902ffc6f41021c436c680 [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
222 * @at: active transaction on this channel
223 * @lock: a lock for this channel data
224 * @host: a pointer to the host (internal use)
225 * @state: whether the channel is idle, paused, running etc
226 * @slave: whether this channel is a device (slave) or for memcpy
Russell Kingb23f2042012-05-16 10:48:44 +0100227 * @waiting: a TX descriptor on this channel which is waiting for a physical
228 * channel to become available
Russell Kingad0de2a2012-05-25 11:15:15 +0100229 * @signal: the physical DMA request signal which this channel is using
Russell King5e2479b2012-05-25 11:32:45 +0100230 * @mux_use: count of descriptors using this DMA request signal setting
Russell Kingb23f2042012-05-16 10:48:44 +0100231 */
232struct pl08x_dma_chan {
233 struct dma_chan chan;
234 struct pl08x_phy_chan *phychan;
235 int phychan_hold;
236 struct tasklet_struct tasklet;
Russell King550ec362012-05-28 10:18:55 +0100237 const char *name;
Russell Kingb23f2042012-05-16 10:48:44 +0100238 const struct pl08x_channel_data *cd;
Russell Kinged91c132012-05-16 11:02:40 +0100239 struct dma_slave_config cfg;
Russell Kingb23f2042012-05-16 10:48:44 +0100240 struct list_head pend_list;
241 struct pl08x_txd *at;
242 spinlock_t lock;
243 struct pl08x_driver_data *host;
244 enum pl08x_dma_chan_state state;
245 bool slave;
Russell Kingb23f2042012-05-16 10:48:44 +0100246 struct pl08x_txd *waiting;
Russell Kingad0de2a2012-05-25 11:15:15 +0100247 int signal;
Russell King5e2479b2012-05-25 11:32:45 +0100248 unsigned mux_use;
Russell Kingb23f2042012-05-16 10:48:44 +0100249};
250
251/**
Linus Walleije8689e62010-09-28 15:57:37 +0200252 * struct pl08x_driver_data - the local state holder for the PL08x
253 * @slave: slave engine for this instance
254 * @memcpy: memcpy engine for this instance
255 * @base: virtual memory base (remapped) for the PL08x
256 * @adev: the corresponding AMBA (PrimeCell) bus entry
257 * @vd: vendor data for this PL08x variant
258 * @pd: platform data passed in from the platform/machine
259 * @phy_chans: array of data for the physical channels
260 * @pool: a pool for the LLI descriptors
261 * @pool_ctr: counter of LLIs in the pool
Viresh Kumar3e27ee82011-08-05 15:32:27 +0530262 * @lli_buses: bitmask to or in to LLI pointer selecting AHB port for LLI
263 * fetches
Russell King - ARM Linux30749cb2011-01-03 22:41:13 +0000264 * @mem_buses: set to indicate memory transfers on AHB2.
Linus Walleije8689e62010-09-28 15:57:37 +0200265 * @lock: a spinlock for this struct
266 */
267struct pl08x_driver_data {
268 struct dma_device slave;
269 struct dma_device memcpy;
270 void __iomem *base;
271 struct amba_device *adev;
Russell King - ARM Linuxf96ca9ec2011-01-03 22:35:08 +0000272 const struct vendor_data *vd;
Linus Walleije8689e62010-09-28 15:57:37 +0200273 struct pl08x_platform_data *pd;
274 struct pl08x_phy_chan *phy_chans;
275 struct dma_pool *pool;
276 int pool_ctr;
Russell King - ARM Linux30749cb2011-01-03 22:41:13 +0000277 u8 lli_buses;
278 u8 mem_buses;
Linus Walleije8689e62010-09-28 15:57:37 +0200279};
280
281/*
282 * PL08X specific defines
283 */
284
Linus Walleije8689e62010-09-28 15:57:37 +0200285/* Size (bytes) of each LLI buffer allocated for one transfer */
286# define PL08X_LLI_TSFR_SIZE 0x2000
287
Russell King - ARM Linuxe8b5e112011-01-03 22:30:24 +0000288/* Maximum times we call dma_pool_alloc on this pool without freeing */
Russell King - ARM Linux7cb72ad2011-01-03 22:35:28 +0000289#define MAX_NUM_TSFR_LLIS (PL08X_LLI_TSFR_SIZE/sizeof(struct pl08x_lli))
Linus Walleije8689e62010-09-28 15:57:37 +0200290#define PL08X_ALIGN 8
291
292static inline struct pl08x_dma_chan *to_pl08x_chan(struct dma_chan *chan)
293{
294 return container_of(chan, struct pl08x_dma_chan, chan);
295}
296
Russell King - ARM Linux501e67e2011-01-03 22:44:57 +0000297static inline struct pl08x_txd *to_pl08x_txd(struct dma_async_tx_descriptor *tx)
298{
299 return container_of(tx, struct pl08x_txd, tx);
300}
301
Linus Walleije8689e62010-09-28 15:57:37 +0200302/*
Russell King6b16c8b2012-05-25 11:10:58 +0100303 * Mux handling.
304 *
305 * This gives us the DMA request input to the PL08x primecell which the
306 * peripheral described by the channel data will be routed to, possibly
307 * via a board/SoC specific external MUX. One important point to note
308 * here is that this does not depend on the physical channel.
309 */
Russell Kingad0de2a2012-05-25 11:15:15 +0100310static int pl08x_request_mux(struct pl08x_dma_chan *plchan)
Russell King6b16c8b2012-05-25 11:10:58 +0100311{
312 const struct pl08x_platform_data *pd = plchan->host->pd;
313 int ret;
314
Russell King5e2479b2012-05-25 11:32:45 +0100315 if (plchan->mux_use++ == 0 && pd->get_signal) {
Russell King6b16c8b2012-05-25 11:10:58 +0100316 ret = pd->get_signal(plchan->cd);
Russell King5e2479b2012-05-25 11:32:45 +0100317 if (ret < 0) {
318 plchan->mux_use = 0;
Russell King6b16c8b2012-05-25 11:10:58 +0100319 return ret;
Russell King5e2479b2012-05-25 11:32:45 +0100320 }
Russell King6b16c8b2012-05-25 11:10:58 +0100321
Russell Kingad0de2a2012-05-25 11:15:15 +0100322 plchan->signal = ret;
Russell King6b16c8b2012-05-25 11:10:58 +0100323 }
324 return 0;
325}
326
327static void pl08x_release_mux(struct pl08x_dma_chan *plchan)
328{
329 const struct pl08x_platform_data *pd = plchan->host->pd;
330
Russell King5e2479b2012-05-25 11:32:45 +0100331 if (plchan->signal >= 0) {
332 WARN_ON(plchan->mux_use == 0);
333
334 if (--plchan->mux_use == 0 && pd->put_signal) {
335 pd->put_signal(plchan->cd, plchan->signal);
336 plchan->signal = -1;
337 }
Russell King6b16c8b2012-05-25 11:10:58 +0100338 }
339}
340
341/*
Linus Walleije8689e62010-09-28 15:57:37 +0200342 * Physical channel handling
343 */
344
345/* Whether a certain channel is busy or not */
346static int pl08x_phy_channel_busy(struct pl08x_phy_chan *ch)
347{
348 unsigned int val;
349
350 val = readl(ch->base + PL080_CH_CONFIG);
351 return val & PL080_CONFIG_ACTIVE;
352}
353
354/*
355 * Set the initial DMA register values i.e. those for the first LLI
Russell King - ARM Linuxe8b5e112011-01-03 22:30:24 +0000356 * The next LLI pointer and the configuration interrupt bit have
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +0000357 * been set when the LLIs were constructed. Poke them into the hardware
358 * and start the transfer.
Linus Walleije8689e62010-09-28 15:57:37 +0200359 */
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +0000360static void pl08x_start_txd(struct pl08x_dma_chan *plchan,
361 struct pl08x_txd *txd)
Linus Walleije8689e62010-09-28 15:57:37 +0200362{
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +0000363 struct pl08x_driver_data *pl08x = plchan->host;
Linus Walleije8689e62010-09-28 15:57:37 +0200364 struct pl08x_phy_chan *phychan = plchan->phychan;
Russell King - ARM Linux19524d72011-01-03 22:39:13 +0000365 struct pl08x_lli *lli = &txd->llis_va[0];
Russell King - ARM Linux09b3c322011-01-03 22:39:53 +0000366 u32 val;
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +0000367
368 plchan->at = txd;
Linus Walleije8689e62010-09-28 15:57:37 +0200369
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +0000370 /* Wait for channel inactive */
371 while (pl08x_phy_channel_busy(phychan))
Russell King - ARM Linux19386b322011-01-03 22:36:29 +0000372 cpu_relax();
Linus Walleije8689e62010-09-28 15:57:37 +0200373
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +0000374 dev_vdbg(&pl08x->adev->dev,
375 "WRITE channel %d: csrc=0x%08x, cdst=0x%08x, "
Russell King - ARM Linux19524d72011-01-03 22:39:13 +0000376 "clli=0x%08x, cctl=0x%08x, ccfg=0x%08x\n",
377 phychan->id, lli->src, lli->dst, lli->lli, lli->cctl,
Russell King - ARM Linux09b3c322011-01-03 22:39:53 +0000378 txd->ccfg);
Linus Walleije8689e62010-09-28 15:57:37 +0200379
Russell King - ARM Linux19524d72011-01-03 22:39:13 +0000380 writel(lli->src, phychan->base + PL080_CH_SRC_ADDR);
381 writel(lli->dst, phychan->base + PL080_CH_DST_ADDR);
382 writel(lli->lli, phychan->base + PL080_CH_LLI);
383 writel(lli->cctl, phychan->base + PL080_CH_CONTROL);
Russell King - ARM Linux09b3c322011-01-03 22:39:53 +0000384 writel(txd->ccfg, phychan->base + PL080_CH_CONFIG);
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +0000385
386 /* Enable the DMA channel */
387 /* Do not access config register until channel shows as disabled */
388 while (readl(pl08x->base + PL080_EN_CHAN) & (1 << phychan->id))
389 cpu_relax();
390
391 /* Do not access config register until channel shows as inactive */
392 val = readl(phychan->base + PL080_CH_CONFIG);
393 while ((val & PL080_CONFIG_ACTIVE) || (val & PL080_CONFIG_ENABLE))
394 val = readl(phychan->base + PL080_CH_CONFIG);
395
396 writel(val | PL080_CONFIG_ENABLE, phychan->base + PL080_CH_CONFIG);
Linus Walleije8689e62010-09-28 15:57:37 +0200397}
398
399/*
Russell King - ARM Linux81796612011-01-27 12:37:44 +0000400 * Pause the channel by setting the HALT bit.
Linus Walleije8689e62010-09-28 15:57:37 +0200401 *
Russell King - ARM Linux81796612011-01-27 12:37:44 +0000402 * For M->P transfers, pause the DMAC first and then stop the peripheral -
403 * the FIFO can only drain if the peripheral is still requesting data.
404 * (note: this can still timeout if the DMAC FIFO never drains of data.)
Linus Walleije8689e62010-09-28 15:57:37 +0200405 *
Russell King - ARM Linux81796612011-01-27 12:37:44 +0000406 * For P->M transfers, disable the peripheral first to stop it filling
407 * the DMAC FIFO, and then pause the DMAC.
Linus Walleije8689e62010-09-28 15:57:37 +0200408 */
409static void pl08x_pause_phy_chan(struct pl08x_phy_chan *ch)
410{
411 u32 val;
Russell King - ARM Linux81796612011-01-27 12:37:44 +0000412 int timeout;
Linus Walleije8689e62010-09-28 15:57:37 +0200413
414 /* Set the HALT bit and wait for the FIFO to drain */
415 val = readl(ch->base + PL080_CH_CONFIG);
416 val |= PL080_CONFIG_HALT;
417 writel(val, ch->base + PL080_CH_CONFIG);
418
419 /* Wait for channel inactive */
Russell King - ARM Linux81796612011-01-27 12:37:44 +0000420 for (timeout = 1000; timeout; timeout--) {
421 if (!pl08x_phy_channel_busy(ch))
422 break;
423 udelay(1);
424 }
425 if (pl08x_phy_channel_busy(ch))
426 pr_err("pl08x: channel%u timeout waiting for pause\n", ch->id);
Linus Walleije8689e62010-09-28 15:57:37 +0200427}
428
429static void pl08x_resume_phy_chan(struct pl08x_phy_chan *ch)
430{
431 u32 val;
432
433 /* Clear the HALT bit */
434 val = readl(ch->base + PL080_CH_CONFIG);
435 val &= ~PL080_CONFIG_HALT;
436 writel(val, ch->base + PL080_CH_CONFIG);
437}
438
Russell King - ARM Linuxfb526212011-01-27 12:32:53 +0000439/*
440 * pl08x_terminate_phy_chan() stops the channel, clears the FIFO and
441 * clears any pending interrupt status. This should not be used for
442 * an on-going transfer, but as a method of shutting down a channel
443 * (eg, when it's no longer used) or terminating a transfer.
444 */
445static void pl08x_terminate_phy_chan(struct pl08x_driver_data *pl08x,
446 struct pl08x_phy_chan *ch)
Linus Walleije8689e62010-09-28 15:57:37 +0200447{
Russell King - ARM Linuxfb526212011-01-27 12:32:53 +0000448 u32 val = readl(ch->base + PL080_CH_CONFIG);
Linus Walleije8689e62010-09-28 15:57:37 +0200449
Russell King - ARM Linuxfb526212011-01-27 12:32:53 +0000450 val &= ~(PL080_CONFIG_ENABLE | PL080_CONFIG_ERR_IRQ_MASK |
451 PL080_CONFIG_TC_IRQ_MASK);
Linus Walleije8689e62010-09-28 15:57:37 +0200452
Linus Walleije8689e62010-09-28 15:57:37 +0200453 writel(val, ch->base + PL080_CH_CONFIG);
Russell King - ARM Linuxfb526212011-01-27 12:32:53 +0000454
455 writel(1 << ch->id, pl08x->base + PL080_ERR_CLEAR);
456 writel(1 << ch->id, pl08x->base + PL080_TC_CLEAR);
Linus Walleije8689e62010-09-28 15:57:37 +0200457}
458
459static inline u32 get_bytes_in_cctl(u32 cctl)
460{
461 /* The source width defines the number of bytes */
462 u32 bytes = cctl & PL080_CONTROL_TRANSFER_SIZE_MASK;
463
464 switch (cctl >> PL080_CONTROL_SWIDTH_SHIFT) {
465 case PL080_WIDTH_8BIT:
466 break;
467 case PL080_WIDTH_16BIT:
468 bytes *= 2;
469 break;
470 case PL080_WIDTH_32BIT:
471 bytes *= 4;
472 break;
473 }
474 return bytes;
475}
476
477/* The channel should be paused when calling this */
478static u32 pl08x_getbytes_chan(struct pl08x_dma_chan *plchan)
479{
480 struct pl08x_phy_chan *ch;
Linus Walleije8689e62010-09-28 15:57:37 +0200481 struct pl08x_txd *txd;
482 unsigned long flags;
Russell King - ARM Linuxcace6582011-01-03 22:37:31 +0000483 size_t bytes = 0;
Linus Walleije8689e62010-09-28 15:57:37 +0200484
485 spin_lock_irqsave(&plchan->lock, flags);
Linus Walleije8689e62010-09-28 15:57:37 +0200486 ch = plchan->phychan;
487 txd = plchan->at;
488
489 /*
Russell King - ARM Linuxdb9f1362011-01-03 22:38:32 +0000490 * Follow the LLIs to get the number of remaining
491 * bytes in the currently active transaction.
Linus Walleije8689e62010-09-28 15:57:37 +0200492 */
493 if (ch && txd) {
Russell King - ARM Linux4c0df6a2011-01-03 22:36:50 +0000494 u32 clli = readl(ch->base + PL080_CH_LLI) & ~PL080_LLI_LM_AHB2;
Linus Walleije8689e62010-09-28 15:57:37 +0200495
Russell King - ARM Linuxdb9f1362011-01-03 22:38:32 +0000496 /* First get the remaining bytes in the active transfer */
Linus Walleije8689e62010-09-28 15:57:37 +0200497 bytes = get_bytes_in_cctl(readl(ch->base + PL080_CH_CONTROL));
498
499 if (clli) {
Russell King - ARM Linuxdb9f1362011-01-03 22:38:32 +0000500 struct pl08x_lli *llis_va = txd->llis_va;
501 dma_addr_t llis_bus = txd->llis_bus;
502 int index;
Linus Walleije8689e62010-09-28 15:57:37 +0200503
Russell King - ARM Linuxdb9f1362011-01-03 22:38:32 +0000504 BUG_ON(clli < llis_bus || clli >= llis_bus +
505 sizeof(struct pl08x_lli) * MAX_NUM_TSFR_LLIS);
Linus Walleije8689e62010-09-28 15:57:37 +0200506
Russell King - ARM Linuxdb9f1362011-01-03 22:38:32 +0000507 /*
508 * Locate the next LLI - as this is an array,
509 * it's simple maths to find.
510 */
511 index = (clli - llis_bus) / sizeof(struct pl08x_lli);
512
513 for (; index < MAX_NUM_TSFR_LLIS; index++) {
514 bytes += get_bytes_in_cctl(llis_va[index].cctl);
515
Linus Walleije8689e62010-09-28 15:57:37 +0200516 /*
Russell King - ARM Linuxe8b5e112011-01-03 22:30:24 +0000517 * A LLI pointer of 0 terminates the LLI list
Linus Walleije8689e62010-09-28 15:57:37 +0200518 */
Russell King - ARM Linuxdb9f1362011-01-03 22:38:32 +0000519 if (!llis_va[index].lli)
520 break;
Linus Walleije8689e62010-09-28 15:57:37 +0200521 }
522 }
523 }
524
525 /* Sum up all queued transactions */
Russell King - ARM Linux15c17232011-01-03 22:44:36 +0000526 if (!list_empty(&plchan->pend_list)) {
Russell King - ARM Linuxdb9f1362011-01-03 22:38:32 +0000527 struct pl08x_txd *txdi;
Russell King - ARM Linux15c17232011-01-03 22:44:36 +0000528 list_for_each_entry(txdi, &plchan->pend_list, node) {
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530529 struct pl08x_sg *dsg;
530 list_for_each_entry(dsg, &txd->dsg_list, node)
531 bytes += dsg->len;
Linus Walleije8689e62010-09-28 15:57:37 +0200532 }
Linus Walleije8689e62010-09-28 15:57:37 +0200533 }
534
535 spin_unlock_irqrestore(&plchan->lock, flags);
536
537 return bytes;
538}
539
540/*
541 * Allocate a physical channel for a virtual channel
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +0000542 *
543 * Try to locate a physical channel to be used for this transfer. If all
544 * are taken return NULL and the requester will have to cope by using
545 * some fallback PIO mode or retrying later.
Linus Walleije8689e62010-09-28 15:57:37 +0200546 */
547static struct pl08x_phy_chan *
548pl08x_get_phy_channel(struct pl08x_driver_data *pl08x,
549 struct pl08x_dma_chan *virt_chan)
550{
551 struct pl08x_phy_chan *ch = NULL;
552 unsigned long flags;
553 int i;
554
Linus Walleije8689e62010-09-28 15:57:37 +0200555 for (i = 0; i < pl08x->vd->channels; i++) {
556 ch = &pl08x->phy_chans[i];
557
558 spin_lock_irqsave(&ch->lock, flags);
559
Linus Walleijaffa1152012-04-12 09:01:49 +0200560 if (!ch->locked && !ch->serving) {
Linus Walleije8689e62010-09-28 15:57:37 +0200561 ch->serving = virt_chan;
Linus Walleije8689e62010-09-28 15:57:37 +0200562 spin_unlock_irqrestore(&ch->lock, flags);
563 break;
564 }
565
566 spin_unlock_irqrestore(&ch->lock, flags);
567 }
568
569 if (i == pl08x->vd->channels) {
570 /* No physical channel available, cope with it */
571 return NULL;
572 }
573
574 return ch;
575}
576
577static inline void pl08x_put_phy_channel(struct pl08x_driver_data *pl08x,
578 struct pl08x_phy_chan *ch)
579{
580 unsigned long flags;
581
Russell King - ARM Linuxfb526212011-01-27 12:32:53 +0000582 spin_lock_irqsave(&ch->lock, flags);
583
Linus Walleije8689e62010-09-28 15:57:37 +0200584 /* Stop the channel and clear its interrupts */
Russell King - ARM Linuxfb526212011-01-27 12:32:53 +0000585 pl08x_terminate_phy_chan(pl08x, ch);
Linus Walleije8689e62010-09-28 15:57:37 +0200586
587 /* Mark it as free */
Linus Walleije8689e62010-09-28 15:57:37 +0200588 ch->serving = NULL;
589 spin_unlock_irqrestore(&ch->lock, flags);
590}
591
592/*
593 * LLI handling
594 */
595
596static inline unsigned int pl08x_get_bytes_for_cctl(unsigned int coded)
597{
598 switch (coded) {
599 case PL080_WIDTH_8BIT:
600 return 1;
601 case PL080_WIDTH_16BIT:
602 return 2;
603 case PL080_WIDTH_32BIT:
604 return 4;
605 default:
606 break;
607 }
608 BUG();
609 return 0;
610}
611
612static inline u32 pl08x_cctl_bits(u32 cctl, u8 srcwidth, u8 dstwidth,
Russell King - ARM Linuxcace6582011-01-03 22:37:31 +0000613 size_t tsize)
Linus Walleije8689e62010-09-28 15:57:37 +0200614{
615 u32 retbits = cctl;
616
Russell King - ARM Linuxe8b5e112011-01-03 22:30:24 +0000617 /* Remove all src, dst and transfer size bits */
Linus Walleije8689e62010-09-28 15:57:37 +0200618 retbits &= ~PL080_CONTROL_DWIDTH_MASK;
619 retbits &= ~PL080_CONTROL_SWIDTH_MASK;
620 retbits &= ~PL080_CONTROL_TRANSFER_SIZE_MASK;
621
622 /* Then set the bits according to the parameters */
623 switch (srcwidth) {
624 case 1:
625 retbits |= PL080_WIDTH_8BIT << PL080_CONTROL_SWIDTH_SHIFT;
626 break;
627 case 2:
628 retbits |= PL080_WIDTH_16BIT << PL080_CONTROL_SWIDTH_SHIFT;
629 break;
630 case 4:
631 retbits |= PL080_WIDTH_32BIT << PL080_CONTROL_SWIDTH_SHIFT;
632 break;
633 default:
634 BUG();
635 break;
636 }
637
638 switch (dstwidth) {
639 case 1:
640 retbits |= PL080_WIDTH_8BIT << PL080_CONTROL_DWIDTH_SHIFT;
641 break;
642 case 2:
643 retbits |= PL080_WIDTH_16BIT << PL080_CONTROL_DWIDTH_SHIFT;
644 break;
645 case 4:
646 retbits |= PL080_WIDTH_32BIT << PL080_CONTROL_DWIDTH_SHIFT;
647 break;
648 default:
649 BUG();
650 break;
651 }
652
653 retbits |= tsize << PL080_CONTROL_TRANSFER_SIZE_SHIFT;
654 return retbits;
655}
656
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000657struct pl08x_lli_build_data {
658 struct pl08x_txd *txd;
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000659 struct pl08x_bus_data srcbus;
660 struct pl08x_bus_data dstbus;
661 size_t remainder;
Russell King - ARM Linux25c94f72011-07-21 17:11:46 +0100662 u32 lli_bus;
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000663};
664
Linus Walleije8689e62010-09-28 15:57:37 +0200665/*
Viresh Kumar0532e6f2011-08-05 15:32:31 +0530666 * Autoselect a master bus to use for the transfer. Slave will be the chosen as
667 * victim in case src & dest are not similarly aligned. i.e. If after aligning
668 * masters address with width requirements of transfer (by sending few byte by
669 * byte data), slave is still not aligned, then its width will be reduced to
670 * BYTE.
671 * - prefers the destination bus if both available
Viresh Kumar036f05f2011-08-05 15:32:41 +0530672 * - prefers bus with fixed address (i.e. peripheral)
Linus Walleije8689e62010-09-28 15:57:37 +0200673 */
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000674static void pl08x_choose_master_bus(struct pl08x_lli_build_data *bd,
675 struct pl08x_bus_data **mbus, struct pl08x_bus_data **sbus, u32 cctl)
Linus Walleije8689e62010-09-28 15:57:37 +0200676{
677 if (!(cctl & PL080_CONTROL_DST_INCR)) {
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000678 *mbus = &bd->dstbus;
679 *sbus = &bd->srcbus;
Viresh Kumar036f05f2011-08-05 15:32:41 +0530680 } else if (!(cctl & PL080_CONTROL_SRC_INCR)) {
681 *mbus = &bd->srcbus;
682 *sbus = &bd->dstbus;
Linus Walleije8689e62010-09-28 15:57:37 +0200683 } else {
Viresh Kumar036f05f2011-08-05 15:32:41 +0530684 if (bd->dstbus.buswidth >= bd->srcbus.buswidth) {
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000685 *mbus = &bd->dstbus;
686 *sbus = &bd->srcbus;
Linus Walleije8689e62010-09-28 15:57:37 +0200687 } else {
Viresh Kumar036f05f2011-08-05 15:32:41 +0530688 *mbus = &bd->srcbus;
689 *sbus = &bd->dstbus;
Linus Walleije8689e62010-09-28 15:57:37 +0200690 }
691 }
692}
693
694/*
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +0000695 * Fills in one LLI for a certain transfer descriptor and advance the counter
Linus Walleije8689e62010-09-28 15:57:37 +0200696 */
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000697static void pl08x_fill_lli_for_desc(struct pl08x_lli_build_data *bd,
698 int num_llis, int len, u32 cctl)
Linus Walleije8689e62010-09-28 15:57:37 +0200699{
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000700 struct pl08x_lli *llis_va = bd->txd->llis_va;
701 dma_addr_t llis_bus = bd->txd->llis_bus;
Linus Walleije8689e62010-09-28 15:57:37 +0200702
703 BUG_ON(num_llis >= MAX_NUM_TSFR_LLIS);
704
Russell King - ARM Linux30749cb2011-01-03 22:41:13 +0000705 llis_va[num_llis].cctl = cctl;
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000706 llis_va[num_llis].src = bd->srcbus.addr;
707 llis_va[num_llis].dst = bd->dstbus.addr;
Viresh Kumar3e27ee82011-08-05 15:32:27 +0530708 llis_va[num_llis].lli = llis_bus + (num_llis + 1) *
709 sizeof(struct pl08x_lli);
Russell King - ARM Linux25c94f72011-07-21 17:11:46 +0100710 llis_va[num_llis].lli |= bd->lli_bus;
Linus Walleije8689e62010-09-28 15:57:37 +0200711
712 if (cctl & PL080_CONTROL_SRC_INCR)
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000713 bd->srcbus.addr += len;
Linus Walleije8689e62010-09-28 15:57:37 +0200714 if (cctl & PL080_CONTROL_DST_INCR)
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000715 bd->dstbus.addr += len;
Linus Walleije8689e62010-09-28 15:57:37 +0200716
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000717 BUG_ON(bd->remainder < len);
Russell King - ARM Linuxcace6582011-01-03 22:37:31 +0000718
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000719 bd->remainder -= len;
Linus Walleije8689e62010-09-28 15:57:37 +0200720}
721
Viresh Kumar03af5002011-08-05 15:32:39 +0530722static inline void prep_byte_width_lli(struct pl08x_lli_build_data *bd,
723 u32 *cctl, u32 len, int num_llis, size_t *total_bytes)
Linus Walleije8689e62010-09-28 15:57:37 +0200724{
Viresh Kumar03af5002011-08-05 15:32:39 +0530725 *cctl = pl08x_cctl_bits(*cctl, 1, 1, len);
726 pl08x_fill_lli_for_desc(bd, num_llis, len, *cctl);
727 (*total_bytes) += len;
Linus Walleije8689e62010-09-28 15:57:37 +0200728}
729
730/*
731 * This fills in the table of LLIs for the transfer descriptor
732 * Note that we assume we never have to change the burst sizes
733 * Return 0 for error
734 */
735static int pl08x_fill_llis_for_desc(struct pl08x_driver_data *pl08x,
736 struct pl08x_txd *txd)
737{
Linus Walleije8689e62010-09-28 15:57:37 +0200738 struct pl08x_bus_data *mbus, *sbus;
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000739 struct pl08x_lli_build_data bd;
Linus Walleije8689e62010-09-28 15:57:37 +0200740 int num_llis = 0;
Viresh Kumar03af5002011-08-05 15:32:39 +0530741 u32 cctl, early_bytes = 0;
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530742 size_t max_bytes_per_lli, total_bytes;
Russell King - ARM Linux7cb72ad2011-01-03 22:35:28 +0000743 struct pl08x_lli *llis_va;
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530744 struct pl08x_sg *dsg;
Linus Walleije8689e62010-09-28 15:57:37 +0200745
Viresh Kumar3e27ee82011-08-05 15:32:27 +0530746 txd->llis_va = dma_pool_alloc(pl08x->pool, GFP_NOWAIT, &txd->llis_bus);
Linus Walleije8689e62010-09-28 15:57:37 +0200747 if (!txd->llis_va) {
748 dev_err(&pl08x->adev->dev, "%s no memory for llis\n", __func__);
749 return 0;
750 }
751
752 pl08x->pool_ctr++;
753
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000754 bd.txd = txd;
Russell King - ARM Linux25c94f72011-07-21 17:11:46 +0100755 bd.lli_bus = (pl08x->lli_buses & PL08X_AHB2) ? PL080_LLI_LM_AHB2 : 0;
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530756 cctl = txd->cctl;
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000757
Linus Walleije8689e62010-09-28 15:57:37 +0200758 /* Find maximum width of the source bus */
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000759 bd.srcbus.maxwidth =
Linus Walleije8689e62010-09-28 15:57:37 +0200760 pl08x_get_bytes_for_cctl((cctl & PL080_CONTROL_SWIDTH_MASK) >>
761 PL080_CONTROL_SWIDTH_SHIFT);
762
763 /* Find maximum width of the destination bus */
Russell King - ARM Linux542361f2011-01-03 22:43:15 +0000764 bd.dstbus.maxwidth =
Linus Walleije8689e62010-09-28 15:57:37 +0200765 pl08x_get_bytes_for_cctl((cctl & PL080_CONTROL_DWIDTH_MASK) >>
766 PL080_CONTROL_DWIDTH_SHIFT);
767
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530768 list_for_each_entry(dsg, &txd->dsg_list, node) {
769 total_bytes = 0;
770 cctl = txd->cctl;
Linus Walleije8689e62010-09-28 15:57:37 +0200771
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530772 bd.srcbus.addr = dsg->src_addr;
773 bd.dstbus.addr = dsg->dst_addr;
774 bd.remainder = dsg->len;
775 bd.srcbus.buswidth = bd.srcbus.maxwidth;
776 bd.dstbus.buswidth = bd.dstbus.maxwidth;
Linus Walleije8689e62010-09-28 15:57:37 +0200777
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530778 pl08x_choose_master_bus(&bd, &mbus, &sbus, cctl);
Linus Walleije8689e62010-09-28 15:57:37 +0200779
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530780 dev_vdbg(&pl08x->adev->dev, "src=0x%08x%s/%u dst=0x%08x%s/%u len=%zu\n",
781 bd.srcbus.addr, cctl & PL080_CONTROL_SRC_INCR ? "+" : "",
782 bd.srcbus.buswidth,
783 bd.dstbus.addr, cctl & PL080_CONTROL_DST_INCR ? "+" : "",
784 bd.dstbus.buswidth,
785 bd.remainder);
786 dev_vdbg(&pl08x->adev->dev, "mbus=%s sbus=%s\n",
787 mbus == &bd.srcbus ? "src" : "dst",
788 sbus == &bd.srcbus ? "src" : "dst");
Russell King - ARM Linuxfc74eb72011-07-21 17:12:06 +0100789
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530790 /*
791 * Zero length is only allowed if all these requirements are
792 * met:
793 * - flow controller is peripheral.
794 * - src.addr is aligned to src.width
795 * - dst.addr is aligned to dst.width
796 *
797 * sg_len == 1 should be true, as there can be two cases here:
798 *
799 * - Memory addresses are contiguous and are not scattered.
800 * Here, Only one sg will be passed by user driver, with
801 * memory address and zero length. We pass this to controller
802 * and after the transfer it will receive the last burst
803 * request from peripheral and so transfer finishes.
804 *
805 * - Memory addresses are scattered and are not contiguous.
806 * Here, Obviously as DMA controller doesn't know when a lli's
807 * transfer gets over, it can't load next lli. So in this
808 * case, there has to be an assumption that only one lli is
809 * supported. Thus, we can't have scattered addresses.
810 */
811 if (!bd.remainder) {
812 u32 fc = (txd->ccfg & PL080_CONFIG_FLOW_CONTROL_MASK) >>
813 PL080_CONFIG_FLOW_CONTROL_SHIFT;
814 if (!((fc >= PL080_FLOW_SRC2DST_DST) &&
Viresh Kumar0a235652011-08-05 15:32:42 +0530815 (fc <= PL080_FLOW_SRC2DST_SRC))) {
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530816 dev_err(&pl08x->adev->dev, "%s sg len can't be zero",
817 __func__);
818 return 0;
819 }
Linus Walleije8689e62010-09-28 15:57:37 +0200820
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530821 if ((bd.srcbus.addr % bd.srcbus.buswidth) ||
Julia Lawall880db3f2012-01-12 22:49:29 +0100822 (bd.dstbus.addr % bd.dstbus.buswidth)) {
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530823 dev_err(&pl08x->adev->dev,
824 "%s src & dst address must be aligned to src"
825 " & dst width if peripheral is flow controller",
826 __func__);
827 return 0;
828 }
Linus Walleije8689e62010-09-28 15:57:37 +0200829
Viresh Kumar16a2e7d2011-08-05 15:32:37 +0530830 cctl = pl08x_cctl_bits(cctl, bd.srcbus.buswidth,
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530831 bd.dstbus.buswidth, 0);
832 pl08x_fill_lli_for_desc(&bd, num_llis++, 0, cctl);
833 break;
Linus Walleije8689e62010-09-28 15:57:37 +0200834 }
835
836 /*
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530837 * Send byte by byte for following cases
838 * - Less than a bus width available
839 * - until master bus is aligned
Linus Walleije8689e62010-09-28 15:57:37 +0200840 */
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530841 if (bd.remainder < mbus->buswidth)
842 early_bytes = bd.remainder;
843 else if ((mbus->addr) % (mbus->buswidth)) {
844 early_bytes = mbus->buswidth - (mbus->addr) %
845 (mbus->buswidth);
846 if ((bd.remainder - early_bytes) < mbus->buswidth)
847 early_bytes = bd.remainder;
Linus Walleije8689e62010-09-28 15:57:37 +0200848 }
Viresh Kumar16a2e7d2011-08-05 15:32:37 +0530849
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530850 if (early_bytes) {
851 dev_vdbg(&pl08x->adev->dev,
852 "%s byte width LLIs (remain 0x%08x)\n",
853 __func__, bd.remainder);
854 prep_byte_width_lli(&bd, &cctl, early_bytes, num_llis++,
855 &total_bytes);
856 }
Linus Walleije8689e62010-09-28 15:57:37 +0200857
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530858 if (bd.remainder) {
859 /*
860 * Master now aligned
861 * - if slave is not then we must set its width down
862 */
863 if (sbus->addr % sbus->buswidth) {
864 dev_dbg(&pl08x->adev->dev,
865 "%s set down bus width to one byte\n",
866 __func__);
867
868 sbus->buswidth = 1;
869 }
870
871 /*
872 * Bytes transferred = tsize * src width, not
873 * MIN(buswidths)
874 */
875 max_bytes_per_lli = bd.srcbus.buswidth *
876 PL080_CONTROL_TRANSFER_SIZE_MASK;
877 dev_vdbg(&pl08x->adev->dev,
878 "%s max bytes per lli = %zu\n",
879 __func__, max_bytes_per_lli);
880
881 /*
882 * Make largest possible LLIs until less than one bus
883 * width left
884 */
885 while (bd.remainder > (mbus->buswidth - 1)) {
886 size_t lli_len, tsize, width;
887
888 /*
889 * If enough left try to send max possible,
890 * otherwise try to send the remainder
891 */
892 lli_len = min(bd.remainder, max_bytes_per_lli);
893
894 /*
895 * Check against maximum bus alignment:
896 * Calculate actual transfer size in relation to
897 * bus width an get a maximum remainder of the
898 * highest bus width - 1
899 */
900 width = max(mbus->buswidth, sbus->buswidth);
901 lli_len = (lli_len / width) * width;
902 tsize = lli_len / bd.srcbus.buswidth;
903
904 dev_vdbg(&pl08x->adev->dev,
905 "%s fill lli with single lli chunk of "
906 "size 0x%08zx (remainder 0x%08zx)\n",
907 __func__, lli_len, bd.remainder);
908
909 cctl = pl08x_cctl_bits(cctl, bd.srcbus.buswidth,
910 bd.dstbus.buswidth, tsize);
911 pl08x_fill_lli_for_desc(&bd, num_llis++,
912 lli_len, cctl);
913 total_bytes += lli_len;
914 }
915
916 /*
917 * Send any odd bytes
918 */
919 if (bd.remainder) {
920 dev_vdbg(&pl08x->adev->dev,
921 "%s align with boundary, send odd bytes (remain %zu)\n",
922 __func__, bd.remainder);
923 prep_byte_width_lli(&bd, &cctl, bd.remainder,
924 num_llis++, &total_bytes);
925 }
926 }
927
928 if (total_bytes != dsg->len) {
929 dev_err(&pl08x->adev->dev,
930 "%s size of encoded lli:s don't match total txd, transferred 0x%08zx from size 0x%08zx\n",
931 __func__, total_bytes, dsg->len);
932 return 0;
933 }
934
935 if (num_llis >= MAX_NUM_TSFR_LLIS) {
936 dev_err(&pl08x->adev->dev,
937 "%s need to increase MAX_NUM_TSFR_LLIS from 0x%08x\n",
938 __func__, (u32) MAX_NUM_TSFR_LLIS);
939 return 0;
940 }
Linus Walleije8689e62010-09-28 15:57:37 +0200941 }
Linus Walleije8689e62010-09-28 15:57:37 +0200942
Russell King - ARM Linuxb58b6b52011-01-03 22:34:48 +0000943 llis_va = txd->llis_va;
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +0000944 /* The final LLI terminates the LLI. */
Russell King - ARM Linuxbfddfb42011-01-03 22:38:12 +0000945 llis_va[num_llis - 1].lli = 0;
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +0000946 /* The final LLI element shall also fire an interrupt. */
Russell King - ARM Linuxb58b6b52011-01-03 22:34:48 +0000947 llis_va[num_llis - 1].cctl |= PL080_CONTROL_TC_IRQ_EN;
Linus Walleije8689e62010-09-28 15:57:37 +0200948
Linus Walleije8689e62010-09-28 15:57:37 +0200949#ifdef VERBOSE_DEBUG
950 {
951 int i;
952
Russell King - ARM Linuxfc74eb72011-07-21 17:12:06 +0100953 dev_vdbg(&pl08x->adev->dev,
954 "%-3s %-9s %-10s %-10s %-10s %s\n",
955 "lli", "", "csrc", "cdst", "clli", "cctl");
Linus Walleije8689e62010-09-28 15:57:37 +0200956 for (i = 0; i < num_llis; i++) {
957 dev_vdbg(&pl08x->adev->dev,
Russell King - ARM Linuxfc74eb72011-07-21 17:12:06 +0100958 "%3d @%p: 0x%08x 0x%08x 0x%08x 0x%08x\n",
959 i, &llis_va[i], llis_va[i].src,
960 llis_va[i].dst, llis_va[i].lli, llis_va[i].cctl
Linus Walleije8689e62010-09-28 15:57:37 +0200961 );
962 }
963 }
964#endif
965
966 return num_llis;
967}
968
969/* You should call this with the struct pl08x lock held */
970static void pl08x_free_txd(struct pl08x_driver_data *pl08x,
971 struct pl08x_txd *txd)
972{
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530973 struct pl08x_sg *dsg, *_dsg;
974
Linus Walleije8689e62010-09-28 15:57:37 +0200975 /* Free the LLI */
Viresh Kumarc1205642011-08-05 15:32:44 +0530976 if (txd->llis_va)
977 dma_pool_free(pl08x->pool, txd->llis_va, txd->llis_bus);
Linus Walleije8689e62010-09-28 15:57:37 +0200978
979 pl08x->pool_ctr--;
980
Viresh Kumarb7f69d92011-08-05 15:32:43 +0530981 list_for_each_entry_safe(dsg, _dsg, &txd->dsg_list, node) {
982 list_del(&dsg->node);
983 kfree(dsg);
984 }
985
Linus Walleije8689e62010-09-28 15:57:37 +0200986 kfree(txd);
987}
988
989static void pl08x_free_txd_list(struct pl08x_driver_data *pl08x,
990 struct pl08x_dma_chan *plchan)
991{
992 struct pl08x_txd *txdi = NULL;
993 struct pl08x_txd *next;
994
Russell King - ARM Linux15c17232011-01-03 22:44:36 +0000995 if (!list_empty(&plchan->pend_list)) {
Linus Walleije8689e62010-09-28 15:57:37 +0200996 list_for_each_entry_safe(txdi,
Russell King - ARM Linux15c17232011-01-03 22:44:36 +0000997 next, &plchan->pend_list, node) {
Linus Walleije8689e62010-09-28 15:57:37 +0200998 list_del(&txdi->node);
999 pl08x_free_txd(pl08x, txdi);
1000 }
Linus Walleije8689e62010-09-28 15:57:37 +02001001 }
1002}
1003
1004/*
1005 * The DMA ENGINE API
1006 */
1007static int pl08x_alloc_chan_resources(struct dma_chan *chan)
1008{
1009 return 0;
1010}
1011
1012static void pl08x_free_chan_resources(struct dma_chan *chan)
1013{
1014}
1015
1016/*
1017 * This should be called with the channel plchan->lock held
1018 */
1019static int prep_phy_channel(struct pl08x_dma_chan *plchan,
1020 struct pl08x_txd *txd)
1021{
1022 struct pl08x_driver_data *pl08x = plchan->host;
1023 struct pl08x_phy_chan *ch;
1024 int ret;
1025
1026 /* Check if we already have a channel */
Viresh Kumar8f0d30f2011-11-29 12:56:50 +05301027 if (plchan->phychan) {
1028 ch = plchan->phychan;
1029 goto got_channel;
1030 }
Linus Walleije8689e62010-09-28 15:57:37 +02001031
1032 ch = pl08x_get_phy_channel(pl08x, plchan);
1033 if (!ch) {
1034 /* No physical channel available, cope with it */
1035 dev_dbg(&pl08x->adev->dev, "no physical channel available for xfer on %s\n", plchan->name);
1036 return -EBUSY;
1037 }
1038
1039 /*
1040 * OK we have a physical channel: for memcpy() this is all we
1041 * need, but for slaves the physical signals may be muxed!
1042 * Can the platform allow us to use this channel?
1043 */
Russell King6b16c8b2012-05-25 11:10:58 +01001044 if (plchan->slave) {
Russell Kingad0de2a2012-05-25 11:15:15 +01001045 ret = pl08x_request_mux(plchan);
Linus Walleije8689e62010-09-28 15:57:37 +02001046 if (ret < 0) {
1047 dev_dbg(&pl08x->adev->dev,
1048 "unable to use physical channel %d for transfer on %s due to platform restrictions\n",
1049 ch->id, plchan->name);
1050 /* Release physical channel & return */
1051 pl08x_put_phy_channel(pl08x, ch);
1052 return -EBUSY;
1053 }
Linus Walleije8689e62010-09-28 15:57:37 +02001054 }
1055
Viresh Kumar8f0d30f2011-11-29 12:56:50 +05301056 plchan->phychan = ch;
Linus Walleije8689e62010-09-28 15:57:37 +02001057 dev_dbg(&pl08x->adev->dev, "allocated physical channel %d and signal %d for xfer on %s\n",
1058 ch->id,
Russell Kingad0de2a2012-05-25 11:15:15 +01001059 plchan->signal,
Linus Walleije8689e62010-09-28 15:57:37 +02001060 plchan->name);
1061
Viresh Kumar8f0d30f2011-11-29 12:56:50 +05301062got_channel:
1063 /* Assign the flow control signal to this channel */
1064 if (txd->direction == DMA_MEM_TO_DEV)
Russell Kingad0de2a2012-05-25 11:15:15 +01001065 txd->ccfg |= plchan->signal << PL080_CONFIG_DST_SEL_SHIFT;
Viresh Kumar8f0d30f2011-11-29 12:56:50 +05301066 else if (txd->direction == DMA_DEV_TO_MEM)
Russell Kingad0de2a2012-05-25 11:15:15 +01001067 txd->ccfg |= plchan->signal << PL080_CONFIG_SRC_SEL_SHIFT;
Viresh Kumar8f0d30f2011-11-29 12:56:50 +05301068
Russell King - ARM Linux8087aac2011-01-03 22:45:17 +00001069 plchan->phychan_hold++;
Linus Walleije8689e62010-09-28 15:57:37 +02001070
1071 return 0;
1072}
1073
Russell King - ARM Linux8c8cc2b2011-01-03 22:36:09 +00001074static void release_phy_channel(struct pl08x_dma_chan *plchan)
1075{
1076 struct pl08x_driver_data *pl08x = plchan->host;
1077
Russell King6b16c8b2012-05-25 11:10:58 +01001078 pl08x_release_mux(plchan);
Russell King - ARM Linux8c8cc2b2011-01-03 22:36:09 +00001079 pl08x_put_phy_channel(pl08x, plchan->phychan);
1080 plchan->phychan = NULL;
1081}
1082
Linus Walleije8689e62010-09-28 15:57:37 +02001083static dma_cookie_t pl08x_tx_submit(struct dma_async_tx_descriptor *tx)
1084{
1085 struct pl08x_dma_chan *plchan = to_pl08x_chan(tx->chan);
Russell King - ARM Linux501e67e2011-01-03 22:44:57 +00001086 struct pl08x_txd *txd = to_pl08x_txd(tx);
Russell King - ARM Linuxc370e592011-01-03 22:45:37 +00001087 unsigned long flags;
Russell King - ARM Linux884485e2012-03-06 22:34:46 +00001088 dma_cookie_t cookie;
Russell King - ARM Linuxc370e592011-01-03 22:45:37 +00001089
1090 spin_lock_irqsave(&plchan->lock, flags);
Russell King - ARM Linux884485e2012-03-06 22:34:46 +00001091 cookie = dma_cookie_assign(tx);
Russell King - ARM Linux501e67e2011-01-03 22:44:57 +00001092
1093 /* Put this onto the pending list */
1094 list_add_tail(&txd->node, &plchan->pend_list);
1095
1096 /*
1097 * If there was no physical channel available for this memcpy,
1098 * stack the request up and indicate that the channel is waiting
1099 * for a free physical channel.
1100 */
1101 if (!plchan->slave && !plchan->phychan) {
1102 /* Do this memcpy whenever there is a channel ready */
1103 plchan->state = PL08X_CHAN_WAITING;
1104 plchan->waiting = txd;
Russell King - ARM Linux8087aac2011-01-03 22:45:17 +00001105 } else {
1106 plchan->phychan_hold--;
Russell King - ARM Linux501e67e2011-01-03 22:44:57 +00001107 }
1108
Russell King - ARM Linuxc370e592011-01-03 22:45:37 +00001109 spin_unlock_irqrestore(&plchan->lock, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001110
Russell King - ARM Linux884485e2012-03-06 22:34:46 +00001111 return cookie;
Linus Walleije8689e62010-09-28 15:57:37 +02001112}
1113
1114static struct dma_async_tx_descriptor *pl08x_prep_dma_interrupt(
1115 struct dma_chan *chan, unsigned long flags)
1116{
1117 struct dma_async_tx_descriptor *retval = NULL;
1118
1119 return retval;
1120}
1121
1122/*
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +00001123 * Code accessing dma_async_is_complete() in a tight loop may give problems.
1124 * If slaves are relying on interrupts to signal completion this function
1125 * must not be called with interrupts disabled.
Linus Walleije8689e62010-09-28 15:57:37 +02001126 */
Viresh Kumar3e27ee82011-08-05 15:32:27 +05301127static enum dma_status pl08x_dma_tx_status(struct dma_chan *chan,
1128 dma_cookie_t cookie, struct dma_tx_state *txstate)
Linus Walleije8689e62010-09-28 15:57:37 +02001129{
1130 struct pl08x_dma_chan *plchan = to_pl08x_chan(chan);
Linus Walleije8689e62010-09-28 15:57:37 +02001131 enum dma_status ret;
Linus Walleije8689e62010-09-28 15:57:37 +02001132
Russell King - ARM Linux96a2af42012-03-06 22:35:27 +00001133 ret = dma_cookie_status(chan, cookie, txstate);
1134 if (ret == DMA_SUCCESS)
Linus Walleije8689e62010-09-28 15:57:37 +02001135 return ret;
Linus Walleije8689e62010-09-28 15:57:37 +02001136
1137 /*
Linus Walleije8689e62010-09-28 15:57:37 +02001138 * This cookie not complete yet
Russell King - ARM Linux96a2af42012-03-06 22:35:27 +00001139 * Get number of bytes left in the active transactions and queue
Linus Walleije8689e62010-09-28 15:57:37 +02001140 */
Russell King - ARM Linux96a2af42012-03-06 22:35:27 +00001141 dma_set_residue(txstate, pl08x_getbytes_chan(plchan));
Linus Walleije8689e62010-09-28 15:57:37 +02001142
1143 if (plchan->state == PL08X_CHAN_PAUSED)
1144 return DMA_PAUSED;
1145
1146 /* Whether waiting or running, we're in progress */
1147 return DMA_IN_PROGRESS;
1148}
1149
1150/* PrimeCell DMA extension */
1151struct burst_table {
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001152 u32 burstwords;
Linus Walleije8689e62010-09-28 15:57:37 +02001153 u32 reg;
1154};
1155
1156static const struct burst_table burst_sizes[] = {
1157 {
1158 .burstwords = 256,
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001159 .reg = PL080_BSIZE_256,
Linus Walleije8689e62010-09-28 15:57:37 +02001160 },
1161 {
1162 .burstwords = 128,
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001163 .reg = PL080_BSIZE_128,
Linus Walleije8689e62010-09-28 15:57:37 +02001164 },
1165 {
1166 .burstwords = 64,
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001167 .reg = PL080_BSIZE_64,
Linus Walleije8689e62010-09-28 15:57:37 +02001168 },
1169 {
1170 .burstwords = 32,
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001171 .reg = PL080_BSIZE_32,
Linus Walleije8689e62010-09-28 15:57:37 +02001172 },
1173 {
1174 .burstwords = 16,
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001175 .reg = PL080_BSIZE_16,
Linus Walleije8689e62010-09-28 15:57:37 +02001176 },
1177 {
1178 .burstwords = 8,
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001179 .reg = PL080_BSIZE_8,
Linus Walleije8689e62010-09-28 15:57:37 +02001180 },
1181 {
1182 .burstwords = 4,
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001183 .reg = PL080_BSIZE_4,
Linus Walleije8689e62010-09-28 15:57:37 +02001184 },
1185 {
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001186 .burstwords = 0,
1187 .reg = PL080_BSIZE_1,
Linus Walleije8689e62010-09-28 15:57:37 +02001188 },
1189};
1190
Russell King - ARM Linux121c8472011-07-21 17:13:48 +01001191/*
1192 * Given the source and destination available bus masks, select which
1193 * will be routed to each port. We try to have source and destination
1194 * on separate ports, but always respect the allowable settings.
1195 */
1196static u32 pl08x_select_bus(u8 src, u8 dst)
1197{
1198 u32 cctl = 0;
1199
1200 if (!(dst & PL08X_AHB1) || ((dst & PL08X_AHB2) && (src & PL08X_AHB1)))
1201 cctl |= PL080_CONTROL_DST_AHB2;
1202 if (!(src & PL08X_AHB1) || ((src & PL08X_AHB2) && !(dst & PL08X_AHB2)))
1203 cctl |= PL080_CONTROL_SRC_AHB2;
1204
1205 return cctl;
1206}
1207
Russell King - ARM Linuxf14c4262011-07-21 17:12:47 +01001208static u32 pl08x_cctl(u32 cctl)
1209{
1210 cctl &= ~(PL080_CONTROL_SRC_AHB2 | PL080_CONTROL_DST_AHB2 |
1211 PL080_CONTROL_SRC_INCR | PL080_CONTROL_DST_INCR |
1212 PL080_CONTROL_PROT_MASK);
1213
1214 /* Access the cell in privileged mode, non-bufferable, non-cacheable */
1215 return cctl | PL080_CONTROL_PROT_SYS;
1216}
1217
Russell King - ARM Linuxaa88cda2011-07-21 17:13:28 +01001218static u32 pl08x_width(enum dma_slave_buswidth width)
1219{
1220 switch (width) {
1221 case DMA_SLAVE_BUSWIDTH_1_BYTE:
1222 return PL080_WIDTH_8BIT;
1223 case DMA_SLAVE_BUSWIDTH_2_BYTES:
1224 return PL080_WIDTH_16BIT;
1225 case DMA_SLAVE_BUSWIDTH_4_BYTES:
1226 return PL080_WIDTH_32BIT;
Vinod Koulf32807f2011-07-25 19:22:01 +05301227 default:
1228 return ~0;
Russell King - ARM Linuxaa88cda2011-07-21 17:13:28 +01001229 }
Russell King - ARM Linuxaa88cda2011-07-21 17:13:28 +01001230}
1231
Russell King - ARM Linux760596c62011-07-21 17:14:08 +01001232static u32 pl08x_burst(u32 maxburst)
1233{
1234 int i;
1235
1236 for (i = 0; i < ARRAY_SIZE(burst_sizes); i++)
1237 if (burst_sizes[i].burstwords <= maxburst)
1238 break;
1239
1240 return burst_sizes[i].reg;
1241}
1242
Russell King9862ba12012-05-16 11:16:03 +01001243static u32 pl08x_get_cctl(struct pl08x_dma_chan *plchan,
1244 enum dma_slave_buswidth addr_width, u32 maxburst)
1245{
1246 u32 width, burst, cctl = 0;
1247
1248 width = pl08x_width(addr_width);
1249 if (width == ~0)
1250 return ~0;
1251
1252 cctl |= width << PL080_CONTROL_SWIDTH_SHIFT;
1253 cctl |= width << PL080_CONTROL_DWIDTH_SHIFT;
1254
1255 /*
1256 * If this channel will only request single transfers, set this
1257 * down to ONE element. Also select one element if no maxburst
1258 * is specified.
1259 */
1260 if (plchan->cd->single)
1261 maxburst = 1;
1262
1263 burst = pl08x_burst(maxburst);
1264 cctl |= burst << PL080_CONTROL_SB_SIZE_SHIFT;
1265 cctl |= burst << PL080_CONTROL_DB_SIZE_SHIFT;
1266
1267 return pl08x_cctl(cctl);
1268}
1269
Russell King - ARM Linuxf0fd9442011-01-03 22:45:57 +00001270static int dma_set_runtime_config(struct dma_chan *chan,
1271 struct dma_slave_config *config)
Linus Walleije8689e62010-09-28 15:57:37 +02001272{
1273 struct pl08x_dma_chan *plchan = to_pl08x_chan(chan);
Linus Walleije8689e62010-09-28 15:57:37 +02001274
Russell King - ARM Linuxb7f75862011-01-03 22:46:17 +00001275 if (!plchan->slave)
1276 return -EINVAL;
1277
Russell Kingdc8d5f82012-05-16 12:20:55 +01001278 /* Reject definitely invalid configurations */
1279 if (config->src_addr_width == DMA_SLAVE_BUSWIDTH_8_BYTES ||
1280 config->dst_addr_width == DMA_SLAVE_BUSWIDTH_8_BYTES)
Russell King - ARM Linuxf0fd9442011-01-03 22:45:57 +00001281 return -EINVAL;
Linus Walleije8689e62010-09-28 15:57:37 +02001282
Russell Kinged91c132012-05-16 11:02:40 +01001283 plchan->cfg = *config;
1284
Russell King - ARM Linuxf0fd9442011-01-03 22:45:57 +00001285 return 0;
Linus Walleije8689e62010-09-28 15:57:37 +02001286}
1287
1288/*
1289 * Slave transactions callback to the slave device to allow
1290 * synchronization of slave DMA signals with the DMAC enable
1291 */
1292static void pl08x_issue_pending(struct dma_chan *chan)
1293{
1294 struct pl08x_dma_chan *plchan = to_pl08x_chan(chan);
Linus Walleije8689e62010-09-28 15:57:37 +02001295 unsigned long flags;
1296
1297 spin_lock_irqsave(&plchan->lock, flags);
Russell King - ARM Linux9c0bb432011-01-03 22:32:05 +00001298 /* Something is already active, or we're waiting for a channel... */
1299 if (plchan->at || plchan->state == PL08X_CHAN_WAITING) {
1300 spin_unlock_irqrestore(&plchan->lock, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001301 return;
Russell King - ARM Linux9c0bb432011-01-03 22:32:05 +00001302 }
Linus Walleije8689e62010-09-28 15:57:37 +02001303
1304 /* Take the first element in the queue and execute it */
Russell King - ARM Linux15c17232011-01-03 22:44:36 +00001305 if (!list_empty(&plchan->pend_list)) {
Linus Walleije8689e62010-09-28 15:57:37 +02001306 struct pl08x_txd *next;
1307
Russell King - ARM Linux15c17232011-01-03 22:44:36 +00001308 next = list_first_entry(&plchan->pend_list,
Linus Walleije8689e62010-09-28 15:57:37 +02001309 struct pl08x_txd,
1310 node);
1311 list_del(&next->node);
Linus Walleije8689e62010-09-28 15:57:37 +02001312 plchan->state = PL08X_CHAN_RUNNING;
1313
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +00001314 pl08x_start_txd(plchan, next);
Linus Walleije8689e62010-09-28 15:57:37 +02001315 }
1316
1317 spin_unlock_irqrestore(&plchan->lock, flags);
1318}
1319
1320static int pl08x_prep_channel_resources(struct pl08x_dma_chan *plchan,
1321 struct pl08x_txd *txd)
1322{
Linus Walleije8689e62010-09-28 15:57:37 +02001323 struct pl08x_driver_data *pl08x = plchan->host;
Russell King - ARM Linuxc370e592011-01-03 22:45:37 +00001324 unsigned long flags;
1325 int num_llis, ret;
Linus Walleije8689e62010-09-28 15:57:37 +02001326
1327 num_llis = pl08x_fill_llis_for_desc(pl08x, txd);
Russell King - ARM Linuxdafa7312011-01-03 22:31:45 +00001328 if (!num_llis) {
Viresh Kumar57001a62011-08-05 15:32:45 +05301329 spin_lock_irqsave(&plchan->lock, flags);
1330 pl08x_free_txd(pl08x, txd);
1331 spin_unlock_irqrestore(&plchan->lock, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001332 return -EINVAL;
Russell King - ARM Linuxdafa7312011-01-03 22:31:45 +00001333 }
Linus Walleije8689e62010-09-28 15:57:37 +02001334
Russell King - ARM Linuxc370e592011-01-03 22:45:37 +00001335 spin_lock_irqsave(&plchan->lock, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001336
Linus Walleije8689e62010-09-28 15:57:37 +02001337 /*
1338 * See if we already have a physical channel allocated,
1339 * else this is the time to try to get one.
1340 */
1341 ret = prep_phy_channel(plchan, txd);
1342 if (ret) {
1343 /*
Russell King - ARM Linux501e67e2011-01-03 22:44:57 +00001344 * No physical channel was available.
1345 *
1346 * memcpy transfers can be sorted out at submission time.
1347 *
1348 * Slave transfers may have been denied due to platform
1349 * channel muxing restrictions. Since there is no guarantee
1350 * that this will ever be resolved, and the signal must be
1351 * acquired AFTER acquiring the physical channel, we will let
1352 * them be NACK:ed with -EBUSY here. The drivers can retry
1353 * the prep() call if they are eager on doing this using DMA.
Linus Walleije8689e62010-09-28 15:57:37 +02001354 */
1355 if (plchan->slave) {
1356 pl08x_free_txd_list(pl08x, plchan);
Russell King - ARM Linux501e67e2011-01-03 22:44:57 +00001357 pl08x_free_txd(pl08x, txd);
Russell King - ARM Linuxc370e592011-01-03 22:45:37 +00001358 spin_unlock_irqrestore(&plchan->lock, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001359 return -EBUSY;
1360 }
Linus Walleije8689e62010-09-28 15:57:37 +02001361 } else
1362 /*
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +00001363 * Else we're all set, paused and ready to roll, status
1364 * will switch to PL08X_CHAN_RUNNING when we call
1365 * issue_pending(). If there is something running on the
1366 * channel already we don't change its state.
Linus Walleije8689e62010-09-28 15:57:37 +02001367 */
1368 if (plchan->state == PL08X_CHAN_IDLE)
1369 plchan->state = PL08X_CHAN_PAUSED;
1370
Russell King - ARM Linuxc370e592011-01-03 22:45:37 +00001371 spin_unlock_irqrestore(&plchan->lock, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001372
1373 return 0;
1374}
1375
Russell King - ARM Linuxc0428792011-01-03 22:43:56 +00001376static struct pl08x_txd *pl08x_get_txd(struct pl08x_dma_chan *plchan,
1377 unsigned long flags)
Russell King - ARM Linuxac3cd202011-01-03 22:35:49 +00001378{
Viresh Kumarb201c112011-08-05 15:32:29 +05301379 struct pl08x_txd *txd = kzalloc(sizeof(*txd), GFP_NOWAIT);
Russell King - ARM Linuxac3cd202011-01-03 22:35:49 +00001380
1381 if (txd) {
1382 dma_async_tx_descriptor_init(&txd->tx, &plchan->chan);
Russell King - ARM Linuxc0428792011-01-03 22:43:56 +00001383 txd->tx.flags = flags;
Russell King - ARM Linuxac3cd202011-01-03 22:35:49 +00001384 txd->tx.tx_submit = pl08x_tx_submit;
1385 INIT_LIST_HEAD(&txd->node);
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301386 INIT_LIST_HEAD(&txd->dsg_list);
Russell King - ARM Linux4983a042011-01-03 22:39:33 +00001387
1388 /* Always enable error and terminal interrupts */
1389 txd->ccfg = PL080_CONFIG_ERR_IRQ_MASK |
1390 PL080_CONFIG_TC_IRQ_MASK;
Russell King - ARM Linuxac3cd202011-01-03 22:35:49 +00001391 }
1392 return txd;
1393}
1394
Linus Walleije8689e62010-09-28 15:57:37 +02001395/*
1396 * Initialize a descriptor to be used by memcpy submit
1397 */
1398static struct dma_async_tx_descriptor *pl08x_prep_dma_memcpy(
1399 struct dma_chan *chan, dma_addr_t dest, dma_addr_t src,
1400 size_t len, unsigned long flags)
1401{
1402 struct pl08x_dma_chan *plchan = to_pl08x_chan(chan);
1403 struct pl08x_driver_data *pl08x = plchan->host;
1404 struct pl08x_txd *txd;
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301405 struct pl08x_sg *dsg;
Linus Walleije8689e62010-09-28 15:57:37 +02001406 int ret;
1407
Russell King - ARM Linuxc0428792011-01-03 22:43:56 +00001408 txd = pl08x_get_txd(plchan, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001409 if (!txd) {
1410 dev_err(&pl08x->adev->dev,
1411 "%s no memory for descriptor\n", __func__);
1412 return NULL;
1413 }
1414
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301415 dsg = kzalloc(sizeof(struct pl08x_sg), GFP_NOWAIT);
1416 if (!dsg) {
1417 pl08x_free_txd(pl08x, txd);
1418 dev_err(&pl08x->adev->dev, "%s no memory for pl080 sg\n",
1419 __func__);
1420 return NULL;
1421 }
1422 list_add_tail(&dsg->node, &txd->dsg_list);
1423
Russell King92d2fd62012-05-25 14:37:56 +01001424 txd->direction = DMA_MEM_TO_MEM;
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301425 dsg->src_addr = src;
1426 dsg->dst_addr = dest;
1427 dsg->len = len;
Linus Walleije8689e62010-09-28 15:57:37 +02001428
1429 /* Set platform data for m2m */
Russell King - ARM Linux4983a042011-01-03 22:39:33 +00001430 txd->ccfg |= PL080_FLOW_MEM2MEM << PL080_CONFIG_FLOW_CONTROL_SHIFT;
Russell Kingdc8d5f82012-05-16 12:20:55 +01001431 txd->cctl = pl08x->pd->memcpy_channel.cctl_memcpy &
Russell King - ARM Linuxc7da9a52011-01-03 22:40:53 +00001432 ~(PL080_CONTROL_DST_AHB2 | PL080_CONTROL_SRC_AHB2);
Russell King - ARM Linux4983a042011-01-03 22:39:33 +00001433
Linus Walleije8689e62010-09-28 15:57:37 +02001434 /* Both to be incremented or the code will break */
Russell King - ARM Linux70b5ed62011-01-03 22:40:13 +00001435 txd->cctl |= PL080_CONTROL_SRC_INCR | PL080_CONTROL_DST_INCR;
Russell King - ARM Linuxc7da9a52011-01-03 22:40:53 +00001436
Russell King - ARM Linuxc7da9a52011-01-03 22:40:53 +00001437 if (pl08x->vd->dualmaster)
Russell King - ARM Linux121c8472011-07-21 17:13:48 +01001438 txd->cctl |= pl08x_select_bus(pl08x->mem_buses,
1439 pl08x->mem_buses);
Linus Walleije8689e62010-09-28 15:57:37 +02001440
Linus Walleije8689e62010-09-28 15:57:37 +02001441 ret = pl08x_prep_channel_resources(plchan, txd);
1442 if (ret)
1443 return NULL;
Linus Walleije8689e62010-09-28 15:57:37 +02001444
1445 return &txd->tx;
1446}
1447
Russell King - ARM Linux3e2a0372011-01-03 22:32:46 +00001448static struct dma_async_tx_descriptor *pl08x_prep_slave_sg(
Linus Walleije8689e62010-09-28 15:57:37 +02001449 struct dma_chan *chan, struct scatterlist *sgl,
Vinod Kouldb8196d2011-10-13 22:34:23 +05301450 unsigned int sg_len, enum dma_transfer_direction direction,
Alexandre Bounine185ecb52012-03-08 15:35:13 -05001451 unsigned long flags, void *context)
Linus Walleije8689e62010-09-28 15:57:37 +02001452{
1453 struct pl08x_dma_chan *plchan = to_pl08x_chan(chan);
1454 struct pl08x_driver_data *pl08x = plchan->host;
1455 struct pl08x_txd *txd;
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301456 struct pl08x_sg *dsg;
1457 struct scatterlist *sg;
Russell Kingdc8d5f82012-05-16 12:20:55 +01001458 enum dma_slave_buswidth addr_width;
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301459 dma_addr_t slave_addr;
Viresh Kumar0a235652011-08-05 15:32:42 +05301460 int ret, tmp;
Russell King409ec8d2012-05-16 11:08:43 +01001461 u8 src_buses, dst_buses;
Russell Kingdc8d5f82012-05-16 12:20:55 +01001462 u32 maxburst, cctl;
Linus Walleije8689e62010-09-28 15:57:37 +02001463
Linus Walleije8689e62010-09-28 15:57:37 +02001464 dev_dbg(&pl08x->adev->dev, "%s prepare transaction of %d bytes from %s\n",
Lars-Peter Clausenfdaf9c42012-04-25 20:50:52 +02001465 __func__, sg_dma_len(sgl), plchan->name);
Linus Walleije8689e62010-09-28 15:57:37 +02001466
Russell King - ARM Linuxc0428792011-01-03 22:43:56 +00001467 txd = pl08x_get_txd(plchan, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001468 if (!txd) {
1469 dev_err(&pl08x->adev->dev, "%s no txd\n", __func__);
1470 return NULL;
1471 }
1472
Linus Walleije8689e62010-09-28 15:57:37 +02001473 /*
1474 * Set up addresses, the PrimeCell configured address
1475 * will take precedence since this may configure the
1476 * channel target address dynamically at runtime.
1477 */
1478 txd->direction = direction;
Russell King - ARM Linuxc7da9a52011-01-03 22:40:53 +00001479
Vinod Kouldb8196d2011-10-13 22:34:23 +05301480 if (direction == DMA_MEM_TO_DEV) {
Russell Kingdc8d5f82012-05-16 12:20:55 +01001481 cctl = PL080_CONTROL_SRC_INCR;
Russell Kinged91c132012-05-16 11:02:40 +01001482 slave_addr = plchan->cfg.dst_addr;
Russell Kingdc8d5f82012-05-16 12:20:55 +01001483 addr_width = plchan->cfg.dst_addr_width;
1484 maxburst = plchan->cfg.dst_maxburst;
Russell King409ec8d2012-05-16 11:08:43 +01001485 src_buses = pl08x->mem_buses;
1486 dst_buses = plchan->cd->periph_buses;
Vinod Kouldb8196d2011-10-13 22:34:23 +05301487 } else if (direction == DMA_DEV_TO_MEM) {
Russell Kingdc8d5f82012-05-16 12:20:55 +01001488 cctl = PL080_CONTROL_DST_INCR;
Russell Kinged91c132012-05-16 11:02:40 +01001489 slave_addr = plchan->cfg.src_addr;
Russell Kingdc8d5f82012-05-16 12:20:55 +01001490 addr_width = plchan->cfg.src_addr_width;
1491 maxburst = plchan->cfg.src_maxburst;
Russell King409ec8d2012-05-16 11:08:43 +01001492 src_buses = plchan->cd->periph_buses;
1493 dst_buses = pl08x->mem_buses;
Linus Walleije8689e62010-09-28 15:57:37 +02001494 } else {
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301495 pl08x_free_txd(pl08x, txd);
Linus Walleije8689e62010-09-28 15:57:37 +02001496 dev_err(&pl08x->adev->dev,
1497 "%s direction unsupported\n", __func__);
1498 return NULL;
1499 }
Linus Walleije8689e62010-09-28 15:57:37 +02001500
Russell Kingdc8d5f82012-05-16 12:20:55 +01001501 cctl |= pl08x_get_cctl(plchan, addr_width, maxburst);
Russell King800d6832012-05-16 11:33:31 +01001502 if (cctl == ~0) {
1503 pl08x_free_txd(pl08x, txd);
1504 dev_err(&pl08x->adev->dev,
1505 "DMA slave configuration botched?\n");
1506 return NULL;
1507 }
1508
Russell King409ec8d2012-05-16 11:08:43 +01001509 txd->cctl = cctl | pl08x_select_bus(src_buses, dst_buses);
1510
Russell King95442b22012-05-16 11:05:09 +01001511 if (plchan->cfg.device_fc)
Vinod Kouldb8196d2011-10-13 22:34:23 +05301512 tmp = (direction == DMA_MEM_TO_DEV) ? PL080_FLOW_MEM2PER_PER :
Viresh Kumar0a235652011-08-05 15:32:42 +05301513 PL080_FLOW_PER2MEM_PER;
1514 else
Vinod Kouldb8196d2011-10-13 22:34:23 +05301515 tmp = (direction == DMA_MEM_TO_DEV) ? PL080_FLOW_MEM2PER :
Viresh Kumar0a235652011-08-05 15:32:42 +05301516 PL080_FLOW_PER2MEM;
1517
1518 txd->ccfg |= tmp << PL080_CONFIG_FLOW_CONTROL_SHIFT;
1519
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301520 for_each_sg(sgl, sg, sg_len, tmp) {
1521 dsg = kzalloc(sizeof(struct pl08x_sg), GFP_NOWAIT);
1522 if (!dsg) {
1523 pl08x_free_txd(pl08x, txd);
1524 dev_err(&pl08x->adev->dev, "%s no mem for pl080 sg\n",
1525 __func__);
1526 return NULL;
1527 }
1528 list_add_tail(&dsg->node, &txd->dsg_list);
1529
1530 dsg->len = sg_dma_len(sg);
Vinod Kouldb8196d2011-10-13 22:34:23 +05301531 if (direction == DMA_MEM_TO_DEV) {
Lars-Peter Clausencbb796c2012-04-25 20:50:51 +02001532 dsg->src_addr = sg_dma_address(sg);
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301533 dsg->dst_addr = slave_addr;
1534 } else {
1535 dsg->src_addr = slave_addr;
Lars-Peter Clausencbb796c2012-04-25 20:50:51 +02001536 dsg->dst_addr = sg_dma_address(sg);
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301537 }
1538 }
1539
Linus Walleije8689e62010-09-28 15:57:37 +02001540 ret = pl08x_prep_channel_resources(plchan, txd);
1541 if (ret)
1542 return NULL;
Linus Walleije8689e62010-09-28 15:57:37 +02001543
1544 return &txd->tx;
1545}
1546
1547static int pl08x_control(struct dma_chan *chan, enum dma_ctrl_cmd cmd,
1548 unsigned long arg)
1549{
1550 struct pl08x_dma_chan *plchan = to_pl08x_chan(chan);
1551 struct pl08x_driver_data *pl08x = plchan->host;
1552 unsigned long flags;
1553 int ret = 0;
1554
1555 /* Controls applicable to inactive channels */
1556 if (cmd == DMA_SLAVE_CONFIG) {
Russell King - ARM Linuxf0fd9442011-01-03 22:45:57 +00001557 return dma_set_runtime_config(chan,
1558 (struct dma_slave_config *)arg);
Linus Walleije8689e62010-09-28 15:57:37 +02001559 }
1560
1561 /*
1562 * Anything succeeds on channels with no physical allocation and
1563 * no queued transfers.
1564 */
1565 spin_lock_irqsave(&plchan->lock, flags);
1566 if (!plchan->phychan && !plchan->at) {
1567 spin_unlock_irqrestore(&plchan->lock, flags);
1568 return 0;
1569 }
1570
1571 switch (cmd) {
1572 case DMA_TERMINATE_ALL:
1573 plchan->state = PL08X_CHAN_IDLE;
1574
1575 if (plchan->phychan) {
Russell King - ARM Linuxfb526212011-01-27 12:32:53 +00001576 pl08x_terminate_phy_chan(pl08x, plchan->phychan);
Linus Walleije8689e62010-09-28 15:57:37 +02001577
1578 /*
1579 * Mark physical channel as free and free any slave
1580 * signal
1581 */
Russell King - ARM Linux8c8cc2b2011-01-03 22:36:09 +00001582 release_phy_channel(plchan);
Davide Ciminaghi88c08a32012-04-19 12:20:24 +02001583 plchan->phychan_hold = 0;
Linus Walleije8689e62010-09-28 15:57:37 +02001584 }
Linus Walleije8689e62010-09-28 15:57:37 +02001585 /* Dequeue jobs and free LLIs */
1586 if (plchan->at) {
1587 pl08x_free_txd(pl08x, plchan->at);
1588 plchan->at = NULL;
1589 }
1590 /* Dequeue jobs not yet fired as well */
1591 pl08x_free_txd_list(pl08x, plchan);
1592 break;
1593 case DMA_PAUSE:
1594 pl08x_pause_phy_chan(plchan->phychan);
1595 plchan->state = PL08X_CHAN_PAUSED;
1596 break;
1597 case DMA_RESUME:
1598 pl08x_resume_phy_chan(plchan->phychan);
1599 plchan->state = PL08X_CHAN_RUNNING;
1600 break;
1601 default:
1602 /* Unknown command */
1603 ret = -ENXIO;
1604 break;
1605 }
1606
1607 spin_unlock_irqrestore(&plchan->lock, flags);
1608
1609 return ret;
1610}
1611
1612bool pl08x_filter_id(struct dma_chan *chan, void *chan_id)
1613{
Russell King - ARM Linux7703eac2011-08-31 09:34:35 +01001614 struct pl08x_dma_chan *plchan;
Linus Walleije8689e62010-09-28 15:57:37 +02001615 char *name = chan_id;
1616
Russell King - ARM Linux7703eac2011-08-31 09:34:35 +01001617 /* Reject channels for devices not bound to this driver */
1618 if (chan->device->dev->driver != &pl08x_amba_driver.drv)
1619 return false;
1620
1621 plchan = to_pl08x_chan(chan);
1622
Linus Walleije8689e62010-09-28 15:57:37 +02001623 /* Check that the channel is not taken! */
1624 if (!strcmp(plchan->name, name))
1625 return true;
1626
1627 return false;
1628}
1629
1630/*
1631 * Just check that the device is there and active
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +00001632 * TODO: turn this bit on/off depending on the number of physical channels
1633 * actually used, if it is zero... well shut it off. That will save some
1634 * power. Cut the clock at the same time.
Linus Walleije8689e62010-09-28 15:57:37 +02001635 */
1636static void pl08x_ensure_on(struct pl08x_driver_data *pl08x)
1637{
Linus Walleijaffa1152012-04-12 09:01:49 +02001638 /* The Nomadik variant does not have the config register */
1639 if (pl08x->vd->nomadik)
1640 return;
Viresh Kumar48a59ef2011-08-05 15:32:34 +05301641 writel(PL080_CONFIG_ENABLE, pl08x->base + PL080_CONFIG);
Linus Walleije8689e62010-09-28 15:57:37 +02001642}
1643
Russell King - ARM Linux3d992e12011-01-03 22:44:16 +00001644static void pl08x_unmap_buffers(struct pl08x_txd *txd)
1645{
1646 struct device *dev = txd->tx.chan->device->dev;
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301647 struct pl08x_sg *dsg;
Russell King - ARM Linux3d992e12011-01-03 22:44:16 +00001648
1649 if (!(txd->tx.flags & DMA_COMPL_SKIP_SRC_UNMAP)) {
1650 if (txd->tx.flags & DMA_COMPL_SRC_UNMAP_SINGLE)
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301651 list_for_each_entry(dsg, &txd->dsg_list, node)
1652 dma_unmap_single(dev, dsg->src_addr, dsg->len,
1653 DMA_TO_DEVICE);
1654 else {
1655 list_for_each_entry(dsg, &txd->dsg_list, node)
1656 dma_unmap_page(dev, dsg->src_addr, dsg->len,
1657 DMA_TO_DEVICE);
1658 }
Russell King - ARM Linux3d992e12011-01-03 22:44:16 +00001659 }
1660 if (!(txd->tx.flags & DMA_COMPL_SKIP_DEST_UNMAP)) {
1661 if (txd->tx.flags & DMA_COMPL_DEST_UNMAP_SINGLE)
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301662 list_for_each_entry(dsg, &txd->dsg_list, node)
1663 dma_unmap_single(dev, dsg->dst_addr, dsg->len,
1664 DMA_FROM_DEVICE);
Russell King - ARM Linux3d992e12011-01-03 22:44:16 +00001665 else
Viresh Kumarb7f69d92011-08-05 15:32:43 +05301666 list_for_each_entry(dsg, &txd->dsg_list, node)
1667 dma_unmap_page(dev, dsg->dst_addr, dsg->len,
1668 DMA_FROM_DEVICE);
Russell King - ARM Linux3d992e12011-01-03 22:44:16 +00001669 }
1670}
1671
Linus Walleije8689e62010-09-28 15:57:37 +02001672static void pl08x_tasklet(unsigned long data)
1673{
1674 struct pl08x_dma_chan *plchan = (struct pl08x_dma_chan *) data;
Linus Walleije8689e62010-09-28 15:57:37 +02001675 struct pl08x_driver_data *pl08x = plchan->host;
Russell King - ARM Linux858c21c2011-01-03 22:41:34 +00001676 struct pl08x_txd *txd;
Russell King - ARM Linuxbf072af2011-01-03 22:31:24 +00001677 unsigned long flags;
Linus Walleije8689e62010-09-28 15:57:37 +02001678
Russell King - ARM Linuxbf072af2011-01-03 22:31:24 +00001679 spin_lock_irqsave(&plchan->lock, flags);
Linus Walleije8689e62010-09-28 15:57:37 +02001680
Russell King - ARM Linux858c21c2011-01-03 22:41:34 +00001681 txd = plchan->at;
1682 plchan->at = NULL;
1683
1684 if (txd) {
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +00001685 /* Update last completed */
Russell King - ARM Linuxf7fbce02012-03-06 22:35:07 +00001686 dma_cookie_complete(&txd->tx);
Linus Walleije8689e62010-09-28 15:57:37 +02001687 }
Russell King - ARM Linux8087aac2011-01-03 22:45:17 +00001688
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +00001689 /* If a new descriptor is queued, set it up plchan->at is NULL here */
Russell King - ARM Linux15c17232011-01-03 22:44:36 +00001690 if (!list_empty(&plchan->pend_list)) {
Linus Walleije8689e62010-09-28 15:57:37 +02001691 struct pl08x_txd *next;
1692
Russell King - ARM Linux15c17232011-01-03 22:44:36 +00001693 next = list_first_entry(&plchan->pend_list,
Linus Walleije8689e62010-09-28 15:57:37 +02001694 struct pl08x_txd,
1695 node);
1696 list_del(&next->node);
Russell King - ARM Linuxc885bee2011-01-03 22:38:52 +00001697
1698 pl08x_start_txd(plchan, next);
Russell King - ARM Linux8087aac2011-01-03 22:45:17 +00001699 } else if (plchan->phychan_hold) {
1700 /*
1701 * This channel is still in use - we have a new txd being
1702 * prepared and will soon be queued. Don't give up the
1703 * physical channel.
1704 */
Linus Walleije8689e62010-09-28 15:57:37 +02001705 } else {
1706 struct pl08x_dma_chan *waiting = NULL;
1707
1708 /*
1709 * No more jobs, so free up the physical channel
1710 * Free any allocated signal on slave transfers too
1711 */
Russell King - ARM Linux8c8cc2b2011-01-03 22:36:09 +00001712 release_phy_channel(plchan);
Linus Walleije8689e62010-09-28 15:57:37 +02001713 plchan->state = PL08X_CHAN_IDLE;
1714
1715 /*
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +00001716 * And NOW before anyone else can grab that free:d up
1717 * physical channel, see if there is some memcpy pending
1718 * that seriously needs to start because of being stacked
1719 * up while we were choking the physical channels with data.
Linus Walleije8689e62010-09-28 15:57:37 +02001720 */
1721 list_for_each_entry(waiting, &pl08x->memcpy.channels,
1722 chan.device_node) {
Viresh Kumar3e27ee82011-08-05 15:32:27 +05301723 if (waiting->state == PL08X_CHAN_WAITING &&
1724 waiting->waiting != NULL) {
Linus Walleije8689e62010-09-28 15:57:37 +02001725 int ret;
1726
1727 /* This should REALLY not fail now */
1728 ret = prep_phy_channel(waiting,
1729 waiting->waiting);
1730 BUG_ON(ret);
Russell King - ARM Linux8087aac2011-01-03 22:45:17 +00001731 waiting->phychan_hold--;
Linus Walleije8689e62010-09-28 15:57:37 +02001732 waiting->state = PL08X_CHAN_RUNNING;
1733 waiting->waiting = NULL;
1734 pl08x_issue_pending(&waiting->chan);
1735 break;
1736 }
1737 }
1738 }
1739
Russell King - ARM Linuxbf072af2011-01-03 22:31:24 +00001740 spin_unlock_irqrestore(&plchan->lock, flags);
Russell King - ARM Linux858c21c2011-01-03 22:41:34 +00001741
Russell King - ARM Linux3d992e12011-01-03 22:44:16 +00001742 if (txd) {
1743 dma_async_tx_callback callback = txd->tx.callback;
1744 void *callback_param = txd->tx.callback_param;
1745
1746 /* Don't try to unmap buffers on slave channels */
1747 if (!plchan->slave)
1748 pl08x_unmap_buffers(txd);
1749
1750 /* Free the descriptor */
1751 spin_lock_irqsave(&plchan->lock, flags);
1752 pl08x_free_txd(pl08x, txd);
1753 spin_unlock_irqrestore(&plchan->lock, flags);
1754
1755 /* Callback to signal completion */
1756 if (callback)
1757 callback(callback_param);
1758 }
Linus Walleije8689e62010-09-28 15:57:37 +02001759}
1760
1761static irqreturn_t pl08x_irq(int irq, void *dev)
1762{
1763 struct pl08x_driver_data *pl08x = dev;
Viresh Kumar28da2832011-08-05 15:32:36 +05301764 u32 mask = 0, err, tc, i;
Linus Walleije8689e62010-09-28 15:57:37 +02001765
Viresh Kumar28da2832011-08-05 15:32:36 +05301766 /* check & clear - ERR & TC interrupts */
1767 err = readl(pl08x->base + PL080_ERR_STATUS);
1768 if (err) {
1769 dev_err(&pl08x->adev->dev, "%s error interrupt, register value 0x%08x\n",
1770 __func__, err);
1771 writel(err, pl08x->base + PL080_ERR_CLEAR);
Linus Walleije8689e62010-09-28 15:57:37 +02001772 }
Linus Walleijd29bf012012-04-09 22:53:21 +02001773 tc = readl(pl08x->base + PL080_TC_STATUS);
Viresh Kumar28da2832011-08-05 15:32:36 +05301774 if (tc)
1775 writel(tc, pl08x->base + PL080_TC_CLEAR);
1776
1777 if (!err && !tc)
1778 return IRQ_NONE;
1779
Linus Walleije8689e62010-09-28 15:57:37 +02001780 for (i = 0; i < pl08x->vd->channels; i++) {
Viresh Kumar28da2832011-08-05 15:32:36 +05301781 if (((1 << i) & err) || ((1 << i) & tc)) {
Linus Walleije8689e62010-09-28 15:57:37 +02001782 /* Locate physical channel */
1783 struct pl08x_phy_chan *phychan = &pl08x->phy_chans[i];
1784 struct pl08x_dma_chan *plchan = phychan->serving;
1785
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
Linus Walleije8689e62010-09-28 15:57:37 +02001793 /* Schedule tasklet on this channel */
1794 tasklet_schedule(&plchan->tasklet);
Linus Walleije8689e62010-09-28 15:57:37 +02001795 mask |= (1 << i);
1796 }
1797 }
Linus Walleije8689e62010-09-28 15:57:37 +02001798
1799 return mask ? IRQ_HANDLED : IRQ_NONE;
1800}
1801
Russell King - ARM Linux121c8472011-07-21 17:13:48 +01001802static void pl08x_dma_slave_init(struct pl08x_dma_chan *chan)
1803{
Russell King - ARM Linux121c8472011-07-21 17:13:48 +01001804 chan->slave = true;
1805 chan->name = chan->cd->bus_id;
Russell Kinged91c132012-05-16 11:02:40 +01001806 chan->cfg.src_addr = chan->cd->addr;
1807 chan->cfg.dst_addr = chan->cd->addr;
Russell King - ARM Linux121c8472011-07-21 17:13:48 +01001808}
1809
Linus Walleije8689e62010-09-28 15:57:37 +02001810/*
1811 * Initialise the DMAC memcpy/slave channels.
1812 * Make a local wrapper to hold required data
1813 */
1814static int pl08x_dma_init_virtual_channels(struct pl08x_driver_data *pl08x,
Viresh Kumar3e27ee82011-08-05 15:32:27 +05301815 struct dma_device *dmadev, unsigned int channels, bool slave)
Linus Walleije8689e62010-09-28 15:57:37 +02001816{
1817 struct pl08x_dma_chan *chan;
1818 int i;
1819
1820 INIT_LIST_HEAD(&dmadev->channels);
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +00001821
Linus Walleije8689e62010-09-28 15:57:37 +02001822 /*
1823 * Register as many many memcpy as we have physical channels,
1824 * we won't always be able to use all but the code will have
1825 * to cope with that situation.
1826 */
1827 for (i = 0; i < channels; i++) {
Viresh Kumarb201c112011-08-05 15:32:29 +05301828 chan = kzalloc(sizeof(*chan), GFP_KERNEL);
Linus Walleije8689e62010-09-28 15:57:37 +02001829 if (!chan) {
1830 dev_err(&pl08x->adev->dev,
1831 "%s no memory for channel\n", __func__);
1832 return -ENOMEM;
1833 }
1834
1835 chan->host = pl08x;
1836 chan->state = PL08X_CHAN_IDLE;
Russell Kingad0de2a2012-05-25 11:15:15 +01001837 chan->signal = -1;
Linus Walleije8689e62010-09-28 15:57:37 +02001838
1839 if (slave) {
Linus Walleije8689e62010-09-28 15:57:37 +02001840 chan->cd = &pl08x->pd->slave_channels[i];
Russell King - ARM Linux121c8472011-07-21 17:13:48 +01001841 pl08x_dma_slave_init(chan);
Linus Walleije8689e62010-09-28 15:57:37 +02001842 } else {
1843 chan->cd = &pl08x->pd->memcpy_channel;
1844 chan->name = kasprintf(GFP_KERNEL, "memcpy%d", i);
1845 if (!chan->name) {
1846 kfree(chan);
1847 return -ENOMEM;
1848 }
1849 }
Viresh Kumar175a5e62011-08-05 15:32:32 +05301850 dev_dbg(&pl08x->adev->dev,
Linus Walleije8689e62010-09-28 15:57:37 +02001851 "initialize virtual channel \"%s\"\n",
1852 chan->name);
1853
1854 chan->chan.device = dmadev;
Russell King - ARM Linuxd3ee98cdc2012-03-06 22:35:47 +00001855 dma_cookie_init(&chan->chan);
Linus Walleije8689e62010-09-28 15:57:37 +02001856
1857 spin_lock_init(&chan->lock);
Russell King - ARM Linux15c17232011-01-03 22:44:36 +00001858 INIT_LIST_HEAD(&chan->pend_list);
Linus Walleije8689e62010-09-28 15:57:37 +02001859 tasklet_init(&chan->tasklet, pl08x_tasklet,
1860 (unsigned long) chan);
1861
1862 list_add_tail(&chan->chan.device_node, &dmadev->channels);
1863 }
1864 dev_info(&pl08x->adev->dev, "initialized %d virtual %s channels\n",
1865 i, slave ? "slave" : "memcpy");
1866 return i;
1867}
1868
1869static void pl08x_free_virtual_channels(struct dma_device *dmadev)
1870{
1871 struct pl08x_dma_chan *chan = NULL;
1872 struct pl08x_dma_chan *next;
1873
1874 list_for_each_entry_safe(chan,
1875 next, &dmadev->channels, chan.device_node) {
1876 list_del(&chan->chan.device_node);
1877 kfree(chan);
1878 }
1879}
1880
1881#ifdef CONFIG_DEBUG_FS
1882static const char *pl08x_state_str(enum pl08x_dma_chan_state state)
1883{
1884 switch (state) {
1885 case PL08X_CHAN_IDLE:
1886 return "idle";
1887 case PL08X_CHAN_RUNNING:
1888 return "running";
1889 case PL08X_CHAN_PAUSED:
1890 return "paused";
1891 case PL08X_CHAN_WAITING:
1892 return "waiting";
1893 default:
1894 break;
1895 }
1896 return "UNKNOWN STATE";
1897}
1898
1899static int pl08x_debugfs_show(struct seq_file *s, void *data)
1900{
1901 struct pl08x_driver_data *pl08x = s->private;
1902 struct pl08x_dma_chan *chan;
1903 struct pl08x_phy_chan *ch;
1904 unsigned long flags;
1905 int i;
1906
1907 seq_printf(s, "PL08x physical channels:\n");
1908 seq_printf(s, "CHANNEL:\tUSER:\n");
1909 seq_printf(s, "--------\t-----\n");
1910 for (i = 0; i < pl08x->vd->channels; i++) {
1911 struct pl08x_dma_chan *virt_chan;
1912
1913 ch = &pl08x->phy_chans[i];
1914
1915 spin_lock_irqsave(&ch->lock, flags);
1916 virt_chan = ch->serving;
1917
Linus Walleijaffa1152012-04-12 09:01:49 +02001918 seq_printf(s, "%d\t\t%s%s\n",
1919 ch->id,
1920 virt_chan ? virt_chan->name : "(none)",
1921 ch->locked ? " LOCKED" : "");
Linus Walleije8689e62010-09-28 15:57:37 +02001922
1923 spin_unlock_irqrestore(&ch->lock, flags);
1924 }
1925
1926 seq_printf(s, "\nPL08x virtual memcpy channels:\n");
1927 seq_printf(s, "CHANNEL:\tSTATE:\n");
1928 seq_printf(s, "--------\t------\n");
1929 list_for_each_entry(chan, &pl08x->memcpy.channels, chan.device_node) {
Russell King - ARM Linux3e2a0372011-01-03 22:32:46 +00001930 seq_printf(s, "%s\t\t%s\n", chan->name,
Linus Walleije8689e62010-09-28 15:57:37 +02001931 pl08x_state_str(chan->state));
1932 }
1933
1934 seq_printf(s, "\nPL08x virtual slave channels:\n");
1935 seq_printf(s, "CHANNEL:\tSTATE:\n");
1936 seq_printf(s, "--------\t------\n");
1937 list_for_each_entry(chan, &pl08x->slave.channels, chan.device_node) {
Russell King - ARM Linux3e2a0372011-01-03 22:32:46 +00001938 seq_printf(s, "%s\t\t%s\n", chan->name,
Linus Walleije8689e62010-09-28 15:57:37 +02001939 pl08x_state_str(chan->state));
1940 }
1941
1942 return 0;
1943}
1944
1945static int pl08x_debugfs_open(struct inode *inode, struct file *file)
1946{
1947 return single_open(file, pl08x_debugfs_show, inode->i_private);
1948}
1949
1950static const struct file_operations pl08x_debugfs_operations = {
1951 .open = pl08x_debugfs_open,
1952 .read = seq_read,
1953 .llseek = seq_lseek,
1954 .release = single_release,
1955};
1956
1957static void init_pl08x_debugfs(struct pl08x_driver_data *pl08x)
1958{
1959 /* Expose a simple debugfs interface to view all clocks */
Viresh Kumar3e27ee82011-08-05 15:32:27 +05301960 (void) debugfs_create_file(dev_name(&pl08x->adev->dev),
1961 S_IFREG | S_IRUGO, NULL, pl08x,
1962 &pl08x_debugfs_operations);
Linus Walleije8689e62010-09-28 15:57:37 +02001963}
1964
1965#else
1966static inline void init_pl08x_debugfs(struct pl08x_driver_data *pl08x)
1967{
1968}
1969#endif
1970
Russell Kingaa25afa2011-02-19 15:55:00 +00001971static int pl08x_probe(struct amba_device *adev, const struct amba_id *id)
Linus Walleije8689e62010-09-28 15:57:37 +02001972{
1973 struct pl08x_driver_data *pl08x;
Russell King - ARM Linuxf96ca9ec2011-01-03 22:35:08 +00001974 const struct vendor_data *vd = id->data;
Linus Walleije8689e62010-09-28 15:57:37 +02001975 int ret = 0;
1976 int i;
1977
1978 ret = amba_request_regions(adev, NULL);
1979 if (ret)
1980 return ret;
1981
1982 /* Create the driver state holder */
Viresh Kumarb201c112011-08-05 15:32:29 +05301983 pl08x = kzalloc(sizeof(*pl08x), GFP_KERNEL);
Linus Walleije8689e62010-09-28 15:57:37 +02001984 if (!pl08x) {
1985 ret = -ENOMEM;
1986 goto out_no_pl08x;
1987 }
1988
1989 /* Initialize memcpy engine */
1990 dma_cap_set(DMA_MEMCPY, pl08x->memcpy.cap_mask);
1991 pl08x->memcpy.dev = &adev->dev;
1992 pl08x->memcpy.device_alloc_chan_resources = pl08x_alloc_chan_resources;
1993 pl08x->memcpy.device_free_chan_resources = pl08x_free_chan_resources;
1994 pl08x->memcpy.device_prep_dma_memcpy = pl08x_prep_dma_memcpy;
1995 pl08x->memcpy.device_prep_dma_interrupt = pl08x_prep_dma_interrupt;
1996 pl08x->memcpy.device_tx_status = pl08x_dma_tx_status;
1997 pl08x->memcpy.device_issue_pending = pl08x_issue_pending;
1998 pl08x->memcpy.device_control = pl08x_control;
1999
2000 /* Initialize slave engine */
2001 dma_cap_set(DMA_SLAVE, pl08x->slave.cap_mask);
2002 pl08x->slave.dev = &adev->dev;
2003 pl08x->slave.device_alloc_chan_resources = pl08x_alloc_chan_resources;
2004 pl08x->slave.device_free_chan_resources = pl08x_free_chan_resources;
2005 pl08x->slave.device_prep_dma_interrupt = pl08x_prep_dma_interrupt;
2006 pl08x->slave.device_tx_status = pl08x_dma_tx_status;
2007 pl08x->slave.device_issue_pending = pl08x_issue_pending;
2008 pl08x->slave.device_prep_slave_sg = pl08x_prep_slave_sg;
2009 pl08x->slave.device_control = pl08x_control;
2010
2011 /* Get the platform data */
2012 pl08x->pd = dev_get_platdata(&adev->dev);
2013 if (!pl08x->pd) {
2014 dev_err(&adev->dev, "no platform data supplied\n");
2015 goto out_no_platdata;
2016 }
2017
2018 /* Assign useful pointers to the driver state */
2019 pl08x->adev = adev;
2020 pl08x->vd = vd;
2021
Russell King - ARM Linux30749cb2011-01-03 22:41:13 +00002022 /* By default, AHB1 only. If dualmaster, from platform */
2023 pl08x->lli_buses = PL08X_AHB1;
2024 pl08x->mem_buses = PL08X_AHB1;
2025 if (pl08x->vd->dualmaster) {
2026 pl08x->lli_buses = pl08x->pd->lli_buses;
2027 pl08x->mem_buses = pl08x->pd->mem_buses;
2028 }
2029
Linus Walleije8689e62010-09-28 15:57:37 +02002030 /* A DMA memory pool for LLIs, align on 1-byte boundary */
2031 pl08x->pool = dma_pool_create(DRIVER_NAME, &pl08x->adev->dev,
2032 PL08X_LLI_TSFR_SIZE, PL08X_ALIGN, 0);
2033 if (!pl08x->pool) {
2034 ret = -ENOMEM;
2035 goto out_no_lli_pool;
2036 }
2037
Linus Walleije8689e62010-09-28 15:57:37 +02002038 pl08x->base = ioremap(adev->res.start, resource_size(&adev->res));
2039 if (!pl08x->base) {
2040 ret = -ENOMEM;
2041 goto out_no_ioremap;
2042 }
2043
2044 /* Turn on the PL08x */
2045 pl08x_ensure_on(pl08x);
2046
Russell King - ARM Linux94ae8522011-01-16 20:18:05 +00002047 /* Attach the interrupt handler */
Linus Walleije8689e62010-09-28 15:57:37 +02002048 writel(0x000000FF, pl08x->base + PL080_ERR_CLEAR);
2049 writel(0x000000FF, pl08x->base + PL080_TC_CLEAR);
2050
2051 ret = request_irq(adev->irq[0], pl08x_irq, IRQF_DISABLED,
Russell King - ARM Linuxb05cd8f2011-01-03 22:33:26 +00002052 DRIVER_NAME, pl08x);
Linus Walleije8689e62010-09-28 15:57:37 +02002053 if (ret) {
2054 dev_err(&adev->dev, "%s failed to request interrupt %d\n",
2055 __func__, adev->irq[0]);
2056 goto out_no_irq;
2057 }
2058
2059 /* Initialize physical channels */
Linus Walleijaffa1152012-04-12 09:01:49 +02002060 pl08x->phy_chans = kzalloc((vd->channels * sizeof(*pl08x->phy_chans)),
Linus Walleije8689e62010-09-28 15:57:37 +02002061 GFP_KERNEL);
2062 if (!pl08x->phy_chans) {
2063 dev_err(&adev->dev, "%s failed to allocate "
2064 "physical channel holders\n",
2065 __func__);
2066 goto out_no_phychans;
2067 }
2068
2069 for (i = 0; i < vd->channels; i++) {
2070 struct pl08x_phy_chan *ch = &pl08x->phy_chans[i];
2071
2072 ch->id = i;
2073 ch->base = pl08x->base + PL080_Cx_BASE(i);
2074 spin_lock_init(&ch->lock);
Linus Walleijaffa1152012-04-12 09:01:49 +02002075
2076 /*
2077 * Nomadik variants can have channels that are locked
2078 * down for the secure world only. Lock up these channels
2079 * by perpetually serving a dummy virtual channel.
2080 */
2081 if (vd->nomadik) {
2082 u32 val;
2083
2084 val = readl(ch->base + PL080_CH_CONFIG);
2085 if (val & (PL080N_CONFIG_ITPROT | PL080N_CONFIG_SECPROT)) {
2086 dev_info(&adev->dev, "physical channel %d reserved for secure access only\n", i);
2087 ch->locked = true;
2088 }
2089 }
2090
Viresh Kumar175a5e62011-08-05 15:32:32 +05302091 dev_dbg(&adev->dev, "physical channel %d is %s\n",
2092 i, pl08x_phy_channel_busy(ch) ? "BUSY" : "FREE");
Linus Walleije8689e62010-09-28 15:57:37 +02002093 }
2094
2095 /* Register as many memcpy channels as there are physical channels */
2096 ret = pl08x_dma_init_virtual_channels(pl08x, &pl08x->memcpy,
2097 pl08x->vd->channels, false);
2098 if (ret <= 0) {
2099 dev_warn(&pl08x->adev->dev,
2100 "%s failed to enumerate memcpy channels - %d\n",
2101 __func__, ret);
2102 goto out_no_memcpy;
2103 }
2104 pl08x->memcpy.chancnt = ret;
2105
2106 /* Register slave channels */
2107 ret = pl08x_dma_init_virtual_channels(pl08x, &pl08x->slave,
Viresh Kumar3e27ee82011-08-05 15:32:27 +05302108 pl08x->pd->num_slave_channels, true);
Linus Walleije8689e62010-09-28 15:57:37 +02002109 if (ret <= 0) {
2110 dev_warn(&pl08x->adev->dev,
2111 "%s failed to enumerate slave channels - %d\n",
2112 __func__, ret);
2113 goto out_no_slave;
2114 }
2115 pl08x->slave.chancnt = ret;
2116
2117 ret = dma_async_device_register(&pl08x->memcpy);
2118 if (ret) {
2119 dev_warn(&pl08x->adev->dev,
2120 "%s failed to register memcpy as an async device - %d\n",
2121 __func__, ret);
2122 goto out_no_memcpy_reg;
2123 }
2124
2125 ret = dma_async_device_register(&pl08x->slave);
2126 if (ret) {
2127 dev_warn(&pl08x->adev->dev,
2128 "%s failed to register slave as an async device - %d\n",
2129 __func__, ret);
2130 goto out_no_slave_reg;
2131 }
2132
2133 amba_set_drvdata(adev, pl08x);
2134 init_pl08x_debugfs(pl08x);
Russell King - ARM Linuxb05cd8f2011-01-03 22:33:26 +00002135 dev_info(&pl08x->adev->dev, "DMA: PL%03x rev%u at 0x%08llx irq %d\n",
2136 amba_part(adev), amba_rev(adev),
2137 (unsigned long long)adev->res.start, adev->irq[0]);
Viresh Kumarb7b60182011-08-05 15:32:33 +05302138
Linus Walleije8689e62010-09-28 15:57:37 +02002139 return 0;
2140
2141out_no_slave_reg:
2142 dma_async_device_unregister(&pl08x->memcpy);
2143out_no_memcpy_reg:
2144 pl08x_free_virtual_channels(&pl08x->slave);
2145out_no_slave:
2146 pl08x_free_virtual_channels(&pl08x->memcpy);
2147out_no_memcpy:
2148 kfree(pl08x->phy_chans);
2149out_no_phychans:
2150 free_irq(adev->irq[0], pl08x);
2151out_no_irq:
2152 iounmap(pl08x->base);
2153out_no_ioremap:
2154 dma_pool_destroy(pl08x->pool);
2155out_no_lli_pool:
2156out_no_platdata:
2157 kfree(pl08x);
2158out_no_pl08x:
2159 amba_release_regions(adev);
2160 return ret;
2161}
2162
2163/* PL080 has 8 channels and the PL080 have just 2 */
2164static struct vendor_data vendor_pl080 = {
Linus Walleije8689e62010-09-28 15:57:37 +02002165 .channels = 8,
2166 .dualmaster = true,
2167};
2168
Linus Walleijaffa1152012-04-12 09:01:49 +02002169static struct vendor_data vendor_nomadik = {
2170 .channels = 8,
2171 .dualmaster = true,
2172 .nomadik = true,
2173};
2174
Linus Walleije8689e62010-09-28 15:57:37 +02002175static struct vendor_data vendor_pl081 = {
Linus Walleije8689e62010-09-28 15:57:37 +02002176 .channels = 2,
2177 .dualmaster = false,
2178};
2179
2180static struct amba_id pl08x_ids[] = {
2181 /* PL080 */
2182 {
2183 .id = 0x00041080,
2184 .mask = 0x000fffff,
2185 .data = &vendor_pl080,
2186 },
2187 /* PL081 */
2188 {
2189 .id = 0x00041081,
2190 .mask = 0x000fffff,
2191 .data = &vendor_pl081,
2192 },
2193 /* Nomadik 8815 PL080 variant */
2194 {
Linus Walleijaffa1152012-04-12 09:01:49 +02002195 .id = 0x00280080,
Linus Walleije8689e62010-09-28 15:57:37 +02002196 .mask = 0x00ffffff,
Linus Walleijaffa1152012-04-12 09:01:49 +02002197 .data = &vendor_nomadik,
Linus Walleije8689e62010-09-28 15:57:37 +02002198 },
2199 { 0, 0 },
2200};
2201
Dave Martin037566d2011-10-05 15:15:20 +01002202MODULE_DEVICE_TABLE(amba, pl08x_ids);
2203
Linus Walleije8689e62010-09-28 15:57:37 +02002204static struct amba_driver pl08x_amba_driver = {
2205 .drv.name = DRIVER_NAME,
2206 .id_table = pl08x_ids,
2207 .probe = pl08x_probe,
2208};
2209
2210static int __init pl08x_init(void)
2211{
2212 int retval;
2213 retval = amba_driver_register(&pl08x_amba_driver);
2214 if (retval)
2215 printk(KERN_WARNING DRIVER_NAME
Russell King - ARM Linuxe8b5e112011-01-03 22:30:24 +00002216 "failed to register as an AMBA device (%d)\n",
Linus Walleije8689e62010-09-28 15:57:37 +02002217 retval);
2218 return retval;
2219}
2220subsys_initcall(pl08x_init);