blob: 511e45775c333acdd8a94177695f5be034083c8c [file] [log] [blame]
Arend van Spriel5b435de2011-10-05 13:19:03 +02001/*
2 * Copyright (c) 2010 Broadcom Corporation
3 *
4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
7 *
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
11 * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
13 * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
14 * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15 */
Joe Perches8505a7e2011-11-13 11:41:04 -080016
Arend van Spriel5b435de2011-10-05 13:19:03 +020017#include <linux/slab.h>
Arend van Spriel5b435de2011-10-05 13:19:03 +020018#include <linux/delay.h>
19#include <linux/pci.h>
Seth Forsheee041f652012-11-15 08:07:56 -060020#include <net/cfg80211.h>
21#include <net/mac80211.h>
Arend van Spriel5b435de2011-10-05 13:19:03 +020022
23#include <brcmu_utils.h>
24#include <aiutils.h>
25#include "types.h"
Seth Forsheee041f652012-11-15 08:07:56 -060026#include "main.h"
Arend van Spriel5b435de2011-10-05 13:19:03 +020027#include "dma.h"
Alwin Beukers23038212011-10-18 14:02:58 +020028#include "soc.h"
Seth Forsheee041f652012-11-15 08:07:56 -060029#include "scb.h"
30#include "ampdu.h"
Seth Forshee90123e02012-11-15 08:08:07 -060031#include "debug.h"
Seth Forshee0c9a0a12012-11-15 08:08:11 -060032#include "brcms_trace_events.h"
Arend van Spriel5b435de2011-10-05 13:19:03 +020033
34/*
Arend van Spriele81da652011-12-08 15:06:53 -080035 * dma register field offset calculation
36 */
37#define DMA64REGOFFS(field) offsetof(struct dma64regs, field)
38#define DMA64TXREGOFFS(di, field) (di->d64txregbase + DMA64REGOFFS(field))
39#define DMA64RXREGOFFS(di, field) (di->d64rxregbase + DMA64REGOFFS(field))
40
41/*
Arend van Spriel5b435de2011-10-05 13:19:03 +020042 * DMA hardware requires each descriptor ring to be 8kB aligned, and fit within
43 * a contiguous 8kB physical address.
44 */
45#define D64RINGALIGN_BITS 13
46#define D64MAXRINGSZ (1 << D64RINGALIGN_BITS)
47#define D64RINGALIGN (1 << D64RINGALIGN_BITS)
48
49#define D64MAXDD (D64MAXRINGSZ / sizeof(struct dma64desc))
50
51/* transmit channel control */
52#define D64_XC_XE 0x00000001 /* transmit enable */
53#define D64_XC_SE 0x00000002 /* transmit suspend request */
54#define D64_XC_LE 0x00000004 /* loopback enable */
55#define D64_XC_FL 0x00000010 /* flush request */
56#define D64_XC_PD 0x00000800 /* parity check disable */
57#define D64_XC_AE 0x00030000 /* address extension bits */
58#define D64_XC_AE_SHIFT 16
59
60/* transmit descriptor table pointer */
61#define D64_XP_LD_MASK 0x00000fff /* last valid descriptor */
62
63/* transmit channel status */
64#define D64_XS0_CD_MASK 0x00001fff /* current descriptor pointer */
65#define D64_XS0_XS_MASK 0xf0000000 /* transmit state */
66#define D64_XS0_XS_SHIFT 28
67#define D64_XS0_XS_DISABLED 0x00000000 /* disabled */
68#define D64_XS0_XS_ACTIVE 0x10000000 /* active */
69#define D64_XS0_XS_IDLE 0x20000000 /* idle wait */
70#define D64_XS0_XS_STOPPED 0x30000000 /* stopped */
71#define D64_XS0_XS_SUSP 0x40000000 /* suspend pending */
72
73#define D64_XS1_AD_MASK 0x00001fff /* active descriptor */
74#define D64_XS1_XE_MASK 0xf0000000 /* transmit errors */
75#define D64_XS1_XE_SHIFT 28
76#define D64_XS1_XE_NOERR 0x00000000 /* no error */
77#define D64_XS1_XE_DPE 0x10000000 /* descriptor protocol error */
78#define D64_XS1_XE_DFU 0x20000000 /* data fifo underrun */
79#define D64_XS1_XE_DTE 0x30000000 /* data transfer error */
80#define D64_XS1_XE_DESRE 0x40000000 /* descriptor read error */
81#define D64_XS1_XE_COREE 0x50000000 /* core error */
82
83/* receive channel control */
84/* receive enable */
85#define D64_RC_RE 0x00000001
86/* receive frame offset */
87#define D64_RC_RO_MASK 0x000000fe
88#define D64_RC_RO_SHIFT 1
89/* direct fifo receive (pio) mode */
90#define D64_RC_FM 0x00000100
91/* separate rx header descriptor enable */
92#define D64_RC_SH 0x00000200
93/* overflow continue */
94#define D64_RC_OC 0x00000400
95/* parity check disable */
96#define D64_RC_PD 0x00000800
97/* address extension bits */
98#define D64_RC_AE 0x00030000
99#define D64_RC_AE_SHIFT 16
100
101/* flags for dma controller */
102/* partity enable */
103#define DMA_CTRL_PEN (1 << 0)
104/* rx overflow continue */
105#define DMA_CTRL_ROC (1 << 1)
106/* allow rx scatter to multiple descriptors */
107#define DMA_CTRL_RXMULTI (1 << 2)
108/* Unframed Rx/Tx data */
109#define DMA_CTRL_UNFRAMED (1 << 3)
110
111/* receive descriptor table pointer */
112#define D64_RP_LD_MASK 0x00000fff /* last valid descriptor */
113
114/* receive channel status */
115#define D64_RS0_CD_MASK 0x00001fff /* current descriptor pointer */
116#define D64_RS0_RS_MASK 0xf0000000 /* receive state */
117#define D64_RS0_RS_SHIFT 28
118#define D64_RS0_RS_DISABLED 0x00000000 /* disabled */
119#define D64_RS0_RS_ACTIVE 0x10000000 /* active */
120#define D64_RS0_RS_IDLE 0x20000000 /* idle wait */
121#define D64_RS0_RS_STOPPED 0x30000000 /* stopped */
122#define D64_RS0_RS_SUSP 0x40000000 /* suspend pending */
123
124#define D64_RS1_AD_MASK 0x0001ffff /* active descriptor */
125#define D64_RS1_RE_MASK 0xf0000000 /* receive errors */
126#define D64_RS1_RE_SHIFT 28
127#define D64_RS1_RE_NOERR 0x00000000 /* no error */
128#define D64_RS1_RE_DPO 0x10000000 /* descriptor protocol error */
129#define D64_RS1_RE_DFU 0x20000000 /* data fifo overflow */
130#define D64_RS1_RE_DTE 0x30000000 /* data transfer error */
131#define D64_RS1_RE_DESRE 0x40000000 /* descriptor read error */
132#define D64_RS1_RE_COREE 0x50000000 /* core error */
133
134/* fifoaddr */
135#define D64_FA_OFF_MASK 0xffff /* offset */
136#define D64_FA_SEL_MASK 0xf0000 /* select */
137#define D64_FA_SEL_SHIFT 16
138#define D64_FA_SEL_XDD 0x00000 /* transmit dma data */
139#define D64_FA_SEL_XDP 0x10000 /* transmit dma pointers */
140#define D64_FA_SEL_RDD 0x40000 /* receive dma data */
141#define D64_FA_SEL_RDP 0x50000 /* receive dma pointers */
142#define D64_FA_SEL_XFD 0x80000 /* transmit fifo data */
143#define D64_FA_SEL_XFP 0x90000 /* transmit fifo pointers */
144#define D64_FA_SEL_RFD 0xc0000 /* receive fifo data */
145#define D64_FA_SEL_RFP 0xd0000 /* receive fifo pointers */
146#define D64_FA_SEL_RSD 0xe0000 /* receive frame status data */
147#define D64_FA_SEL_RSP 0xf0000 /* receive frame status pointers */
148
149/* descriptor control flags 1 */
150#define D64_CTRL_COREFLAGS 0x0ff00000 /* core specific flags */
151#define D64_CTRL1_EOT ((u32)1 << 28) /* end of descriptor table */
152#define D64_CTRL1_IOC ((u32)1 << 29) /* interrupt on completion */
153#define D64_CTRL1_EOF ((u32)1 << 30) /* end of frame */
154#define D64_CTRL1_SOF ((u32)1 << 31) /* start of frame */
155
156/* descriptor control flags 2 */
157/* buffer byte count. real data len must <= 16KB */
158#define D64_CTRL2_BC_MASK 0x00007fff
159/* address extension bits */
160#define D64_CTRL2_AE 0x00030000
161#define D64_CTRL2_AE_SHIFT 16
162/* parity bit */
163#define D64_CTRL2_PARITY 0x00040000
164
165/* control flags in the range [27:20] are core-specific and not defined here */
166#define D64_CTRL_CORE_MASK 0x0ff00000
167
168#define D64_RX_FRM_STS_LEN 0x0000ffff /* frame length mask */
169#define D64_RX_FRM_STS_OVFL 0x00800000 /* RxOverFlow */
170#define D64_RX_FRM_STS_DSCRCNT 0x0f000000 /* no. of descriptors used - 1 */
171#define D64_RX_FRM_STS_DATATYPE 0xf0000000 /* core-dependent data type */
172
173/*
174 * packet headroom necessary to accommodate the largest header
175 * in the system, (i.e TXOFF). By doing, we avoid the need to
176 * allocate an extra buffer for the header when bridging to WL.
177 * There is a compile time check in wlc.c which ensure that this
178 * value is at least as big as TXOFF. This value is used in
179 * dma_rxfill().
180 */
181
182#define BCMEXTRAHDROOM 172
183
Arend van Spriel5b435de2011-10-05 13:19:03 +0200184#define MAXNAMEL 8 /* 8 char names */
185
186/* macros to convert between byte offsets and indexes */
187#define B2I(bytes, type) ((bytes) / sizeof(type))
188#define I2B(index, type) ((index) * sizeof(type))
189
190#define PCI32ADDR_HIGH 0xc0000000 /* address[31:30] */
191#define PCI32ADDR_HIGH_SHIFT 30 /* address[31:30] */
192
193#define PCI64ADDR_HIGH 0x80000000 /* address[63] */
194#define PCI64ADDR_HIGH_SHIFT 31 /* address[63] */
195
196/*
197 * DMA Descriptor
198 * Descriptors are only read by the hardware, never written back.
199 */
200struct dma64desc {
201 __le32 ctrl1; /* misc control bits & bufcount */
202 __le32 ctrl2; /* buffer count and address extension */
203 __le32 addrlow; /* memory address of the date buffer, bits 31:0 */
204 __le32 addrhigh; /* memory address of the date buffer, bits 63:32 */
205};
206
207/* dma engine software state */
208struct dma_info {
209 struct dma_pub dma; /* exported structure */
Arend van Spriel5b435de2011-10-05 13:19:03 +0200210 char name[MAXNAMEL]; /* callers name for diag msgs */
211
Arend van Spriel3b758a62011-12-12 15:15:09 -0800212 struct bcma_device *core;
Arend van Spriel2e81b9b2011-12-08 15:06:52 -0800213 struct device *dmadev;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200214
Seth Forsheee041f652012-11-15 08:07:56 -0600215 /* session information for AMPDU */
216 struct brcms_ampdu_session ampdu_session;
217
Arend van Spriel5b435de2011-10-05 13:19:03 +0200218 bool dma64; /* this dma engine is operating in 64-bit mode */
219 bool addrext; /* this dma engine supports DmaExtendedAddrChanges */
220
221 /* 64-bit dma tx engine registers */
Arend van Spriele81da652011-12-08 15:06:53 -0800222 uint d64txregbase;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200223 /* 64-bit dma rx engine registers */
Arend van Spriele81da652011-12-08 15:06:53 -0800224 uint d64rxregbase;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200225 /* pointer to dma64 tx descriptor ring */
226 struct dma64desc *txd64;
227 /* pointer to dma64 rx descriptor ring */
228 struct dma64desc *rxd64;
229
230 u16 dmadesc_align; /* alignment requirement for dma descriptors */
231
232 u16 ntxd; /* # tx descriptors tunable */
233 u16 txin; /* index of next descriptor to reclaim */
234 u16 txout; /* index of next descriptor to post */
235 /* pointer to parallel array of pointers to packets */
236 struct sk_buff **txp;
237 /* Aligned physical address of descriptor ring */
238 dma_addr_t txdpa;
239 /* Original physical address of descriptor ring */
240 dma_addr_t txdpaorig;
241 u16 txdalign; /* #bytes added to alloc'd mem to align txd */
242 u32 txdalloc; /* #bytes allocated for the ring */
243 u32 xmtptrbase; /* When using unaligned descriptors, the ptr register
244 * is not just an index, it needs all 13 bits to be
245 * an offset from the addr register.
246 */
247
248 u16 nrxd; /* # rx descriptors tunable */
249 u16 rxin; /* index of next descriptor to reclaim */
250 u16 rxout; /* index of next descriptor to post */
251 /* pointer to parallel array of pointers to packets */
252 struct sk_buff **rxp;
253 /* Aligned physical address of descriptor ring */
254 dma_addr_t rxdpa;
255 /* Original physical address of descriptor ring */
256 dma_addr_t rxdpaorig;
257 u16 rxdalign; /* #bytes added to alloc'd mem to align rxd */
258 u32 rxdalloc; /* #bytes allocated for the ring */
259 u32 rcvptrbase; /* Base for ptr reg when using unaligned descriptors */
260
261 /* tunables */
262 unsigned int rxbufsize; /* rx buffer size in bytes, not including
263 * the extra headroom
264 */
265 uint rxextrahdrroom; /* extra rx headroom, reverseved to assist upper
266 * stack, e.g. some rx pkt buffers will be
267 * bridged to tx side without byte copying.
268 * The extra headroom needs to be large enough
269 * to fit txheader needs. Some dongle driver may
270 * not need it.
271 */
272 uint nrxpost; /* # rx buffers to keep posted */
273 unsigned int rxoffset; /* rxcontrol offset */
274 /* add to get dma address of descriptor ring, low 32 bits */
275 uint ddoffsetlow;
276 /* high 32 bits */
277 uint ddoffsethigh;
278 /* add to get dma address of data buffer, low 32 bits */
279 uint dataoffsetlow;
280 /* high 32 bits */
281 uint dataoffsethigh;
282 /* descriptor base need to be aligned or not */
283 bool aligndesc_4k;
284};
285
Arend van Spriel5b435de2011-10-05 13:19:03 +0200286/* Check for odd number of 1's */
287static u32 parity32(__le32 data)
288{
289 /* no swap needed for counting 1's */
290 u32 par_data = *(u32 *)&data;
291
292 par_data ^= par_data >> 16;
293 par_data ^= par_data >> 8;
294 par_data ^= par_data >> 4;
295 par_data ^= par_data >> 2;
296 par_data ^= par_data >> 1;
297
298 return par_data & 1;
299}
300
301static bool dma64_dd_parity(struct dma64desc *dd)
302{
303 return parity32(dd->addrlow ^ dd->addrhigh ^ dd->ctrl1 ^ dd->ctrl2);
304}
305
306/* descriptor bumping functions */
307
308static uint xxd(uint x, uint n)
309{
310 return x & (n - 1); /* faster than %, but n must be power of 2 */
311}
312
313static uint txd(struct dma_info *di, uint x)
314{
315 return xxd(x, di->ntxd);
316}
317
318static uint rxd(struct dma_info *di, uint x)
319{
320 return xxd(x, di->nrxd);
321}
322
323static uint nexttxd(struct dma_info *di, uint i)
324{
325 return txd(di, i + 1);
326}
327
328static uint prevtxd(struct dma_info *di, uint i)
329{
330 return txd(di, i - 1);
331}
332
333static uint nextrxd(struct dma_info *di, uint i)
334{
Seth Forsheeb05618d2012-11-15 08:07:57 -0600335 return rxd(di, i + 1);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200336}
337
338static uint ntxdactive(struct dma_info *di, uint h, uint t)
339{
340 return txd(di, t-h);
341}
342
343static uint nrxdactive(struct dma_info *di, uint h, uint t)
344{
345 return rxd(di, t-h);
346}
347
348static uint _dma_ctrlflags(struct dma_info *di, uint mask, uint flags)
349{
Arend van Sprielae8e4672011-10-29 11:30:15 +0200350 uint dmactrlflags;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200351
352 if (di == NULL) {
Seth Forshee90123e02012-11-15 08:08:07 -0600353 brcms_dbg_dma(di->core, "NULL dma handle\n");
Arend van Spriel5b435de2011-10-05 13:19:03 +0200354 return 0;
355 }
356
Arend van Sprielae8e4672011-10-29 11:30:15 +0200357 dmactrlflags = di->dma.dmactrlflags;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200358 dmactrlflags &= ~mask;
359 dmactrlflags |= flags;
360
361 /* If trying to enable parity, check if parity is actually supported */
362 if (dmactrlflags & DMA_CTRL_PEN) {
363 u32 control;
364
Arend van Spriel3b758a62011-12-12 15:15:09 -0800365 control = bcma_read32(di->core, DMA64TXREGOFFS(di, control));
366 bcma_write32(di->core, DMA64TXREGOFFS(di, control),
Arend van Spriel5b435de2011-10-05 13:19:03 +0200367 control | D64_XC_PD);
Arend van Spriel3b758a62011-12-12 15:15:09 -0800368 if (bcma_read32(di->core, DMA64TXREGOFFS(di, control)) &
Arend van Spriele81da652011-12-08 15:06:53 -0800369 D64_XC_PD)
Arend van Spriel5b435de2011-10-05 13:19:03 +0200370 /* We *can* disable it so it is supported,
371 * restore control register
372 */
Arend van Spriel3b758a62011-12-12 15:15:09 -0800373 bcma_write32(di->core, DMA64TXREGOFFS(di, control),
Arend van Spriele81da652011-12-08 15:06:53 -0800374 control);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200375 else
376 /* Not supported, don't allow it to be enabled */
377 dmactrlflags &= ~DMA_CTRL_PEN;
378 }
379
380 di->dma.dmactrlflags = dmactrlflags;
381
382 return dmactrlflags;
383}
384
Arend van Spriele81da652011-12-08 15:06:53 -0800385static bool _dma64_addrext(struct dma_info *di, uint ctrl_offset)
Arend van Spriel5b435de2011-10-05 13:19:03 +0200386{
387 u32 w;
Arend van Spriel3b758a62011-12-12 15:15:09 -0800388 bcma_set32(di->core, ctrl_offset, D64_XC_AE);
389 w = bcma_read32(di->core, ctrl_offset);
390 bcma_mask32(di->core, ctrl_offset, ~D64_XC_AE);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200391 return (w & D64_XC_AE) == D64_XC_AE;
392}
393
394/*
395 * return true if this dma engine supports DmaExtendedAddrChanges,
396 * otherwise false
397 */
398static bool _dma_isaddrext(struct dma_info *di)
399{
400 /* DMA64 supports full 32- or 64-bit operation. AE is always valid */
401
402 /* not all tx or rx channel are available */
Arend van Spriele81da652011-12-08 15:06:53 -0800403 if (di->d64txregbase != 0) {
404 if (!_dma64_addrext(di, DMA64TXREGOFFS(di, control)))
Seth Forshee90123e02012-11-15 08:08:07 -0600405 brcms_dbg_dma(di->core,
406 "%s: DMA64 tx doesn't have AE set\n",
407 di->name);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200408 return true;
Arend van Spriele81da652011-12-08 15:06:53 -0800409 } else if (di->d64rxregbase != 0) {
410 if (!_dma64_addrext(di, DMA64RXREGOFFS(di, control)))
Seth Forshee90123e02012-11-15 08:08:07 -0600411 brcms_dbg_dma(di->core,
412 "%s: DMA64 rx doesn't have AE set\n",
413 di->name);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200414 return true;
415 }
416
417 return false;
418}
419
420static bool _dma_descriptor_align(struct dma_info *di)
421{
422 u32 addrl;
423
424 /* Check to see if the descriptors need to be aligned on 4K/8K or not */
Arend van Spriele81da652011-12-08 15:06:53 -0800425 if (di->d64txregbase != 0) {
Arend van Spriel3b758a62011-12-12 15:15:09 -0800426 bcma_write32(di->core, DMA64TXREGOFFS(di, addrlow), 0xff0);
427 addrl = bcma_read32(di->core, DMA64TXREGOFFS(di, addrlow));
Arend van Spriel5b435de2011-10-05 13:19:03 +0200428 if (addrl != 0)
429 return false;
Arend van Spriele81da652011-12-08 15:06:53 -0800430 } else if (di->d64rxregbase != 0) {
Arend van Spriel3b758a62011-12-12 15:15:09 -0800431 bcma_write32(di->core, DMA64RXREGOFFS(di, addrlow), 0xff0);
432 addrl = bcma_read32(di->core, DMA64RXREGOFFS(di, addrlow));
Arend van Spriel5b435de2011-10-05 13:19:03 +0200433 if (addrl != 0)
434 return false;
435 }
436 return true;
437}
438
439/*
440 * Descriptor table must start at the DMA hardware dictated alignment, so
441 * allocated memory must be large enough to support this requirement.
442 */
Arend van Spriel2e81b9b2011-12-08 15:06:52 -0800443static void *dma_alloc_consistent(struct dma_info *di, uint size,
Arend van Spriel5b435de2011-10-05 13:19:03 +0200444 u16 align_bits, uint *alloced,
445 dma_addr_t *pap)
446{
447 if (align_bits) {
448 u16 align = (1 << align_bits);
449 if (!IS_ALIGNED(PAGE_SIZE, align))
450 size += align;
451 *alloced = size;
452 }
Arend van Spriel2e81b9b2011-12-08 15:06:52 -0800453 return dma_alloc_coherent(di->dmadev, size, pap, GFP_ATOMIC);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200454}
455
456static
457u8 dma_align_sizetobits(uint size)
458{
459 u8 bitpos = 0;
460 while (size >>= 1)
461 bitpos++;
462 return bitpos;
463}
464
465/* This function ensures that the DMA descriptor ring will not get allocated
466 * across Page boundary. If the allocation is done across the page boundary
467 * at the first time, then it is freed and the allocation is done at
468 * descriptor ring size aligned location. This will ensure that the ring will
469 * not cross page boundary
470 */
471static void *dma_ringalloc(struct dma_info *di, u32 boundary, uint size,
472 u16 *alignbits, uint *alloced,
473 dma_addr_t *descpa)
474{
475 void *va;
476 u32 desc_strtaddr;
477 u32 alignbytes = 1 << *alignbits;
478
Arend van Spriel2e81b9b2011-12-08 15:06:52 -0800479 va = dma_alloc_consistent(di, size, *alignbits, alloced, descpa);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200480
481 if (NULL == va)
482 return NULL;
483
484 desc_strtaddr = (u32) roundup((unsigned long)va, alignbytes);
485 if (((desc_strtaddr + size - 1) & boundary) != (desc_strtaddr
486 & boundary)) {
487 *alignbits = dma_align_sizetobits(size);
Arend van Spriel2e81b9b2011-12-08 15:06:52 -0800488 dma_free_coherent(di->dmadev, size, va, *descpa);
489 va = dma_alloc_consistent(di, size, *alignbits,
Arend van Spriel5b435de2011-10-05 13:19:03 +0200490 alloced, descpa);
491 }
492 return va;
493}
494
495static bool dma64_alloc(struct dma_info *di, uint direction)
496{
497 u16 size;
498 uint ddlen;
499 void *va;
500 uint alloced = 0;
501 u16 align;
502 u16 align_bits;
503
504 ddlen = sizeof(struct dma64desc);
505
506 size = (direction == DMA_TX) ? (di->ntxd * ddlen) : (di->nrxd * ddlen);
507 align_bits = di->dmadesc_align;
508 align = (1 << align_bits);
509
510 if (direction == DMA_TX) {
511 va = dma_ringalloc(di, D64RINGALIGN, size, &align_bits,
512 &alloced, &di->txdpaorig);
513 if (va == NULL) {
Seth Forshee90123e02012-11-15 08:08:07 -0600514 brcms_dbg_dma(di->core,
515 "%s: DMA_ALLOC_CONSISTENT(ntxd) failed\n",
516 di->name);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200517 return false;
518 }
519 align = (1 << align_bits);
520 di->txd64 = (struct dma64desc *)
521 roundup((unsigned long)va, align);
522 di->txdalign = (uint) ((s8 *)di->txd64 - (s8 *) va);
523 di->txdpa = di->txdpaorig + di->txdalign;
524 di->txdalloc = alloced;
525 } else {
526 va = dma_ringalloc(di, D64RINGALIGN, size, &align_bits,
527 &alloced, &di->rxdpaorig);
528 if (va == NULL) {
Seth Forshee90123e02012-11-15 08:08:07 -0600529 brcms_dbg_dma(di->core,
530 "%s: DMA_ALLOC_CONSISTENT(nrxd) failed\n",
531 di->name);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200532 return false;
533 }
534 align = (1 << align_bits);
535 di->rxd64 = (struct dma64desc *)
536 roundup((unsigned long)va, align);
537 di->rxdalign = (uint) ((s8 *)di->rxd64 - (s8 *) va);
538 di->rxdpa = di->rxdpaorig + di->rxdalign;
539 di->rxdalloc = alloced;
540 }
541
542 return true;
543}
544
545static bool _dma_alloc(struct dma_info *di, uint direction)
546{
547 return dma64_alloc(di, direction);
548}
549
Seth Forsheee041f652012-11-15 08:07:56 -0600550struct dma_pub *dma_attach(char *name, struct brcms_c_info *wlc,
Arend van Spriele81da652011-12-08 15:06:53 -0800551 uint txregbase, uint rxregbase, uint ntxd, uint nrxd,
Arend van Spriel2e81b9b2011-12-08 15:06:52 -0800552 uint rxbufsize, int rxextheadroom,
Seth Forshee90123e02012-11-15 08:08:07 -0600553 uint nrxpost, uint rxoffset)
Arend van Spriel5b435de2011-10-05 13:19:03 +0200554{
Seth Forsheee041f652012-11-15 08:07:56 -0600555 struct si_pub *sih = wlc->hw->sih;
556 struct bcma_device *core = wlc->hw->d11core;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200557 struct dma_info *di;
Arend van Spriel3b758a62011-12-12 15:15:09 -0800558 u8 rev = core->id.rev;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200559 uint size;
Hauke Mehrtensec5ab1d2012-06-30 15:16:18 +0200560 struct si_info *sii = container_of(sih, struct si_info, pub);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200561
562 /* allocate private info structure */
563 di = kzalloc(sizeof(struct dma_info), GFP_ATOMIC);
564 if (di == NULL)
565 return NULL;
566
Arend van Spriela8779e42011-12-08 15:06:58 -0800567 di->dma64 =
Arend van Spriel3b758a62011-12-12 15:15:09 -0800568 ((bcma_aread32(core, BCMA_IOST) & SISF_DMA64) == SISF_DMA64);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200569
Arend van Spriele81da652011-12-08 15:06:53 -0800570 /* init dma reg info */
Arend van Spriel3b758a62011-12-12 15:15:09 -0800571 di->core = core;
Arend van Spriele81da652011-12-08 15:06:53 -0800572 di->d64txregbase = txregbase;
573 di->d64rxregbase = rxregbase;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200574
575 /*
576 * Default flags (which can be changed by the driver calling
577 * dma_ctrlflags before enable): For backwards compatibility
578 * both Rx Overflow Continue and Parity are DISABLED.
579 */
580 _dma_ctrlflags(di, DMA_CTRL_ROC | DMA_CTRL_PEN, 0);
581
Seth Forshee90123e02012-11-15 08:08:07 -0600582 brcms_dbg_dma(di->core, "%s: %s flags 0x%x ntxd %d nrxd %d "
583 "rxbufsize %d rxextheadroom %d nrxpost %d rxoffset %d "
584 "txregbase %u rxregbase %u\n", name, "DMA64",
585 di->dma.dmactrlflags, ntxd, nrxd, rxbufsize,
586 rxextheadroom, nrxpost, rxoffset, txregbase, rxregbase);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200587
588 /* make a private copy of our callers name */
589 strncpy(di->name, name, MAXNAMEL);
590 di->name[MAXNAMEL - 1] = '\0';
591
Arend van Spriel3b758a62011-12-12 15:15:09 -0800592 di->dmadev = core->dma_dev;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200593
594 /* save tunables */
595 di->ntxd = (u16) ntxd;
596 di->nrxd = (u16) nrxd;
597
598 /* the actual dma size doesn't include the extra headroom */
599 di->rxextrahdrroom =
600 (rxextheadroom == -1) ? BCMEXTRAHDROOM : rxextheadroom;
601 if (rxbufsize > BCMEXTRAHDROOM)
602 di->rxbufsize = (u16) (rxbufsize - di->rxextrahdrroom);
603 else
604 di->rxbufsize = (u16) rxbufsize;
605
606 di->nrxpost = (u16) nrxpost;
607 di->rxoffset = (u8) rxoffset;
608
609 /*
610 * figure out the DMA physical address offset for dd and data
611 * PCI/PCIE: they map silicon backplace address to zero
612 * based memory, need offset
613 * Other bus: use zero SI_BUS BIGENDIAN kludge: use sdram
614 * swapped region for data buffer, not descriptor
615 */
616 di->ddoffsetlow = 0;
617 di->dataoffsetlow = 0;
Hauke Mehrtensec5ab1d2012-06-30 15:16:18 +0200618 /* for pci bus, add offset */
619 if (sii->icbus->hosttype == BCMA_HOSTTYPE_PCI) {
620 /* add offset for pcie with DMA64 bus */
621 di->ddoffsetlow = 0;
622 di->ddoffsethigh = SI_PCIE_DMA_H32;
623 }
Arend van Spriel5b435de2011-10-05 13:19:03 +0200624 di->dataoffsetlow = di->ddoffsetlow;
625 di->dataoffsethigh = di->ddoffsethigh;
Hauke Mehrtensec5ab1d2012-06-30 15:16:18 +0200626
Arend van Spriel5b435de2011-10-05 13:19:03 +0200627 /* WAR64450 : DMACtl.Addr ext fields are not supported in SDIOD core. */
Hauke Mehrtens780b9c42012-06-30 15:16:12 +0200628 if ((core->id.id == BCMA_CORE_SDIO_DEV)
Arend van Spriel3b758a62011-12-12 15:15:09 -0800629 && ((rev > 0) && (rev <= 2)))
Rusty Russell3db1cd52011-12-19 13:56:45 +0000630 di->addrext = false;
Hauke Mehrtens780b9c42012-06-30 15:16:12 +0200631 else if ((core->id.id == BCMA_CORE_I2S) &&
Arend van Spriel3b758a62011-12-12 15:15:09 -0800632 ((rev == 0) || (rev == 1)))
Rusty Russell3db1cd52011-12-19 13:56:45 +0000633 di->addrext = false;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200634 else
635 di->addrext = _dma_isaddrext(di);
636
637 /* does the descriptor need to be aligned and if yes, on 4K/8K or not */
638 di->aligndesc_4k = _dma_descriptor_align(di);
639 if (di->aligndesc_4k) {
640 di->dmadesc_align = D64RINGALIGN_BITS;
641 if ((ntxd < D64MAXDD / 2) && (nrxd < D64MAXDD / 2))
642 /* for smaller dd table, HW relax alignment reqmnt */
643 di->dmadesc_align = D64RINGALIGN_BITS - 1;
644 } else {
645 di->dmadesc_align = 4; /* 16 byte alignment */
646 }
647
Seth Forshee90123e02012-11-15 08:08:07 -0600648 brcms_dbg_dma(di->core, "DMA descriptor align_needed %d, align %d\n",
649 di->aligndesc_4k, di->dmadesc_align);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200650
651 /* allocate tx packet pointer vector */
652 if (ntxd) {
653 size = ntxd * sizeof(void *);
654 di->txp = kzalloc(size, GFP_ATOMIC);
655 if (di->txp == NULL)
656 goto fail;
657 }
658
659 /* allocate rx packet pointer vector */
660 if (nrxd) {
661 size = nrxd * sizeof(void *);
662 di->rxp = kzalloc(size, GFP_ATOMIC);
663 if (di->rxp == NULL)
664 goto fail;
665 }
666
667 /*
668 * allocate transmit descriptor ring, only need ntxd descriptors
669 * but it must be aligned
670 */
671 if (ntxd) {
672 if (!_dma_alloc(di, DMA_TX))
673 goto fail;
674 }
675
676 /*
677 * allocate receive descriptor ring, only need nrxd descriptors
678 * but it must be aligned
679 */
680 if (nrxd) {
681 if (!_dma_alloc(di, DMA_RX))
682 goto fail;
683 }
684
685 if ((di->ddoffsetlow != 0) && !di->addrext) {
686 if (di->txdpa > SI_PCI_DMA_SZ) {
Seth Forshee90123e02012-11-15 08:08:07 -0600687 brcms_dbg_dma(di->core,
688 "%s: txdpa 0x%x: addrext not supported\n",
689 di->name, (u32)di->txdpa);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200690 goto fail;
691 }
692 if (di->rxdpa > SI_PCI_DMA_SZ) {
Seth Forshee90123e02012-11-15 08:08:07 -0600693 brcms_dbg_dma(di->core,
694 "%s: rxdpa 0x%x: addrext not supported\n",
695 di->name, (u32)di->rxdpa);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200696 goto fail;
697 }
698 }
699
Seth Forsheee041f652012-11-15 08:07:56 -0600700 /* Initialize AMPDU session */
701 brcms_c_ampdu_reset_session(&di->ampdu_session, wlc);
702
Seth Forshee90123e02012-11-15 08:08:07 -0600703 brcms_dbg_dma(di->core,
704 "ddoffsetlow 0x%x ddoffsethigh 0x%x dataoffsetlow 0x%x dataoffsethigh 0x%x addrext %d\n",
705 di->ddoffsetlow, di->ddoffsethigh,
706 di->dataoffsetlow, di->dataoffsethigh,
707 di->addrext);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200708
709 return (struct dma_pub *) di;
710
711 fail:
712 dma_detach((struct dma_pub *)di);
713 return NULL;
714}
715
716static inline void
717dma64_dd_upd(struct dma_info *di, struct dma64desc *ddring,
718 dma_addr_t pa, uint outidx, u32 *flags, u32 bufcount)
719{
720 u32 ctrl2 = bufcount & D64_CTRL2_BC_MASK;
721
722 /* PCI bus with big(>1G) physical address, use address extension */
723 if ((di->dataoffsetlow == 0) || !(pa & PCI32ADDR_HIGH)) {
724 ddring[outidx].addrlow = cpu_to_le32(pa + di->dataoffsetlow);
725 ddring[outidx].addrhigh = cpu_to_le32(di->dataoffsethigh);
726 ddring[outidx].ctrl1 = cpu_to_le32(*flags);
727 ddring[outidx].ctrl2 = cpu_to_le32(ctrl2);
728 } else {
729 /* address extension for 32-bit PCI */
730 u32 ae;
731
732 ae = (pa & PCI32ADDR_HIGH) >> PCI32ADDR_HIGH_SHIFT;
733 pa &= ~PCI32ADDR_HIGH;
734
735 ctrl2 |= (ae << D64_CTRL2_AE_SHIFT) & D64_CTRL2_AE;
736 ddring[outidx].addrlow = cpu_to_le32(pa + di->dataoffsetlow);
737 ddring[outidx].addrhigh = cpu_to_le32(di->dataoffsethigh);
738 ddring[outidx].ctrl1 = cpu_to_le32(*flags);
739 ddring[outidx].ctrl2 = cpu_to_le32(ctrl2);
740 }
741 if (di->dma.dmactrlflags & DMA_CTRL_PEN) {
742 if (dma64_dd_parity(&ddring[outidx]))
743 ddring[outidx].ctrl2 =
744 cpu_to_le32(ctrl2 | D64_CTRL2_PARITY);
745 }
746}
747
748/* !! may be called with core in reset */
749void dma_detach(struct dma_pub *pub)
750{
751 struct dma_info *di = (struct dma_info *)pub;
752
Seth Forshee90123e02012-11-15 08:08:07 -0600753 brcms_dbg_dma(di->core, "%s:\n", di->name);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200754
755 /* free dma descriptor rings */
756 if (di->txd64)
Arend van Spriel2e81b9b2011-12-08 15:06:52 -0800757 dma_free_coherent(di->dmadev, di->txdalloc,
758 ((s8 *)di->txd64 - di->txdalign),
759 (di->txdpaorig));
Arend van Spriel5b435de2011-10-05 13:19:03 +0200760 if (di->rxd64)
Arend van Spriel2e81b9b2011-12-08 15:06:52 -0800761 dma_free_coherent(di->dmadev, di->rxdalloc,
762 ((s8 *)di->rxd64 - di->rxdalign),
763 (di->rxdpaorig));
Arend van Spriel5b435de2011-10-05 13:19:03 +0200764
765 /* free packet pointer vectors */
766 kfree(di->txp);
767 kfree(di->rxp);
768
769 /* free our private info structure */
770 kfree(di);
771
772}
773
774/* initialize descriptor table base address */
775static void
776_dma_ddtable_init(struct dma_info *di, uint direction, dma_addr_t pa)
777{
778 if (!di->aligndesc_4k) {
779 if (direction == DMA_TX)
780 di->xmtptrbase = pa;
781 else
782 di->rcvptrbase = pa;
783 }
784
785 if ((di->ddoffsetlow == 0)
786 || !(pa & PCI32ADDR_HIGH)) {
787 if (direction == DMA_TX) {
Arend van Spriel3b758a62011-12-12 15:15:09 -0800788 bcma_write32(di->core, DMA64TXREGOFFS(di, addrlow),
Arend van Spriele81da652011-12-08 15:06:53 -0800789 pa + di->ddoffsetlow);
Arend van Spriel3b758a62011-12-12 15:15:09 -0800790 bcma_write32(di->core, DMA64TXREGOFFS(di, addrhigh),
Arend van Spriele81da652011-12-08 15:06:53 -0800791 di->ddoffsethigh);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200792 } else {
Arend van Spriel3b758a62011-12-12 15:15:09 -0800793 bcma_write32(di->core, DMA64RXREGOFFS(di, addrlow),
Arend van Spriele81da652011-12-08 15:06:53 -0800794 pa + di->ddoffsetlow);
Arend van Spriel3b758a62011-12-12 15:15:09 -0800795 bcma_write32(di->core, DMA64RXREGOFFS(di, addrhigh),
Arend van Spriele81da652011-12-08 15:06:53 -0800796 di->ddoffsethigh);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200797 }
798 } else {
799 /* DMA64 32bits address extension */
800 u32 ae;
801
802 /* shift the high bit(s) from pa to ae */
803 ae = (pa & PCI32ADDR_HIGH) >> PCI32ADDR_HIGH_SHIFT;
804 pa &= ~PCI32ADDR_HIGH;
805
806 if (direction == DMA_TX) {
Arend van Spriel3b758a62011-12-12 15:15:09 -0800807 bcma_write32(di->core, DMA64TXREGOFFS(di, addrlow),
Arend van Spriele81da652011-12-08 15:06:53 -0800808 pa + di->ddoffsetlow);
Arend van Spriel3b758a62011-12-12 15:15:09 -0800809 bcma_write32(di->core, DMA64TXREGOFFS(di, addrhigh),
Arend van Spriele81da652011-12-08 15:06:53 -0800810 di->ddoffsethigh);
Arend van Spriel3b758a62011-12-12 15:15:09 -0800811 bcma_maskset32(di->core, DMA64TXREGOFFS(di, control),
Arend van Spriele81da652011-12-08 15:06:53 -0800812 D64_XC_AE, (ae << D64_XC_AE_SHIFT));
Arend van Spriel5b435de2011-10-05 13:19:03 +0200813 } else {
Arend van Spriel3b758a62011-12-12 15:15:09 -0800814 bcma_write32(di->core, DMA64RXREGOFFS(di, addrlow),
Arend van Spriele81da652011-12-08 15:06:53 -0800815 pa + di->ddoffsetlow);
Arend van Spriel3b758a62011-12-12 15:15:09 -0800816 bcma_write32(di->core, DMA64RXREGOFFS(di, addrhigh),
Arend van Spriele81da652011-12-08 15:06:53 -0800817 di->ddoffsethigh);
Arend van Spriel3b758a62011-12-12 15:15:09 -0800818 bcma_maskset32(di->core, DMA64RXREGOFFS(di, control),
Arend van Spriele81da652011-12-08 15:06:53 -0800819 D64_RC_AE, (ae << D64_RC_AE_SHIFT));
Arend van Spriel5b435de2011-10-05 13:19:03 +0200820 }
821 }
822}
823
824static void _dma_rxenable(struct dma_info *di)
825{
826 uint dmactrlflags = di->dma.dmactrlflags;
827 u32 control;
828
Seth Forshee90123e02012-11-15 08:08:07 -0600829 brcms_dbg_dma(di->core, "%s:\n", di->name);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200830
Arend van Spriel3b758a62011-12-12 15:15:09 -0800831 control = D64_RC_RE | (bcma_read32(di->core,
Arend van Spriele81da652011-12-08 15:06:53 -0800832 DMA64RXREGOFFS(di, control)) &
833 D64_RC_AE);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200834
835 if ((dmactrlflags & DMA_CTRL_PEN) == 0)
836 control |= D64_RC_PD;
837
838 if (dmactrlflags & DMA_CTRL_ROC)
839 control |= D64_RC_OC;
840
Arend van Spriel3b758a62011-12-12 15:15:09 -0800841 bcma_write32(di->core, DMA64RXREGOFFS(di, control),
Arend van Spriel5b435de2011-10-05 13:19:03 +0200842 ((di->rxoffset << D64_RC_RO_SHIFT) | control));
843}
844
845void dma_rxinit(struct dma_pub *pub)
846{
847 struct dma_info *di = (struct dma_info *)pub;
848
Seth Forshee90123e02012-11-15 08:08:07 -0600849 brcms_dbg_dma(di->core, "%s:\n", di->name);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200850
851 if (di->nrxd == 0)
852 return;
853
854 di->rxin = di->rxout = 0;
855
856 /* clear rx descriptor ring */
857 memset(di->rxd64, '\0', di->nrxd * sizeof(struct dma64desc));
858
859 /* DMA engine with out alignment requirement requires table to be inited
860 * before enabling the engine
861 */
862 if (!di->aligndesc_4k)
863 _dma_ddtable_init(di, DMA_RX, di->rxdpa);
864
865 _dma_rxenable(di);
866
867 if (di->aligndesc_4k)
868 _dma_ddtable_init(di, DMA_RX, di->rxdpa);
869}
870
871static struct sk_buff *dma64_getnextrxp(struct dma_info *di, bool forceall)
872{
873 uint i, curr;
874 struct sk_buff *rxp;
875 dma_addr_t pa;
876
877 i = di->rxin;
878
879 /* return if no packets posted */
880 if (i == di->rxout)
881 return NULL;
882
883 curr =
Arend van Spriel3b758a62011-12-12 15:15:09 -0800884 B2I(((bcma_read32(di->core,
Arend van Spriele81da652011-12-08 15:06:53 -0800885 DMA64RXREGOFFS(di, status0)) & D64_RS0_CD_MASK) -
Arend van Spriel5b435de2011-10-05 13:19:03 +0200886 di->rcvptrbase) & D64_RS0_CD_MASK, struct dma64desc);
887
888 /* ignore curr if forceall */
889 if (!forceall && (i == curr))
890 return NULL;
891
892 /* get the packet pointer that corresponds to the rx descriptor */
893 rxp = di->rxp[i];
894 di->rxp[i] = NULL;
895
896 pa = le32_to_cpu(di->rxd64[i].addrlow) - di->dataoffsetlow;
897
898 /* clear this packet from the descriptor ring */
Arend van Spriel2e81b9b2011-12-08 15:06:52 -0800899 dma_unmap_single(di->dmadev, pa, di->rxbufsize, DMA_FROM_DEVICE);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200900
901 di->rxd64[i].addrlow = cpu_to_le32(0xdeadbeef);
902 di->rxd64[i].addrhigh = cpu_to_le32(0xdeadbeef);
903
904 di->rxin = nextrxd(di, i);
905
906 return rxp;
907}
908
909static struct sk_buff *_dma_getnextrxp(struct dma_info *di, bool forceall)
910{
911 if (di->nrxd == 0)
912 return NULL;
913
914 return dma64_getnextrxp(di, forceall);
915}
916
917/*
918 * !! rx entry routine
Arend van Spriel3fd172d2011-10-21 16:16:31 +0200919 * returns the number packages in the next frame, or 0 if there are no more
Arend van Spriel5b435de2011-10-05 13:19:03 +0200920 * if DMA_CTRL_RXMULTI is defined, DMA scattering(multiple buffers) is
921 * supported with pkts chain
922 * otherwise, it's treated as giant pkt and will be tossed.
923 * The DMA scattering starts with normal DMA header, followed by first
924 * buffer data. After it reaches the max size of buffer, the data continues
925 * in next DMA descriptor buffer WITHOUT DMA header
926 */
Arend van Spriel3fd172d2011-10-21 16:16:31 +0200927int dma_rx(struct dma_pub *pub, struct sk_buff_head *skb_list)
Arend van Spriel5b435de2011-10-05 13:19:03 +0200928{
929 struct dma_info *di = (struct dma_info *)pub;
Arend van Spriel3fd172d2011-10-21 16:16:31 +0200930 struct sk_buff_head dma_frames;
931 struct sk_buff *p, *next;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200932 uint len;
933 uint pkt_len;
934 int resid = 0;
Arend van Spriel3fd172d2011-10-21 16:16:31 +0200935 int pktcnt = 1;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200936
Arend van Spriel3fd172d2011-10-21 16:16:31 +0200937 skb_queue_head_init(&dma_frames);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200938 next_frame:
Arend van Spriel3fd172d2011-10-21 16:16:31 +0200939 p = _dma_getnextrxp(di, false);
940 if (p == NULL)
941 return 0;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200942
Arend van Spriel3fd172d2011-10-21 16:16:31 +0200943 len = le16_to_cpu(*(__le16 *) (p->data));
Seth Forshee90123e02012-11-15 08:08:07 -0600944 brcms_dbg_dma(di->core, "%s: dma_rx len %d\n", di->name, len);
Arend van Spriel3fd172d2011-10-21 16:16:31 +0200945 dma_spin_for_len(len, p);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200946
947 /* set actual length */
948 pkt_len = min((di->rxoffset + len), di->rxbufsize);
Arend van Spriel3fd172d2011-10-21 16:16:31 +0200949 __skb_trim(p, pkt_len);
950 skb_queue_tail(&dma_frames, p);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200951 resid = len - (di->rxbufsize - di->rxoffset);
952
953 /* check for single or multi-buffer rx */
954 if (resid > 0) {
Arend van Spriel5b435de2011-10-05 13:19:03 +0200955 while ((resid > 0) && (p = _dma_getnextrxp(di, false))) {
Arend van Spriel5b435de2011-10-05 13:19:03 +0200956 pkt_len = min_t(uint, resid, di->rxbufsize);
957 __skb_trim(p, pkt_len);
Arend van Spriel3fd172d2011-10-21 16:16:31 +0200958 skb_queue_tail(&dma_frames, p);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200959 resid -= di->rxbufsize;
Arend van Spriel3fd172d2011-10-21 16:16:31 +0200960 pktcnt++;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200961 }
962
Joe Perches8ae74652012-01-15 00:38:38 -0800963#ifdef DEBUG
Arend van Spriel5b435de2011-10-05 13:19:03 +0200964 if (resid > 0) {
965 uint cur;
966 cur =
Arend van Spriel3b758a62011-12-12 15:15:09 -0800967 B2I(((bcma_read32(di->core,
Arend van Spriele81da652011-12-08 15:06:53 -0800968 DMA64RXREGOFFS(di, status0)) &
969 D64_RS0_CD_MASK) - di->rcvptrbase) &
970 D64_RS0_CD_MASK, struct dma64desc);
Seth Forshee90123e02012-11-15 08:08:07 -0600971 brcms_dbg_dma(di->core,
972 "rxin %d rxout %d, hw_curr %d\n",
973 di->rxin, di->rxout, cur);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200974 }
Joe Perches8ae74652012-01-15 00:38:38 -0800975#endif /* DEBUG */
Arend van Spriel5b435de2011-10-05 13:19:03 +0200976
977 if ((di->dma.dmactrlflags & DMA_CTRL_RXMULTI) == 0) {
Seth Forshee90123e02012-11-15 08:08:07 -0600978 brcms_dbg_dma(di->core, "%s: bad frame length (%d)\n",
979 di->name, len);
Arend van Spriel3fd172d2011-10-21 16:16:31 +0200980 skb_queue_walk_safe(&dma_frames, p, next) {
981 skb_unlink(p, &dma_frames);
982 brcmu_pkt_buf_free_skb(p);
983 }
Arend van Spriel5b435de2011-10-05 13:19:03 +0200984 di->dma.rxgiants++;
Arend van Spriel3fd172d2011-10-21 16:16:31 +0200985 pktcnt = 1;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200986 goto next_frame;
987 }
988 }
989
Arend van Spriel3fd172d2011-10-21 16:16:31 +0200990 skb_queue_splice_tail(&dma_frames, skb_list);
991 return pktcnt;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200992}
993
994static bool dma64_rxidle(struct dma_info *di)
995{
Seth Forshee90123e02012-11-15 08:08:07 -0600996 brcms_dbg_dma(di->core, "%s:\n", di->name);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200997
998 if (di->nrxd == 0)
999 return true;
1000
Arend van Spriel3b758a62011-12-12 15:15:09 -08001001 return ((bcma_read32(di->core,
Arend van Spriele81da652011-12-08 15:06:53 -08001002 DMA64RXREGOFFS(di, status0)) & D64_RS0_CD_MASK) ==
Arend van Spriel3b758a62011-12-12 15:15:09 -08001003 (bcma_read32(di->core, DMA64RXREGOFFS(di, ptr)) &
Arend van Spriele81da652011-12-08 15:06:53 -08001004 D64_RS0_CD_MASK));
Arend van Spriel5b435de2011-10-05 13:19:03 +02001005}
1006
Seth Forsheee041f652012-11-15 08:07:56 -06001007static bool dma64_txidle(struct dma_info *di)
1008{
1009 if (di->ntxd == 0)
1010 return true;
1011
1012 return ((bcma_read32(di->core,
1013 DMA64TXREGOFFS(di, status0)) & D64_XS0_CD_MASK) ==
1014 (bcma_read32(di->core, DMA64TXREGOFFS(di, ptr)) &
1015 D64_XS0_CD_MASK));
1016}
1017
Arend van Spriel5b435de2011-10-05 13:19:03 +02001018/*
1019 * post receive buffers
1020 * return false is refill failed completely and ring is empty this will stall
1021 * the rx dma and user might want to call rxfill again asap. This unlikely
1022 * happens on memory-rich NIC, but often on memory-constrained dongle
1023 */
1024bool dma_rxfill(struct dma_pub *pub)
1025{
1026 struct dma_info *di = (struct dma_info *)pub;
1027 struct sk_buff *p;
1028 u16 rxin, rxout;
1029 u32 flags = 0;
1030 uint n;
1031 uint i;
1032 dma_addr_t pa;
1033 uint extra_offset = 0;
1034 bool ring_empty;
1035
1036 ring_empty = false;
1037
1038 /*
1039 * Determine how many receive buffers we're lacking
1040 * from the full complement, allocate, initialize,
1041 * and post them, then update the chip rx lastdscr.
1042 */
1043
1044 rxin = di->rxin;
1045 rxout = di->rxout;
1046
1047 n = di->nrxpost - nrxdactive(di, rxin, rxout);
1048
Seth Forshee90123e02012-11-15 08:08:07 -06001049 brcms_dbg_dma(di->core, "%s: post %d\n", di->name, n);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001050
1051 if (di->rxbufsize > BCMEXTRAHDROOM)
1052 extra_offset = di->rxextrahdrroom;
1053
1054 for (i = 0; i < n; i++) {
1055 /*
1056 * the di->rxbufsize doesn't include the extra headroom,
1057 * we need to add it to the size to be allocated
1058 */
1059 p = brcmu_pkt_buf_get_skb(di->rxbufsize + extra_offset);
1060
1061 if (p == NULL) {
Seth Forshee90123e02012-11-15 08:08:07 -06001062 brcms_dbg_dma(di->core, "%s: out of rxbufs\n",
1063 di->name);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001064 if (i == 0 && dma64_rxidle(di)) {
Seth Forshee90123e02012-11-15 08:08:07 -06001065 brcms_dbg_dma(di->core, "%s: ring is empty !\n",
1066 di->name);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001067 ring_empty = true;
1068 }
1069 di->dma.rxnobuf++;
1070 break;
1071 }
1072 /* reserve an extra headroom, if applicable */
1073 if (extra_offset)
1074 skb_pull(p, extra_offset);
1075
1076 /* Do a cached write instead of uncached write since DMA_MAP
1077 * will flush the cache.
1078 */
1079 *(u32 *) (p->data) = 0;
1080
Arend van Spriel2e81b9b2011-12-08 15:06:52 -08001081 pa = dma_map_single(di->dmadev, p->data, di->rxbufsize,
1082 DMA_FROM_DEVICE);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001083
1084 /* save the free packet pointer */
1085 di->rxp[rxout] = p;
1086
1087 /* reset flags for each descriptor */
1088 flags = 0;
1089 if (rxout == (di->nrxd - 1))
1090 flags = D64_CTRL1_EOT;
1091
1092 dma64_dd_upd(di, di->rxd64, pa, rxout, &flags,
1093 di->rxbufsize);
1094 rxout = nextrxd(di, rxout);
1095 }
1096
1097 di->rxout = rxout;
1098
1099 /* update the chip lastdscr pointer */
Arend van Spriel3b758a62011-12-12 15:15:09 -08001100 bcma_write32(di->core, DMA64RXREGOFFS(di, ptr),
Arend van Spriel5b435de2011-10-05 13:19:03 +02001101 di->rcvptrbase + I2B(rxout, struct dma64desc));
1102
1103 return ring_empty;
1104}
1105
1106void dma_rxreclaim(struct dma_pub *pub)
1107{
1108 struct dma_info *di = (struct dma_info *)pub;
1109 struct sk_buff *p;
1110
Seth Forshee90123e02012-11-15 08:08:07 -06001111 brcms_dbg_dma(di->core, "%s:\n", di->name);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001112
1113 while ((p = _dma_getnextrxp(di, true)))
1114 brcmu_pkt_buf_free_skb(p);
1115}
1116
1117void dma_counterreset(struct dma_pub *pub)
1118{
1119 /* reset all software counters */
1120 pub->rxgiants = 0;
1121 pub->rxnobuf = 0;
1122 pub->txnobuf = 0;
1123}
1124
1125/* get the address of the var in order to change later */
1126unsigned long dma_getvar(struct dma_pub *pub, const char *name)
1127{
1128 struct dma_info *di = (struct dma_info *)pub;
1129
1130 if (!strcmp(name, "&txavail"))
1131 return (unsigned long)&(di->dma.txavail);
1132 return 0;
1133}
1134
1135/* 64-bit DMA functions */
1136
1137void dma_txinit(struct dma_pub *pub)
1138{
1139 struct dma_info *di = (struct dma_info *)pub;
1140 u32 control = D64_XC_XE;
1141
Seth Forshee90123e02012-11-15 08:08:07 -06001142 brcms_dbg_dma(di->core, "%s:\n", di->name);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001143
1144 if (di->ntxd == 0)
1145 return;
1146
1147 di->txin = di->txout = 0;
1148 di->dma.txavail = di->ntxd - 1;
1149
1150 /* clear tx descriptor ring */
1151 memset(di->txd64, '\0', (di->ntxd * sizeof(struct dma64desc)));
1152
1153 /* DMA engine with out alignment requirement requires table to be inited
1154 * before enabling the engine
1155 */
1156 if (!di->aligndesc_4k)
1157 _dma_ddtable_init(di, DMA_TX, di->txdpa);
1158
1159 if ((di->dma.dmactrlflags & DMA_CTRL_PEN) == 0)
1160 control |= D64_XC_PD;
Arend van Spriel3b758a62011-12-12 15:15:09 -08001161 bcma_set32(di->core, DMA64TXREGOFFS(di, control), control);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001162
1163 /* DMA engine with alignment requirement requires table to be inited
1164 * before enabling the engine
1165 */
1166 if (di->aligndesc_4k)
1167 _dma_ddtable_init(di, DMA_TX, di->txdpa);
1168}
1169
1170void dma_txsuspend(struct dma_pub *pub)
1171{
1172 struct dma_info *di = (struct dma_info *)pub;
1173
Seth Forshee90123e02012-11-15 08:08:07 -06001174 brcms_dbg_dma(di->core, "%s:\n", di->name);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001175
1176 if (di->ntxd == 0)
1177 return;
1178
Arend van Spriel3b758a62011-12-12 15:15:09 -08001179 bcma_set32(di->core, DMA64TXREGOFFS(di, control), D64_XC_SE);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001180}
1181
1182void dma_txresume(struct dma_pub *pub)
1183{
1184 struct dma_info *di = (struct dma_info *)pub;
1185
Seth Forshee90123e02012-11-15 08:08:07 -06001186 brcms_dbg_dma(di->core, "%s:\n", di->name);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001187
1188 if (di->ntxd == 0)
1189 return;
1190
Arend van Spriel3b758a62011-12-12 15:15:09 -08001191 bcma_mask32(di->core, DMA64TXREGOFFS(di, control), ~D64_XC_SE);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001192}
1193
1194bool dma_txsuspended(struct dma_pub *pub)
1195{
1196 struct dma_info *di = (struct dma_info *)pub;
1197
1198 return (di->ntxd == 0) ||
Arend van Spriel3b758a62011-12-12 15:15:09 -08001199 ((bcma_read32(di->core,
Arend van Spriele81da652011-12-08 15:06:53 -08001200 DMA64TXREGOFFS(di, control)) & D64_XC_SE) ==
1201 D64_XC_SE);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001202}
1203
1204void dma_txreclaim(struct dma_pub *pub, enum txd_range range)
1205{
1206 struct dma_info *di = (struct dma_info *)pub;
1207 struct sk_buff *p;
1208
Seth Forshee90123e02012-11-15 08:08:07 -06001209 brcms_dbg_dma(di->core, "%s: %s\n",
1210 di->name,
1211 range == DMA_RANGE_ALL ? "all" :
1212 range == DMA_RANGE_TRANSMITTED ? "transmitted" :
1213 "transferred");
Arend van Spriel5b435de2011-10-05 13:19:03 +02001214
1215 if (di->txin == di->txout)
1216 return;
1217
1218 while ((p = dma_getnexttxp(pub, range))) {
1219 /* For unframed data, we don't have any packets to free */
1220 if (!(di->dma.dmactrlflags & DMA_CTRL_UNFRAMED))
1221 brcmu_pkt_buf_free_skb(p);
1222 }
1223}
1224
1225bool dma_txreset(struct dma_pub *pub)
1226{
1227 struct dma_info *di = (struct dma_info *)pub;
1228 u32 status;
1229
1230 if (di->ntxd == 0)
1231 return true;
1232
1233 /* suspend tx DMA first */
Arend van Spriel3b758a62011-12-12 15:15:09 -08001234 bcma_write32(di->core, DMA64TXREGOFFS(di, control), D64_XC_SE);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001235 SPINWAIT(((status =
Arend van Spriel3b758a62011-12-12 15:15:09 -08001236 (bcma_read32(di->core, DMA64TXREGOFFS(di, status0)) &
Arend van Spriele81da652011-12-08 15:06:53 -08001237 D64_XS0_XS_MASK)) != D64_XS0_XS_DISABLED) &&
1238 (status != D64_XS0_XS_IDLE) && (status != D64_XS0_XS_STOPPED),
1239 10000);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001240
Arend van Spriel3b758a62011-12-12 15:15:09 -08001241 bcma_write32(di->core, DMA64TXREGOFFS(di, control), 0);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001242 SPINWAIT(((status =
Arend van Spriel3b758a62011-12-12 15:15:09 -08001243 (bcma_read32(di->core, DMA64TXREGOFFS(di, status0)) &
Arend van Spriele81da652011-12-08 15:06:53 -08001244 D64_XS0_XS_MASK)) != D64_XS0_XS_DISABLED), 10000);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001245
1246 /* wait for the last transaction to complete */
1247 udelay(300);
1248
1249 return status == D64_XS0_XS_DISABLED;
1250}
1251
1252bool dma_rxreset(struct dma_pub *pub)
1253{
1254 struct dma_info *di = (struct dma_info *)pub;
1255 u32 status;
1256
1257 if (di->nrxd == 0)
1258 return true;
1259
Arend van Spriel3b758a62011-12-12 15:15:09 -08001260 bcma_write32(di->core, DMA64RXREGOFFS(di, control), 0);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001261 SPINWAIT(((status =
Arend van Spriel3b758a62011-12-12 15:15:09 -08001262 (bcma_read32(di->core, DMA64RXREGOFFS(di, status0)) &
Arend van Spriele81da652011-12-08 15:06:53 -08001263 D64_RS0_RS_MASK)) != D64_RS0_RS_DISABLED), 10000);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001264
1265 return status == D64_RS0_RS_DISABLED;
1266}
1267
Seth Forsheee041f652012-11-15 08:07:56 -06001268static void dma_txenq(struct dma_info *di, struct sk_buff *p)
Seth Forshee05f8a612012-11-15 08:07:53 -06001269{
Arend van Spriel5b435de2011-10-05 13:19:03 +02001270 unsigned char *data;
1271 uint len;
1272 u16 txout;
1273 u32 flags = 0;
1274 dma_addr_t pa;
1275
Arend van Spriel5b435de2011-10-05 13:19:03 +02001276 txout = di->txout;
1277
Seth Forsheee041f652012-11-15 08:07:56 -06001278 if (WARN_ON(nexttxd(di, txout) == di->txin))
1279 return;
1280
Arend van Spriel5b435de2011-10-05 13:19:03 +02001281 /*
Arend van Spriel30307942011-11-22 17:21:37 -08001282 * obtain and initialize transmit descriptor entry.
Arend van Spriel5b435de2011-10-05 13:19:03 +02001283 */
Arend van Spriel30307942011-11-22 17:21:37 -08001284 data = p->data;
1285 len = p->len;
Arend van Spriel5b435de2011-10-05 13:19:03 +02001286
Arend van Spriel30307942011-11-22 17:21:37 -08001287 /* get physical address of buffer start */
Arend van Spriel2e81b9b2011-12-08 15:06:52 -08001288 pa = dma_map_single(di->dmadev, data, len, DMA_TO_DEVICE);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001289
Arend van Spriel30307942011-11-22 17:21:37 -08001290 /* With a DMA segment list, Descriptor table is filled
1291 * using the segment list instead of looping over
1292 * buffers in multi-chain DMA. Therefore, EOF for SGLIST
1293 * is when end of segment list is reached.
1294 */
1295 flags = D64_CTRL1_SOF | D64_CTRL1_IOC | D64_CTRL1_EOF;
1296 if (txout == (di->ntxd - 1))
1297 flags |= D64_CTRL1_EOT;
Arend van Spriel5b435de2011-10-05 13:19:03 +02001298
Arend van Spriel30307942011-11-22 17:21:37 -08001299 dma64_dd_upd(di, di->txd64, pa, txout, &flags, len);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001300
Arend van Spriel30307942011-11-22 17:21:37 -08001301 txout = nexttxd(di, txout);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001302
1303 /* save the packet */
Arend van Spriel30307942011-11-22 17:21:37 -08001304 di->txp[prevtxd(di, txout)] = p;
Arend van Spriel5b435de2011-10-05 13:19:03 +02001305
1306 /* bump the tx descriptor index */
1307 di->txout = txout;
Seth Forsheee041f652012-11-15 08:07:56 -06001308}
Arend van Spriel5b435de2011-10-05 13:19:03 +02001309
Seth Forsheee041f652012-11-15 08:07:56 -06001310static void ampdu_finalize(struct dma_info *di)
1311{
1312 struct brcms_ampdu_session *session = &di->ampdu_session;
1313 struct sk_buff *p;
1314
Seth Forshee0c9a0a12012-11-15 08:08:11 -06001315 trace_brcms_ampdu_session(&session->wlc->hw->d11core->dev,
1316 session->max_ampdu_len,
1317 session->max_ampdu_frames,
1318 session->ampdu_len,
1319 skb_queue_len(&session->skb_list),
1320 session->dma_len);
1321
Seth Forsheee041f652012-11-15 08:07:56 -06001322 if (WARN_ON(skb_queue_empty(&session->skb_list)))
1323 return;
1324
1325 brcms_c_ampdu_finalize(session);
1326
1327 while (!skb_queue_empty(&session->skb_list)) {
1328 p = skb_dequeue(&session->skb_list);
1329 dma_txenq(di, p);
1330 }
1331
1332 bcma_write32(di->core, DMA64TXREGOFFS(di, ptr),
1333 di->xmtptrbase + I2B(di->txout, struct dma64desc));
1334 brcms_c_ampdu_reset_session(session, session->wlc);
1335}
1336
1337static void prep_ampdu_frame(struct dma_info *di, struct sk_buff *p)
1338{
1339 struct brcms_ampdu_session *session = &di->ampdu_session;
1340 int ret;
1341
1342 ret = brcms_c_ampdu_add_frame(session, p);
1343 if (ret == -ENOSPC) {
1344 /*
1345 * AMPDU cannot accomodate this frame. Close out the in-
1346 * progress AMPDU session and start a new one.
1347 */
1348 ampdu_finalize(di);
1349 ret = brcms_c_ampdu_add_frame(session, p);
1350 }
1351
1352 WARN_ON(ret);
1353}
1354
1355/* Update count of available tx descriptors based on current DMA state */
1356static void dma_update_txavail(struct dma_info *di)
1357{
1358 /*
1359 * Available space is number of descriptors less the number of
1360 * active descriptors and the number of queued AMPDU frames.
1361 */
1362 di->dma.txavail = di->ntxd - ntxdactive(di, di->txin, di->txout) -
1363 skb_queue_len(&di->ampdu_session.skb_list) - 1;
1364}
1365
1366/*
1367 * !! tx entry routine
1368 * WARNING: call must check the return value for error.
1369 * the error(toss frames) could be fatal and cause many subsequent hard
1370 * to debug problems
1371 */
1372int dma_txfast(struct brcms_c_info *wlc, struct dma_pub *pub,
1373 struct sk_buff *p)
1374{
1375 struct dma_info *di = (struct dma_info *)pub;
1376 struct brcms_ampdu_session *session = &di->ampdu_session;
1377 struct ieee80211_tx_info *tx_info;
1378 bool is_ampdu;
1379
Seth Forsheee041f652012-11-15 08:07:56 -06001380 /* no use to transmit a zero length packet */
1381 if (p->len == 0)
1382 return 0;
1383
1384 /* return nonzero if out of tx descriptors */
1385 if (di->dma.txavail == 0 || nexttxd(di, di->txout) == di->txin)
1386 goto outoftxd;
1387
1388 tx_info = IEEE80211_SKB_CB(p);
1389 is_ampdu = tx_info->flags & IEEE80211_TX_CTL_AMPDU;
1390 if (is_ampdu)
1391 prep_ampdu_frame(di, p);
1392 else
1393 dma_txenq(di, p);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001394
1395 /* tx flow control */
Seth Forshee05f8a612012-11-15 08:07:53 -06001396 dma_update_txavail(di);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001397
Seth Forsheee041f652012-11-15 08:07:56 -06001398 /* kick the chip */
1399 if (is_ampdu) {
1400 /*
1401 * Start sending data if we've got a full AMPDU, there's
1402 * no more space in the DMA ring, or the ring isn't
1403 * currently transmitting.
1404 */
1405 if (skb_queue_len(&session->skb_list) == session->max_ampdu_frames ||
1406 di->dma.txavail == 0 || dma64_txidle(di))
1407 ampdu_finalize(di);
1408 } else {
1409 bcma_write32(di->core, DMA64TXREGOFFS(di, ptr),
1410 di->xmtptrbase + I2B(di->txout, struct dma64desc));
1411 }
1412
Arend van Spriel5b435de2011-10-05 13:19:03 +02001413 return 0;
1414
1415 outoftxd:
Seth Forshee90123e02012-11-15 08:08:07 -06001416 brcms_dbg_dma(di->core, "%s: out of txds !!!\n", di->name);
Arend van Spriel30307942011-11-22 17:21:37 -08001417 brcmu_pkt_buf_free_skb(p);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001418 di->dma.txavail = 0;
1419 di->dma.txnobuf++;
Seth Forsheee041f652012-11-15 08:07:56 -06001420 return -ENOSPC;
1421}
1422
1423void dma_txflush(struct dma_pub *pub)
1424{
1425 struct dma_info *di = (struct dma_info *)pub;
1426 struct brcms_ampdu_session *session = &di->ampdu_session;
1427
1428 if (!skb_queue_empty(&session->skb_list))
1429 ampdu_finalize(di);
1430}
1431
1432int dma_txpending(struct dma_pub *pub)
1433{
1434 struct dma_info *di = (struct dma_info *)pub;
1435 return ntxdactive(di, di->txin, di->txout);
1436}
1437
1438/*
1439 * If we have an active AMPDU session and are not transmitting,
1440 * this function will force tx to start.
1441 */
1442void dma_kick_tx(struct dma_pub *pub)
1443{
1444 struct dma_info *di = (struct dma_info *)pub;
1445 struct brcms_ampdu_session *session = &di->ampdu_session;
1446
1447 if (!skb_queue_empty(&session->skb_list) && dma64_txidle(di))
1448 ampdu_finalize(di);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001449}
1450
1451/*
1452 * Reclaim next completed txd (txds if using chained buffers) in the range
1453 * specified and return associated packet.
1454 * If range is DMA_RANGE_TRANSMITTED, reclaim descriptors that have be
1455 * transmitted as noted by the hardware "CurrDescr" pointer.
1456 * If range is DMA_RANGE_TRANSFERED, reclaim descriptors that have be
1457 * transferred by the DMA as noted by the hardware "ActiveDescr" pointer.
1458 * If range is DMA_RANGE_ALL, reclaim all txd(s) posted to the ring and
1459 * return associated packet regardless of the value of hardware pointers.
1460 */
1461struct sk_buff *dma_getnexttxp(struct dma_pub *pub, enum txd_range range)
1462{
1463 struct dma_info *di = (struct dma_info *)pub;
1464 u16 start, end, i;
1465 u16 active_desc;
1466 struct sk_buff *txp;
1467
Seth Forshee90123e02012-11-15 08:08:07 -06001468 brcms_dbg_dma(di->core, "%s: %s\n",
1469 di->name,
1470 range == DMA_RANGE_ALL ? "all" :
1471 range == DMA_RANGE_TRANSMITTED ? "transmitted" :
1472 "transferred");
Arend van Spriel5b435de2011-10-05 13:19:03 +02001473
1474 if (di->ntxd == 0)
1475 return NULL;
1476
1477 txp = NULL;
1478
1479 start = di->txin;
1480 if (range == DMA_RANGE_ALL)
1481 end = di->txout;
1482 else {
Arend van Spriel3b758a62011-12-12 15:15:09 -08001483 end = (u16) (B2I(((bcma_read32(di->core,
Arend van Spriele81da652011-12-08 15:06:53 -08001484 DMA64TXREGOFFS(di, status0)) &
1485 D64_XS0_CD_MASK) - di->xmtptrbase) &
1486 D64_XS0_CD_MASK, struct dma64desc));
Arend van Spriel5b435de2011-10-05 13:19:03 +02001487
1488 if (range == DMA_RANGE_TRANSFERED) {
1489 active_desc =
Arend van Spriel3b758a62011-12-12 15:15:09 -08001490 (u16)(bcma_read32(di->core,
Arend van Spriele81da652011-12-08 15:06:53 -08001491 DMA64TXREGOFFS(di, status1)) &
Arend van Spriel5b435de2011-10-05 13:19:03 +02001492 D64_XS1_AD_MASK);
1493 active_desc =
1494 (active_desc - di->xmtptrbase) & D64_XS0_CD_MASK;
1495 active_desc = B2I(active_desc, struct dma64desc);
1496 if (end != active_desc)
1497 end = prevtxd(di, active_desc);
1498 }
1499 }
1500
1501 if ((start == 0) && (end > di->txout))
1502 goto bogus;
1503
1504 for (i = start; i != end && !txp; i = nexttxd(di, i)) {
1505 dma_addr_t pa;
1506 uint size;
1507
1508 pa = le32_to_cpu(di->txd64[i].addrlow) - di->dataoffsetlow;
1509
1510 size =
1511 (le32_to_cpu(di->txd64[i].ctrl2) &
1512 D64_CTRL2_BC_MASK);
1513
1514 di->txd64[i].addrlow = cpu_to_le32(0xdeadbeef);
1515 di->txd64[i].addrhigh = cpu_to_le32(0xdeadbeef);
1516
1517 txp = di->txp[i];
1518 di->txp[i] = NULL;
1519
Arend van Spriel2e81b9b2011-12-08 15:06:52 -08001520 dma_unmap_single(di->dmadev, pa, size, DMA_TO_DEVICE);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001521 }
1522
1523 di->txin = i;
1524
1525 /* tx flow control */
Seth Forshee05f8a612012-11-15 08:07:53 -06001526 dma_update_txavail(di);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001527
1528 return txp;
1529
1530 bogus:
Seth Forshee90123e02012-11-15 08:08:07 -06001531 brcms_dbg_dma(di->core, "bogus curr: start %d end %d txout %d\n",
1532 start, end, di->txout);
Arend van Spriel5b435de2011-10-05 13:19:03 +02001533 return NULL;
1534}
1535
1536/*
1537 * Mac80211 initiated actions sometimes require packets in the DMA queue to be
1538 * modified. The modified portion of the packet is not under control of the DMA
1539 * engine. This function calls a caller-supplied function for each packet in
1540 * the caller specified dma chain.
1541 */
1542void dma_walk_packets(struct dma_pub *dmah, void (*callback_fnc)
1543 (void *pkt, void *arg_a), void *arg_a)
1544{
1545 struct dma_info *di = (struct dma_info *) dmah;
1546 uint i = di->txin;
1547 uint end = di->txout;
1548 struct sk_buff *skb;
1549 struct ieee80211_tx_info *tx_info;
1550
1551 while (i != end) {
Joe Perches2c208892012-06-04 12:44:17 +00001552 skb = di->txp[i];
Arend van Spriel5b435de2011-10-05 13:19:03 +02001553 if (skb != NULL) {
1554 tx_info = (struct ieee80211_tx_info *)skb->cb;
1555 (callback_fnc)(tx_info, arg_a);
1556 }
1557 i = nexttxd(di, i);
1558 }
1559}