dma.c 36 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456
  1. /*
  2. Broadcom B43legacy wireless driver
  3. DMA ringbuffer and descriptor allocation/management
  4. Copyright (c) 2005, 2006 Michael Buesch <m@bues.ch>
  5. Some code in this file is derived from the b44.c driver
  6. Copyright (C) 2002 David S. Miller
  7. Copyright (C) Pekka Pietikainen
  8. This program is free software; you can redistribute it and/or modify
  9. it under the terms of the GNU General Public License as published by
  10. the Free Software Foundation; either version 2 of the License, or
  11. (at your option) any later version.
  12. This program is distributed in the hope that it will be useful,
  13. but WITHOUT ANY WARRANTY; without even the implied warranty of
  14. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  15. GNU General Public License for more details.
  16. You should have received a copy of the GNU General Public License
  17. along with this program; see the file COPYING. If not, write to
  18. the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor,
  19. Boston, MA 02110-1301, USA.
  20. */
  21. #include "b43legacy.h"
  22. #include "dma.h"
  23. #include "main.h"
  24. #include "debugfs.h"
  25. #include "xmit.h"
  26. #include <linux/dma-mapping.h>
  27. #include <linux/pci.h>
  28. #include <linux/delay.h>
  29. #include <linux/skbuff.h>
  30. #include <linux/slab.h>
  31. #include <net/dst.h>
  32. /* 32bit DMA ops. */
  33. static
  34. struct b43legacy_dmadesc32 *op32_idx2desc(struct b43legacy_dmaring *ring,
  35. int slot,
  36. struct b43legacy_dmadesc_meta **meta)
  37. {
  38. struct b43legacy_dmadesc32 *desc;
  39. *meta = &(ring->meta[slot]);
  40. desc = ring->descbase;
  41. desc = &(desc[slot]);
  42. return (struct b43legacy_dmadesc32 *)desc;
  43. }
  44. static void op32_fill_descriptor(struct b43legacy_dmaring *ring,
  45. struct b43legacy_dmadesc32 *desc,
  46. dma_addr_t dmaaddr, u16 bufsize,
  47. int start, int end, int irq)
  48. {
  49. struct b43legacy_dmadesc32 *descbase = ring->descbase;
  50. int slot;
  51. u32 ctl;
  52. u32 addr;
  53. u32 addrext;
  54. slot = (int)(desc - descbase);
  55. B43legacy_WARN_ON(!(slot >= 0 && slot < ring->nr_slots));
  56. addr = (u32)(dmaaddr & ~SSB_DMA_TRANSLATION_MASK);
  57. addrext = (u32)(dmaaddr & SSB_DMA_TRANSLATION_MASK)
  58. >> SSB_DMA_TRANSLATION_SHIFT;
  59. addr |= ring->dev->dma.translation;
  60. ctl = (bufsize - ring->frameoffset)
  61. & B43legacy_DMA32_DCTL_BYTECNT;
  62. if (slot == ring->nr_slots - 1)
  63. ctl |= B43legacy_DMA32_DCTL_DTABLEEND;
  64. if (start)
  65. ctl |= B43legacy_DMA32_DCTL_FRAMESTART;
  66. if (end)
  67. ctl |= B43legacy_DMA32_DCTL_FRAMEEND;
  68. if (irq)
  69. ctl |= B43legacy_DMA32_DCTL_IRQ;
  70. ctl |= (addrext << B43legacy_DMA32_DCTL_ADDREXT_SHIFT)
  71. & B43legacy_DMA32_DCTL_ADDREXT_MASK;
  72. desc->control = cpu_to_le32(ctl);
  73. desc->address = cpu_to_le32(addr);
  74. }
  75. static void op32_poke_tx(struct b43legacy_dmaring *ring, int slot)
  76. {
  77. b43legacy_dma_write(ring, B43legacy_DMA32_TXINDEX,
  78. (u32)(slot * sizeof(struct b43legacy_dmadesc32)));
  79. }
  80. static void op32_tx_suspend(struct b43legacy_dmaring *ring)
  81. {
  82. b43legacy_dma_write(ring, B43legacy_DMA32_TXCTL,
  83. b43legacy_dma_read(ring, B43legacy_DMA32_TXCTL)
  84. | B43legacy_DMA32_TXSUSPEND);
  85. }
  86. static void op32_tx_resume(struct b43legacy_dmaring *ring)
  87. {
  88. b43legacy_dma_write(ring, B43legacy_DMA32_TXCTL,
  89. b43legacy_dma_read(ring, B43legacy_DMA32_TXCTL)
  90. & ~B43legacy_DMA32_TXSUSPEND);
  91. }
  92. static int op32_get_current_rxslot(struct b43legacy_dmaring *ring)
  93. {
  94. u32 val;
  95. val = b43legacy_dma_read(ring, B43legacy_DMA32_RXSTATUS);
  96. val &= B43legacy_DMA32_RXDPTR;
  97. return (val / sizeof(struct b43legacy_dmadesc32));
  98. }
  99. static void op32_set_current_rxslot(struct b43legacy_dmaring *ring,
  100. int slot)
  101. {
  102. b43legacy_dma_write(ring, B43legacy_DMA32_RXINDEX,
  103. (u32)(slot * sizeof(struct b43legacy_dmadesc32)));
  104. }
  105. static inline int free_slots(struct b43legacy_dmaring *ring)
  106. {
  107. return (ring->nr_slots - ring->used_slots);
  108. }
  109. static inline int next_slot(struct b43legacy_dmaring *ring, int slot)
  110. {
  111. B43legacy_WARN_ON(!(slot >= -1 && slot <= ring->nr_slots - 1));
  112. if (slot == ring->nr_slots - 1)
  113. return 0;
  114. return slot + 1;
  115. }
  116. static inline int prev_slot(struct b43legacy_dmaring *ring, int slot)
  117. {
  118. B43legacy_WARN_ON(!(slot >= 0 && slot <= ring->nr_slots - 1));
  119. if (slot == 0)
  120. return ring->nr_slots - 1;
  121. return slot - 1;
  122. }
  123. #ifdef CONFIG_B43LEGACY_DEBUG
  124. static void update_max_used_slots(struct b43legacy_dmaring *ring,
  125. int current_used_slots)
  126. {
  127. if (current_used_slots <= ring->max_used_slots)
  128. return;
  129. ring->max_used_slots = current_used_slots;
  130. if (b43legacy_debug(ring->dev, B43legacy_DBG_DMAVERBOSE))
  131. b43legacydbg(ring->dev->wl,
  132. "max_used_slots increased to %d on %s ring %d\n",
  133. ring->max_used_slots,
  134. ring->tx ? "TX" : "RX",
  135. ring->index);
  136. }
  137. #else
  138. static inline
  139. void update_max_used_slots(struct b43legacy_dmaring *ring,
  140. int current_used_slots)
  141. { }
  142. #endif /* DEBUG */
  143. /* Request a slot for usage. */
  144. static inline
  145. int request_slot(struct b43legacy_dmaring *ring)
  146. {
  147. int slot;
  148. B43legacy_WARN_ON(!ring->tx);
  149. B43legacy_WARN_ON(ring->stopped);
  150. B43legacy_WARN_ON(free_slots(ring) == 0);
  151. slot = next_slot(ring, ring->current_slot);
  152. ring->current_slot = slot;
  153. ring->used_slots++;
  154. update_max_used_slots(ring, ring->used_slots);
  155. return slot;
  156. }
  157. /* Mac80211-queue to b43legacy-ring mapping */
  158. static struct b43legacy_dmaring *priority_to_txring(
  159. struct b43legacy_wldev *dev,
  160. int queue_priority)
  161. {
  162. struct b43legacy_dmaring *ring;
  163. /*FIXME: For now we always run on TX-ring-1 */
  164. return dev->dma.tx_ring1;
  165. /* 0 = highest priority */
  166. switch (queue_priority) {
  167. default:
  168. B43legacy_WARN_ON(1);
  169. /* fallthrough */
  170. case 0:
  171. ring = dev->dma.tx_ring3;
  172. break;
  173. case 1:
  174. ring = dev->dma.tx_ring2;
  175. break;
  176. case 2:
  177. ring = dev->dma.tx_ring1;
  178. break;
  179. case 3:
  180. ring = dev->dma.tx_ring0;
  181. break;
  182. case 4:
  183. ring = dev->dma.tx_ring4;
  184. break;
  185. case 5:
  186. ring = dev->dma.tx_ring5;
  187. break;
  188. }
  189. return ring;
  190. }
  191. /* Bcm4301-ring to mac80211-queue mapping */
  192. static inline int txring_to_priority(struct b43legacy_dmaring *ring)
  193. {
  194. static const u8 idx_to_prio[] =
  195. { 3, 2, 1, 0, 4, 5, };
  196. /*FIXME: have only one queue, for now */
  197. return 0;
  198. return idx_to_prio[ring->index];
  199. }
  200. static u16 b43legacy_dmacontroller_base(enum b43legacy_dmatype type,
  201. int controller_idx)
  202. {
  203. static const u16 map32[] = {
  204. B43legacy_MMIO_DMA32_BASE0,
  205. B43legacy_MMIO_DMA32_BASE1,
  206. B43legacy_MMIO_DMA32_BASE2,
  207. B43legacy_MMIO_DMA32_BASE3,
  208. B43legacy_MMIO_DMA32_BASE4,
  209. B43legacy_MMIO_DMA32_BASE5,
  210. };
  211. B43legacy_WARN_ON(!(controller_idx >= 0 &&
  212. controller_idx < ARRAY_SIZE(map32)));
  213. return map32[controller_idx];
  214. }
  215. static inline
  216. dma_addr_t map_descbuffer(struct b43legacy_dmaring *ring,
  217. unsigned char *buf,
  218. size_t len,
  219. int tx)
  220. {
  221. dma_addr_t dmaaddr;
  222. if (tx)
  223. dmaaddr = dma_map_single(ring->dev->dev->dma_dev,
  224. buf, len,
  225. DMA_TO_DEVICE);
  226. else
  227. dmaaddr = dma_map_single(ring->dev->dev->dma_dev,
  228. buf, len,
  229. DMA_FROM_DEVICE);
  230. return dmaaddr;
  231. }
  232. static inline
  233. void unmap_descbuffer(struct b43legacy_dmaring *ring,
  234. dma_addr_t addr,
  235. size_t len,
  236. int tx)
  237. {
  238. if (tx)
  239. dma_unmap_single(ring->dev->dev->dma_dev,
  240. addr, len,
  241. DMA_TO_DEVICE);
  242. else
  243. dma_unmap_single(ring->dev->dev->dma_dev,
  244. addr, len,
  245. DMA_FROM_DEVICE);
  246. }
  247. static inline
  248. void sync_descbuffer_for_cpu(struct b43legacy_dmaring *ring,
  249. dma_addr_t addr,
  250. size_t len)
  251. {
  252. B43legacy_WARN_ON(ring->tx);
  253. dma_sync_single_for_cpu(ring->dev->dev->dma_dev,
  254. addr, len, DMA_FROM_DEVICE);
  255. }
  256. static inline
  257. void sync_descbuffer_for_device(struct b43legacy_dmaring *ring,
  258. dma_addr_t addr,
  259. size_t len)
  260. {
  261. B43legacy_WARN_ON(ring->tx);
  262. dma_sync_single_for_device(ring->dev->dev->dma_dev,
  263. addr, len, DMA_FROM_DEVICE);
  264. }
  265. static inline
  266. void free_descriptor_buffer(struct b43legacy_dmaring *ring,
  267. struct b43legacy_dmadesc_meta *meta,
  268. int irq_context)
  269. {
  270. if (meta->skb) {
  271. if (irq_context)
  272. dev_kfree_skb_irq(meta->skb);
  273. else
  274. dev_kfree_skb(meta->skb);
  275. meta->skb = NULL;
  276. }
  277. }
  278. static int alloc_ringmemory(struct b43legacy_dmaring *ring)
  279. {
  280. /* GFP flags must match the flags in free_ringmemory()! */
  281. ring->descbase = dma_alloc_coherent(ring->dev->dev->dma_dev,
  282. B43legacy_DMA_RINGMEMSIZE,
  283. &(ring->dmabase),
  284. GFP_KERNEL);
  285. if (!ring->descbase) {
  286. b43legacyerr(ring->dev->wl, "DMA ringmemory allocation"
  287. " failed\n");
  288. return -ENOMEM;
  289. }
  290. memset(ring->descbase, 0, B43legacy_DMA_RINGMEMSIZE);
  291. return 0;
  292. }
  293. static void free_ringmemory(struct b43legacy_dmaring *ring)
  294. {
  295. dma_free_coherent(ring->dev->dev->dma_dev, B43legacy_DMA_RINGMEMSIZE,
  296. ring->descbase, ring->dmabase);
  297. }
  298. /* Reset the RX DMA channel */
  299. static int b43legacy_dmacontroller_rx_reset(struct b43legacy_wldev *dev,
  300. u16 mmio_base,
  301. enum b43legacy_dmatype type)
  302. {
  303. int i;
  304. u32 value;
  305. u16 offset;
  306. might_sleep();
  307. offset = B43legacy_DMA32_RXCTL;
  308. b43legacy_write32(dev, mmio_base + offset, 0);
  309. for (i = 0; i < 10; i++) {
  310. offset = B43legacy_DMA32_RXSTATUS;
  311. value = b43legacy_read32(dev, mmio_base + offset);
  312. value &= B43legacy_DMA32_RXSTATE;
  313. if (value == B43legacy_DMA32_RXSTAT_DISABLED) {
  314. i = -1;
  315. break;
  316. }
  317. msleep(1);
  318. }
  319. if (i != -1) {
  320. b43legacyerr(dev->wl, "DMA RX reset timed out\n");
  321. return -ENODEV;
  322. }
  323. return 0;
  324. }
  325. /* Reset the RX DMA channel */
  326. static int b43legacy_dmacontroller_tx_reset(struct b43legacy_wldev *dev,
  327. u16 mmio_base,
  328. enum b43legacy_dmatype type)
  329. {
  330. int i;
  331. u32 value;
  332. u16 offset;
  333. might_sleep();
  334. for (i = 0; i < 10; i++) {
  335. offset = B43legacy_DMA32_TXSTATUS;
  336. value = b43legacy_read32(dev, mmio_base + offset);
  337. value &= B43legacy_DMA32_TXSTATE;
  338. if (value == B43legacy_DMA32_TXSTAT_DISABLED ||
  339. value == B43legacy_DMA32_TXSTAT_IDLEWAIT ||
  340. value == B43legacy_DMA32_TXSTAT_STOPPED)
  341. break;
  342. msleep(1);
  343. }
  344. offset = B43legacy_DMA32_TXCTL;
  345. b43legacy_write32(dev, mmio_base + offset, 0);
  346. for (i = 0; i < 10; i++) {
  347. offset = B43legacy_DMA32_TXSTATUS;
  348. value = b43legacy_read32(dev, mmio_base + offset);
  349. value &= B43legacy_DMA32_TXSTATE;
  350. if (value == B43legacy_DMA32_TXSTAT_DISABLED) {
  351. i = -1;
  352. break;
  353. }
  354. msleep(1);
  355. }
  356. if (i != -1) {
  357. b43legacyerr(dev->wl, "DMA TX reset timed out\n");
  358. return -ENODEV;
  359. }
  360. /* ensure the reset is completed. */
  361. msleep(1);
  362. return 0;
  363. }
  364. /* Check if a DMA mapping address is invalid. */
  365. static bool b43legacy_dma_mapping_error(struct b43legacy_dmaring *ring,
  366. dma_addr_t addr,
  367. size_t buffersize,
  368. bool dma_to_device)
  369. {
  370. if (unlikely(dma_mapping_error(ring->dev->dev->dma_dev, addr)))
  371. return 1;
  372. switch (ring->type) {
  373. case B43legacy_DMA_30BIT:
  374. if ((u64)addr + buffersize > (1ULL << 30))
  375. goto address_error;
  376. break;
  377. case B43legacy_DMA_32BIT:
  378. if ((u64)addr + buffersize > (1ULL << 32))
  379. goto address_error;
  380. break;
  381. }
  382. /* The address is OK. */
  383. return 0;
  384. address_error:
  385. /* We can't support this address. Unmap it again. */
  386. unmap_descbuffer(ring, addr, buffersize, dma_to_device);
  387. return 1;
  388. }
  389. static int setup_rx_descbuffer(struct b43legacy_dmaring *ring,
  390. struct b43legacy_dmadesc32 *desc,
  391. struct b43legacy_dmadesc_meta *meta,
  392. gfp_t gfp_flags)
  393. {
  394. struct b43legacy_rxhdr_fw3 *rxhdr;
  395. struct b43legacy_hwtxstatus *txstat;
  396. dma_addr_t dmaaddr;
  397. struct sk_buff *skb;
  398. B43legacy_WARN_ON(ring->tx);
  399. skb = __dev_alloc_skb(ring->rx_buffersize, gfp_flags);
  400. if (unlikely(!skb))
  401. return -ENOMEM;
  402. dmaaddr = map_descbuffer(ring, skb->data,
  403. ring->rx_buffersize, 0);
  404. if (b43legacy_dma_mapping_error(ring, dmaaddr, ring->rx_buffersize, 0)) {
  405. /* ugh. try to realloc in zone_dma */
  406. gfp_flags |= GFP_DMA;
  407. dev_kfree_skb_any(skb);
  408. skb = __dev_alloc_skb(ring->rx_buffersize, gfp_flags);
  409. if (unlikely(!skb))
  410. return -ENOMEM;
  411. dmaaddr = map_descbuffer(ring, skb->data,
  412. ring->rx_buffersize, 0);
  413. }
  414. if (b43legacy_dma_mapping_error(ring, dmaaddr, ring->rx_buffersize, 0)) {
  415. dev_kfree_skb_any(skb);
  416. return -EIO;
  417. }
  418. meta->skb = skb;
  419. meta->dmaaddr = dmaaddr;
  420. op32_fill_descriptor(ring, desc, dmaaddr, ring->rx_buffersize, 0, 0, 0);
  421. rxhdr = (struct b43legacy_rxhdr_fw3 *)(skb->data);
  422. rxhdr->frame_len = 0;
  423. txstat = (struct b43legacy_hwtxstatus *)(skb->data);
  424. txstat->cookie = 0;
  425. return 0;
  426. }
  427. /* Allocate the initial descbuffers.
  428. * This is used for an RX ring only.
  429. */
  430. static int alloc_initial_descbuffers(struct b43legacy_dmaring *ring)
  431. {
  432. int i;
  433. int err = -ENOMEM;
  434. struct b43legacy_dmadesc32 *desc;
  435. struct b43legacy_dmadesc_meta *meta;
  436. for (i = 0; i < ring->nr_slots; i++) {
  437. desc = op32_idx2desc(ring, i, &meta);
  438. err = setup_rx_descbuffer(ring, desc, meta, GFP_KERNEL);
  439. if (err) {
  440. b43legacyerr(ring->dev->wl,
  441. "Failed to allocate initial descbuffers\n");
  442. goto err_unwind;
  443. }
  444. }
  445. mb(); /* all descbuffer setup before next line */
  446. ring->used_slots = ring->nr_slots;
  447. err = 0;
  448. out:
  449. return err;
  450. err_unwind:
  451. for (i--; i >= 0; i--) {
  452. desc = op32_idx2desc(ring, i, &meta);
  453. unmap_descbuffer(ring, meta->dmaaddr, ring->rx_buffersize, 0);
  454. dev_kfree_skb(meta->skb);
  455. }
  456. goto out;
  457. }
  458. /* Do initial setup of the DMA controller.
  459. * Reset the controller, write the ring busaddress
  460. * and switch the "enable" bit on.
  461. */
  462. static int dmacontroller_setup(struct b43legacy_dmaring *ring)
  463. {
  464. int err = 0;
  465. u32 value;
  466. u32 addrext;
  467. u32 trans = ring->dev->dma.translation;
  468. u32 ringbase = (u32)(ring->dmabase);
  469. if (ring->tx) {
  470. addrext = (ringbase & SSB_DMA_TRANSLATION_MASK)
  471. >> SSB_DMA_TRANSLATION_SHIFT;
  472. value = B43legacy_DMA32_TXENABLE;
  473. value |= (addrext << B43legacy_DMA32_TXADDREXT_SHIFT)
  474. & B43legacy_DMA32_TXADDREXT_MASK;
  475. b43legacy_dma_write(ring, B43legacy_DMA32_TXCTL, value);
  476. b43legacy_dma_write(ring, B43legacy_DMA32_TXRING,
  477. (ringbase & ~SSB_DMA_TRANSLATION_MASK)
  478. | trans);
  479. } else {
  480. err = alloc_initial_descbuffers(ring);
  481. if (err)
  482. goto out;
  483. addrext = (ringbase & SSB_DMA_TRANSLATION_MASK)
  484. >> SSB_DMA_TRANSLATION_SHIFT;
  485. value = (ring->frameoffset <<
  486. B43legacy_DMA32_RXFROFF_SHIFT);
  487. value |= B43legacy_DMA32_RXENABLE;
  488. value |= (addrext << B43legacy_DMA32_RXADDREXT_SHIFT)
  489. & B43legacy_DMA32_RXADDREXT_MASK;
  490. b43legacy_dma_write(ring, B43legacy_DMA32_RXCTL, value);
  491. b43legacy_dma_write(ring, B43legacy_DMA32_RXRING,
  492. (ringbase & ~SSB_DMA_TRANSLATION_MASK)
  493. | trans);
  494. b43legacy_dma_write(ring, B43legacy_DMA32_RXINDEX, 200);
  495. }
  496. out:
  497. return err;
  498. }
  499. /* Shutdown the DMA controller. */
  500. static void dmacontroller_cleanup(struct b43legacy_dmaring *ring)
  501. {
  502. if (ring->tx) {
  503. b43legacy_dmacontroller_tx_reset(ring->dev, ring->mmio_base,
  504. ring->type);
  505. b43legacy_dma_write(ring, B43legacy_DMA32_TXRING, 0);
  506. } else {
  507. b43legacy_dmacontroller_rx_reset(ring->dev, ring->mmio_base,
  508. ring->type);
  509. b43legacy_dma_write(ring, B43legacy_DMA32_RXRING, 0);
  510. }
  511. }
  512. static void free_all_descbuffers(struct b43legacy_dmaring *ring)
  513. {
  514. struct b43legacy_dmadesc_meta *meta;
  515. int i;
  516. if (!ring->used_slots)
  517. return;
  518. for (i = 0; i < ring->nr_slots; i++) {
  519. op32_idx2desc(ring, i, &meta);
  520. if (!meta->skb) {
  521. B43legacy_WARN_ON(!ring->tx);
  522. continue;
  523. }
  524. if (ring->tx)
  525. unmap_descbuffer(ring, meta->dmaaddr,
  526. meta->skb->len, 1);
  527. else
  528. unmap_descbuffer(ring, meta->dmaaddr,
  529. ring->rx_buffersize, 0);
  530. free_descriptor_buffer(ring, meta, 0);
  531. }
  532. }
  533. static u64 supported_dma_mask(struct b43legacy_wldev *dev)
  534. {
  535. u32 tmp;
  536. u16 mmio_base;
  537. mmio_base = b43legacy_dmacontroller_base(0, 0);
  538. b43legacy_write32(dev,
  539. mmio_base + B43legacy_DMA32_TXCTL,
  540. B43legacy_DMA32_TXADDREXT_MASK);
  541. tmp = b43legacy_read32(dev, mmio_base +
  542. B43legacy_DMA32_TXCTL);
  543. if (tmp & B43legacy_DMA32_TXADDREXT_MASK)
  544. return DMA_BIT_MASK(32);
  545. return DMA_BIT_MASK(30);
  546. }
  547. static enum b43legacy_dmatype dma_mask_to_engine_type(u64 dmamask)
  548. {
  549. if (dmamask == DMA_BIT_MASK(30))
  550. return B43legacy_DMA_30BIT;
  551. if (dmamask == DMA_BIT_MASK(32))
  552. return B43legacy_DMA_32BIT;
  553. B43legacy_WARN_ON(1);
  554. return B43legacy_DMA_30BIT;
  555. }
  556. /* Main initialization function. */
  557. static
  558. struct b43legacy_dmaring *b43legacy_setup_dmaring(struct b43legacy_wldev *dev,
  559. int controller_index,
  560. int for_tx,
  561. enum b43legacy_dmatype type)
  562. {
  563. struct b43legacy_dmaring *ring;
  564. int err;
  565. int nr_slots;
  566. dma_addr_t dma_test;
  567. ring = kzalloc(sizeof(*ring), GFP_KERNEL);
  568. if (!ring)
  569. goto out;
  570. ring->type = type;
  571. ring->dev = dev;
  572. nr_slots = B43legacy_RXRING_SLOTS;
  573. if (for_tx)
  574. nr_slots = B43legacy_TXRING_SLOTS;
  575. ring->meta = kcalloc(nr_slots, sizeof(struct b43legacy_dmadesc_meta),
  576. GFP_KERNEL);
  577. if (!ring->meta)
  578. goto err_kfree_ring;
  579. if (for_tx) {
  580. ring->txhdr_cache = kcalloc(nr_slots,
  581. sizeof(struct b43legacy_txhdr_fw3),
  582. GFP_KERNEL);
  583. if (!ring->txhdr_cache)
  584. goto err_kfree_meta;
  585. /* test for ability to dma to txhdr_cache */
  586. dma_test = dma_map_single(dev->dev->dma_dev, ring->txhdr_cache,
  587. sizeof(struct b43legacy_txhdr_fw3),
  588. DMA_TO_DEVICE);
  589. if (b43legacy_dma_mapping_error(ring, dma_test,
  590. sizeof(struct b43legacy_txhdr_fw3), 1)) {
  591. /* ugh realloc */
  592. kfree(ring->txhdr_cache);
  593. ring->txhdr_cache = kcalloc(nr_slots,
  594. sizeof(struct b43legacy_txhdr_fw3),
  595. GFP_KERNEL | GFP_DMA);
  596. if (!ring->txhdr_cache)
  597. goto err_kfree_meta;
  598. dma_test = dma_map_single(dev->dev->dma_dev,
  599. ring->txhdr_cache,
  600. sizeof(struct b43legacy_txhdr_fw3),
  601. DMA_TO_DEVICE);
  602. if (b43legacy_dma_mapping_error(ring, dma_test,
  603. sizeof(struct b43legacy_txhdr_fw3), 1))
  604. goto err_kfree_txhdr_cache;
  605. }
  606. dma_unmap_single(dev->dev->dma_dev, dma_test,
  607. sizeof(struct b43legacy_txhdr_fw3),
  608. DMA_TO_DEVICE);
  609. }
  610. ring->nr_slots = nr_slots;
  611. ring->mmio_base = b43legacy_dmacontroller_base(type, controller_index);
  612. ring->index = controller_index;
  613. if (for_tx) {
  614. ring->tx = 1;
  615. ring->current_slot = -1;
  616. } else {
  617. if (ring->index == 0) {
  618. ring->rx_buffersize = B43legacy_DMA0_RX_BUFFERSIZE;
  619. ring->frameoffset = B43legacy_DMA0_RX_FRAMEOFFSET;
  620. } else if (ring->index == 3) {
  621. ring->rx_buffersize = B43legacy_DMA3_RX_BUFFERSIZE;
  622. ring->frameoffset = B43legacy_DMA3_RX_FRAMEOFFSET;
  623. } else
  624. B43legacy_WARN_ON(1);
  625. }
  626. spin_lock_init(&ring->lock);
  627. #ifdef CONFIG_B43LEGACY_DEBUG
  628. ring->last_injected_overflow = jiffies;
  629. #endif
  630. err = alloc_ringmemory(ring);
  631. if (err)
  632. goto err_kfree_txhdr_cache;
  633. err = dmacontroller_setup(ring);
  634. if (err)
  635. goto err_free_ringmemory;
  636. out:
  637. return ring;
  638. err_free_ringmemory:
  639. free_ringmemory(ring);
  640. err_kfree_txhdr_cache:
  641. kfree(ring->txhdr_cache);
  642. err_kfree_meta:
  643. kfree(ring->meta);
  644. err_kfree_ring:
  645. kfree(ring);
  646. ring = NULL;
  647. goto out;
  648. }
  649. /* Main cleanup function. */
  650. static void b43legacy_destroy_dmaring(struct b43legacy_dmaring *ring)
  651. {
  652. if (!ring)
  653. return;
  654. b43legacydbg(ring->dev->wl, "DMA-%u 0x%04X (%s) max used slots:"
  655. " %d/%d\n", (unsigned int)(ring->type), ring->mmio_base,
  656. (ring->tx) ? "TX" : "RX", ring->max_used_slots,
  657. ring->nr_slots);
  658. /* Device IRQs are disabled prior entering this function,
  659. * so no need to take care of concurrency with rx handler stuff.
  660. */
  661. dmacontroller_cleanup(ring);
  662. free_all_descbuffers(ring);
  663. free_ringmemory(ring);
  664. kfree(ring->txhdr_cache);
  665. kfree(ring->meta);
  666. kfree(ring);
  667. }
  668. void b43legacy_dma_free(struct b43legacy_wldev *dev)
  669. {
  670. struct b43legacy_dma *dma;
  671. if (b43legacy_using_pio(dev))
  672. return;
  673. dma = &dev->dma;
  674. b43legacy_destroy_dmaring(dma->rx_ring3);
  675. dma->rx_ring3 = NULL;
  676. b43legacy_destroy_dmaring(dma->rx_ring0);
  677. dma->rx_ring0 = NULL;
  678. b43legacy_destroy_dmaring(dma->tx_ring5);
  679. dma->tx_ring5 = NULL;
  680. b43legacy_destroy_dmaring(dma->tx_ring4);
  681. dma->tx_ring4 = NULL;
  682. b43legacy_destroy_dmaring(dma->tx_ring3);
  683. dma->tx_ring3 = NULL;
  684. b43legacy_destroy_dmaring(dma->tx_ring2);
  685. dma->tx_ring2 = NULL;
  686. b43legacy_destroy_dmaring(dma->tx_ring1);
  687. dma->tx_ring1 = NULL;
  688. b43legacy_destroy_dmaring(dma->tx_ring0);
  689. dma->tx_ring0 = NULL;
  690. }
  691. static int b43legacy_dma_set_mask(struct b43legacy_wldev *dev, u64 mask)
  692. {
  693. u64 orig_mask = mask;
  694. bool fallback = 0;
  695. int err;
  696. /* Try to set the DMA mask. If it fails, try falling back to a
  697. * lower mask, as we can always also support a lower one. */
  698. while (1) {
  699. err = dma_set_mask(dev->dev->dma_dev, mask);
  700. if (!err) {
  701. err = dma_set_coherent_mask(dev->dev->dma_dev, mask);
  702. if (!err)
  703. break;
  704. }
  705. if (mask == DMA_BIT_MASK(64)) {
  706. mask = DMA_BIT_MASK(32);
  707. fallback = 1;
  708. continue;
  709. }
  710. if (mask == DMA_BIT_MASK(32)) {
  711. mask = DMA_BIT_MASK(30);
  712. fallback = 1;
  713. continue;
  714. }
  715. b43legacyerr(dev->wl, "The machine/kernel does not support "
  716. "the required %u-bit DMA mask\n",
  717. (unsigned int)dma_mask_to_engine_type(orig_mask));
  718. return -EOPNOTSUPP;
  719. }
  720. if (fallback) {
  721. b43legacyinfo(dev->wl, "DMA mask fallback from %u-bit to %u-"
  722. "bit\n",
  723. (unsigned int)dma_mask_to_engine_type(orig_mask),
  724. (unsigned int)dma_mask_to_engine_type(mask));
  725. }
  726. return 0;
  727. }
  728. int b43legacy_dma_init(struct b43legacy_wldev *dev)
  729. {
  730. struct b43legacy_dma *dma = &dev->dma;
  731. struct b43legacy_dmaring *ring;
  732. int err;
  733. u64 dmamask;
  734. enum b43legacy_dmatype type;
  735. dmamask = supported_dma_mask(dev);
  736. type = dma_mask_to_engine_type(dmamask);
  737. err = b43legacy_dma_set_mask(dev, dmamask);
  738. if (err) {
  739. #ifdef CONFIG_B43LEGACY_PIO
  740. b43legacywarn(dev->wl, "DMA for this device not supported. "
  741. "Falling back to PIO\n");
  742. dev->__using_pio = 1;
  743. return -EAGAIN;
  744. #else
  745. b43legacyerr(dev->wl, "DMA for this device not supported and "
  746. "no PIO support compiled in\n");
  747. return -EOPNOTSUPP;
  748. #endif
  749. }
  750. dma->translation = ssb_dma_translation(dev->dev);
  751. err = -ENOMEM;
  752. /* setup TX DMA channels. */
  753. ring = b43legacy_setup_dmaring(dev, 0, 1, type);
  754. if (!ring)
  755. goto out;
  756. dma->tx_ring0 = ring;
  757. ring = b43legacy_setup_dmaring(dev, 1, 1, type);
  758. if (!ring)
  759. goto err_destroy_tx0;
  760. dma->tx_ring1 = ring;
  761. ring = b43legacy_setup_dmaring(dev, 2, 1, type);
  762. if (!ring)
  763. goto err_destroy_tx1;
  764. dma->tx_ring2 = ring;
  765. ring = b43legacy_setup_dmaring(dev, 3, 1, type);
  766. if (!ring)
  767. goto err_destroy_tx2;
  768. dma->tx_ring3 = ring;
  769. ring = b43legacy_setup_dmaring(dev, 4, 1, type);
  770. if (!ring)
  771. goto err_destroy_tx3;
  772. dma->tx_ring4 = ring;
  773. ring = b43legacy_setup_dmaring(dev, 5, 1, type);
  774. if (!ring)
  775. goto err_destroy_tx4;
  776. dma->tx_ring5 = ring;
  777. /* setup RX DMA channels. */
  778. ring = b43legacy_setup_dmaring(dev, 0, 0, type);
  779. if (!ring)
  780. goto err_destroy_tx5;
  781. dma->rx_ring0 = ring;
  782. if (dev->dev->id.revision < 5) {
  783. ring = b43legacy_setup_dmaring(dev, 3, 0, type);
  784. if (!ring)
  785. goto err_destroy_rx0;
  786. dma->rx_ring3 = ring;
  787. }
  788. b43legacydbg(dev->wl, "%u-bit DMA initialized\n", (unsigned int)type);
  789. err = 0;
  790. out:
  791. return err;
  792. err_destroy_rx0:
  793. b43legacy_destroy_dmaring(dma->rx_ring0);
  794. dma->rx_ring0 = NULL;
  795. err_destroy_tx5:
  796. b43legacy_destroy_dmaring(dma->tx_ring5);
  797. dma->tx_ring5 = NULL;
  798. err_destroy_tx4:
  799. b43legacy_destroy_dmaring(dma->tx_ring4);
  800. dma->tx_ring4 = NULL;
  801. err_destroy_tx3:
  802. b43legacy_destroy_dmaring(dma->tx_ring3);
  803. dma->tx_ring3 = NULL;
  804. err_destroy_tx2:
  805. b43legacy_destroy_dmaring(dma->tx_ring2);
  806. dma->tx_ring2 = NULL;
  807. err_destroy_tx1:
  808. b43legacy_destroy_dmaring(dma->tx_ring1);
  809. dma->tx_ring1 = NULL;
  810. err_destroy_tx0:
  811. b43legacy_destroy_dmaring(dma->tx_ring0);
  812. dma->tx_ring0 = NULL;
  813. goto out;
  814. }
  815. /* Generate a cookie for the TX header. */
  816. static u16 generate_cookie(struct b43legacy_dmaring *ring,
  817. int slot)
  818. {
  819. u16 cookie = 0x1000;
  820. /* Use the upper 4 bits of the cookie as
  821. * DMA controller ID and store the slot number
  822. * in the lower 12 bits.
  823. * Note that the cookie must never be 0, as this
  824. * is a special value used in RX path.
  825. */
  826. switch (ring->index) {
  827. case 0:
  828. cookie = 0xA000;
  829. break;
  830. case 1:
  831. cookie = 0xB000;
  832. break;
  833. case 2:
  834. cookie = 0xC000;
  835. break;
  836. case 3:
  837. cookie = 0xD000;
  838. break;
  839. case 4:
  840. cookie = 0xE000;
  841. break;
  842. case 5:
  843. cookie = 0xF000;
  844. break;
  845. }
  846. B43legacy_WARN_ON(!(((u16)slot & 0xF000) == 0x0000));
  847. cookie |= (u16)slot;
  848. return cookie;
  849. }
  850. /* Inspect a cookie and find out to which controller/slot it belongs. */
  851. static
  852. struct b43legacy_dmaring *parse_cookie(struct b43legacy_wldev *dev,
  853. u16 cookie, int *slot)
  854. {
  855. struct b43legacy_dma *dma = &dev->dma;
  856. struct b43legacy_dmaring *ring = NULL;
  857. switch (cookie & 0xF000) {
  858. case 0xA000:
  859. ring = dma->tx_ring0;
  860. break;
  861. case 0xB000:
  862. ring = dma->tx_ring1;
  863. break;
  864. case 0xC000:
  865. ring = dma->tx_ring2;
  866. break;
  867. case 0xD000:
  868. ring = dma->tx_ring3;
  869. break;
  870. case 0xE000:
  871. ring = dma->tx_ring4;
  872. break;
  873. case 0xF000:
  874. ring = dma->tx_ring5;
  875. break;
  876. default:
  877. B43legacy_WARN_ON(1);
  878. }
  879. *slot = (cookie & 0x0FFF);
  880. B43legacy_WARN_ON(!(ring && *slot >= 0 && *slot < ring->nr_slots));
  881. return ring;
  882. }
  883. static int dma_tx_fragment(struct b43legacy_dmaring *ring,
  884. struct sk_buff **in_skb)
  885. {
  886. struct sk_buff *skb = *in_skb;
  887. struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
  888. u8 *header;
  889. int slot, old_top_slot, old_used_slots;
  890. int err;
  891. struct b43legacy_dmadesc32 *desc;
  892. struct b43legacy_dmadesc_meta *meta;
  893. struct b43legacy_dmadesc_meta *meta_hdr;
  894. struct sk_buff *bounce_skb;
  895. #define SLOTS_PER_PACKET 2
  896. B43legacy_WARN_ON(skb_shinfo(skb)->nr_frags != 0);
  897. old_top_slot = ring->current_slot;
  898. old_used_slots = ring->used_slots;
  899. /* Get a slot for the header. */
  900. slot = request_slot(ring);
  901. desc = op32_idx2desc(ring, slot, &meta_hdr);
  902. memset(meta_hdr, 0, sizeof(*meta_hdr));
  903. header = &(ring->txhdr_cache[slot * sizeof(
  904. struct b43legacy_txhdr_fw3)]);
  905. err = b43legacy_generate_txhdr(ring->dev, header,
  906. skb->data, skb->len, info,
  907. generate_cookie(ring, slot));
  908. if (unlikely(err)) {
  909. ring->current_slot = old_top_slot;
  910. ring->used_slots = old_used_slots;
  911. return err;
  912. }
  913. meta_hdr->dmaaddr = map_descbuffer(ring, (unsigned char *)header,
  914. sizeof(struct b43legacy_txhdr_fw3), 1);
  915. if (b43legacy_dma_mapping_error(ring, meta_hdr->dmaaddr,
  916. sizeof(struct b43legacy_txhdr_fw3), 1)) {
  917. ring->current_slot = old_top_slot;
  918. ring->used_slots = old_used_slots;
  919. return -EIO;
  920. }
  921. op32_fill_descriptor(ring, desc, meta_hdr->dmaaddr,
  922. sizeof(struct b43legacy_txhdr_fw3), 1, 0, 0);
  923. /* Get a slot for the payload. */
  924. slot = request_slot(ring);
  925. desc = op32_idx2desc(ring, slot, &meta);
  926. memset(meta, 0, sizeof(*meta));
  927. meta->skb = skb;
  928. meta->is_last_fragment = 1;
  929. meta->dmaaddr = map_descbuffer(ring, skb->data, skb->len, 1);
  930. /* create a bounce buffer in zone_dma on mapping failure. */
  931. if (b43legacy_dma_mapping_error(ring, meta->dmaaddr, skb->len, 1)) {
  932. bounce_skb = __dev_alloc_skb(skb->len, GFP_ATOMIC | GFP_DMA);
  933. if (!bounce_skb) {
  934. ring->current_slot = old_top_slot;
  935. ring->used_slots = old_used_slots;
  936. err = -ENOMEM;
  937. goto out_unmap_hdr;
  938. }
  939. memcpy(skb_put(bounce_skb, skb->len), skb->data, skb->len);
  940. memcpy(bounce_skb->cb, skb->cb, sizeof(skb->cb));
  941. bounce_skb->dev = skb->dev;
  942. skb_set_queue_mapping(bounce_skb, skb_get_queue_mapping(skb));
  943. info = IEEE80211_SKB_CB(bounce_skb);
  944. dev_kfree_skb_any(skb);
  945. skb = bounce_skb;
  946. *in_skb = bounce_skb;
  947. meta->skb = skb;
  948. meta->dmaaddr = map_descbuffer(ring, skb->data, skb->len, 1);
  949. if (b43legacy_dma_mapping_error(ring, meta->dmaaddr, skb->len, 1)) {
  950. ring->current_slot = old_top_slot;
  951. ring->used_slots = old_used_slots;
  952. err = -EIO;
  953. goto out_free_bounce;
  954. }
  955. }
  956. op32_fill_descriptor(ring, desc, meta->dmaaddr,
  957. skb->len, 0, 1, 1);
  958. wmb(); /* previous stuff MUST be done */
  959. /* Now transfer the whole frame. */
  960. op32_poke_tx(ring, next_slot(ring, slot));
  961. return 0;
  962. out_free_bounce:
  963. dev_kfree_skb_any(skb);
  964. out_unmap_hdr:
  965. unmap_descbuffer(ring, meta_hdr->dmaaddr,
  966. sizeof(struct b43legacy_txhdr_fw3), 1);
  967. return err;
  968. }
  969. static inline
  970. int should_inject_overflow(struct b43legacy_dmaring *ring)
  971. {
  972. #ifdef CONFIG_B43LEGACY_DEBUG
  973. if (unlikely(b43legacy_debug(ring->dev,
  974. B43legacy_DBG_DMAOVERFLOW))) {
  975. /* Check if we should inject another ringbuffer overflow
  976. * to test handling of this situation in the stack. */
  977. unsigned long next_overflow;
  978. next_overflow = ring->last_injected_overflow + HZ;
  979. if (time_after(jiffies, next_overflow)) {
  980. ring->last_injected_overflow = jiffies;
  981. b43legacydbg(ring->dev->wl,
  982. "Injecting TX ring overflow on "
  983. "DMA controller %d\n", ring->index);
  984. return 1;
  985. }
  986. }
  987. #endif /* CONFIG_B43LEGACY_DEBUG */
  988. return 0;
  989. }
  990. int b43legacy_dma_tx(struct b43legacy_wldev *dev,
  991. struct sk_buff *skb)
  992. {
  993. struct b43legacy_dmaring *ring;
  994. int err = 0;
  995. unsigned long flags;
  996. ring = priority_to_txring(dev, skb_get_queue_mapping(skb));
  997. spin_lock_irqsave(&ring->lock, flags);
  998. B43legacy_WARN_ON(!ring->tx);
  999. if (unlikely(ring->stopped)) {
  1000. /* We get here only because of a bug in mac80211.
  1001. * Because of a race, one packet may be queued after
  1002. * the queue is stopped, thus we got called when we shouldn't.
  1003. * For now, just refuse the transmit. */
  1004. if (b43legacy_debug(dev, B43legacy_DBG_DMAVERBOSE))
  1005. b43legacyerr(dev->wl, "Packet after queue stopped\n");
  1006. err = -ENOSPC;
  1007. goto out_unlock;
  1008. }
  1009. if (unlikely(WARN_ON(free_slots(ring) < SLOTS_PER_PACKET))) {
  1010. /* If we get here, we have a real error with the queue
  1011. * full, but queues not stopped. */
  1012. b43legacyerr(dev->wl, "DMA queue overflow\n");
  1013. err = -ENOSPC;
  1014. goto out_unlock;
  1015. }
  1016. /* dma_tx_fragment might reallocate the skb, so invalidate pointers pointing
  1017. * into the skb data or cb now. */
  1018. err = dma_tx_fragment(ring, &skb);
  1019. if (unlikely(err == -ENOKEY)) {
  1020. /* Drop this packet, as we don't have the encryption key
  1021. * anymore and must not transmit it unencrypted. */
  1022. dev_kfree_skb_any(skb);
  1023. err = 0;
  1024. goto out_unlock;
  1025. }
  1026. if (unlikely(err)) {
  1027. b43legacyerr(dev->wl, "DMA tx mapping failure\n");
  1028. goto out_unlock;
  1029. }
  1030. if ((free_slots(ring) < SLOTS_PER_PACKET) ||
  1031. should_inject_overflow(ring)) {
  1032. /* This TX ring is full. */
  1033. ieee80211_stop_queue(dev->wl->hw, txring_to_priority(ring));
  1034. ring->stopped = 1;
  1035. if (b43legacy_debug(dev, B43legacy_DBG_DMAVERBOSE))
  1036. b43legacydbg(dev->wl, "Stopped TX ring %d\n",
  1037. ring->index);
  1038. }
  1039. out_unlock:
  1040. spin_unlock_irqrestore(&ring->lock, flags);
  1041. return err;
  1042. }
  1043. void b43legacy_dma_handle_txstatus(struct b43legacy_wldev *dev,
  1044. const struct b43legacy_txstatus *status)
  1045. {
  1046. struct b43legacy_dmaring *ring;
  1047. struct b43legacy_dmadesc_meta *meta;
  1048. int retry_limit;
  1049. int slot;
  1050. ring = parse_cookie(dev, status->cookie, &slot);
  1051. if (unlikely(!ring))
  1052. return;
  1053. B43legacy_WARN_ON(!irqs_disabled());
  1054. spin_lock(&ring->lock);
  1055. B43legacy_WARN_ON(!ring->tx);
  1056. while (1) {
  1057. B43legacy_WARN_ON(!(slot >= 0 && slot < ring->nr_slots));
  1058. op32_idx2desc(ring, slot, &meta);
  1059. if (meta->skb)
  1060. unmap_descbuffer(ring, meta->dmaaddr,
  1061. meta->skb->len, 1);
  1062. else
  1063. unmap_descbuffer(ring, meta->dmaaddr,
  1064. sizeof(struct b43legacy_txhdr_fw3),
  1065. 1);
  1066. if (meta->is_last_fragment) {
  1067. struct ieee80211_tx_info *info;
  1068. BUG_ON(!meta->skb);
  1069. info = IEEE80211_SKB_CB(meta->skb);
  1070. /* preserve the confiured retry limit before clearing the status
  1071. * The xmit function has overwritten the rc's value with the actual
  1072. * retry limit done by the hardware */
  1073. retry_limit = info->status.rates[0].count;
  1074. ieee80211_tx_info_clear_status(info);
  1075. if (status->acked)
  1076. info->flags |= IEEE80211_TX_STAT_ACK;
  1077. if (status->rts_count > dev->wl->hw->conf.short_frame_max_tx_count) {
  1078. /*
  1079. * If the short retries (RTS, not data frame) have exceeded
  1080. * the limit, the hw will not have tried the selected rate,
  1081. * but will have used the fallback rate instead.
  1082. * Don't let the rate control count attempts for the selected
  1083. * rate in this case, otherwise the statistics will be off.
  1084. */
  1085. info->status.rates[0].count = 0;
  1086. info->status.rates[1].count = status->frame_count;
  1087. } else {
  1088. if (status->frame_count > retry_limit) {
  1089. info->status.rates[0].count = retry_limit;
  1090. info->status.rates[1].count = status->frame_count -
  1091. retry_limit;
  1092. } else {
  1093. info->status.rates[0].count = status->frame_count;
  1094. info->status.rates[1].idx = -1;
  1095. }
  1096. }
  1097. /* Call back to inform the ieee80211 subsystem about the
  1098. * status of the transmission.
  1099. * Some fields of txstat are already filled in dma_tx().
  1100. */
  1101. ieee80211_tx_status_irqsafe(dev->wl->hw, meta->skb);
  1102. /* skb is freed by ieee80211_tx_status_irqsafe() */
  1103. meta->skb = NULL;
  1104. } else {
  1105. /* No need to call free_descriptor_buffer here, as
  1106. * this is only the txhdr, which is not allocated.
  1107. */
  1108. B43legacy_WARN_ON(meta->skb != NULL);
  1109. }
  1110. /* Everything unmapped and free'd. So it's not used anymore. */
  1111. ring->used_slots--;
  1112. if (meta->is_last_fragment)
  1113. break;
  1114. slot = next_slot(ring, slot);
  1115. }
  1116. dev->stats.last_tx = jiffies;
  1117. if (ring->stopped) {
  1118. B43legacy_WARN_ON(free_slots(ring) < SLOTS_PER_PACKET);
  1119. ieee80211_wake_queue(dev->wl->hw, txring_to_priority(ring));
  1120. ring->stopped = 0;
  1121. if (b43legacy_debug(dev, B43legacy_DBG_DMAVERBOSE))
  1122. b43legacydbg(dev->wl, "Woke up TX ring %d\n",
  1123. ring->index);
  1124. }
  1125. spin_unlock(&ring->lock);
  1126. }
  1127. static void dma_rx(struct b43legacy_dmaring *ring,
  1128. int *slot)
  1129. {
  1130. struct b43legacy_dmadesc32 *desc;
  1131. struct b43legacy_dmadesc_meta *meta;
  1132. struct b43legacy_rxhdr_fw3 *rxhdr;
  1133. struct sk_buff *skb;
  1134. u16 len;
  1135. int err;
  1136. dma_addr_t dmaaddr;
  1137. desc = op32_idx2desc(ring, *slot, &meta);
  1138. sync_descbuffer_for_cpu(ring, meta->dmaaddr, ring->rx_buffersize);
  1139. skb = meta->skb;
  1140. if (ring->index == 3) {
  1141. /* We received an xmit status. */
  1142. struct b43legacy_hwtxstatus *hw =
  1143. (struct b43legacy_hwtxstatus *)skb->data;
  1144. int i = 0;
  1145. while (hw->cookie == 0) {
  1146. if (i > 100)
  1147. break;
  1148. i++;
  1149. udelay(2);
  1150. barrier();
  1151. }
  1152. b43legacy_handle_hwtxstatus(ring->dev, hw);
  1153. /* recycle the descriptor buffer. */
  1154. sync_descbuffer_for_device(ring, meta->dmaaddr,
  1155. ring->rx_buffersize);
  1156. return;
  1157. }
  1158. rxhdr = (struct b43legacy_rxhdr_fw3 *)skb->data;
  1159. len = le16_to_cpu(rxhdr->frame_len);
  1160. if (len == 0) {
  1161. int i = 0;
  1162. do {
  1163. udelay(2);
  1164. barrier();
  1165. len = le16_to_cpu(rxhdr->frame_len);
  1166. } while (len == 0 && i++ < 5);
  1167. if (unlikely(len == 0)) {
  1168. /* recycle the descriptor buffer. */
  1169. sync_descbuffer_for_device(ring, meta->dmaaddr,
  1170. ring->rx_buffersize);
  1171. goto drop;
  1172. }
  1173. }
  1174. if (unlikely(len > ring->rx_buffersize)) {
  1175. /* The data did not fit into one descriptor buffer
  1176. * and is split over multiple buffers.
  1177. * This should never happen, as we try to allocate buffers
  1178. * big enough. So simply ignore this packet.
  1179. */
  1180. int cnt = 0;
  1181. s32 tmp = len;
  1182. while (1) {
  1183. desc = op32_idx2desc(ring, *slot, &meta);
  1184. /* recycle the descriptor buffer. */
  1185. sync_descbuffer_for_device(ring, meta->dmaaddr,
  1186. ring->rx_buffersize);
  1187. *slot = next_slot(ring, *slot);
  1188. cnt++;
  1189. tmp -= ring->rx_buffersize;
  1190. if (tmp <= 0)
  1191. break;
  1192. }
  1193. b43legacyerr(ring->dev->wl, "DMA RX buffer too small "
  1194. "(len: %u, buffer: %u, nr-dropped: %d)\n",
  1195. len, ring->rx_buffersize, cnt);
  1196. goto drop;
  1197. }
  1198. dmaaddr = meta->dmaaddr;
  1199. err = setup_rx_descbuffer(ring, desc, meta, GFP_ATOMIC);
  1200. if (unlikely(err)) {
  1201. b43legacydbg(ring->dev->wl, "DMA RX: setup_rx_descbuffer()"
  1202. " failed\n");
  1203. sync_descbuffer_for_device(ring, dmaaddr,
  1204. ring->rx_buffersize);
  1205. goto drop;
  1206. }
  1207. unmap_descbuffer(ring, dmaaddr, ring->rx_buffersize, 0);
  1208. skb_put(skb, len + ring->frameoffset);
  1209. skb_pull(skb, ring->frameoffset);
  1210. b43legacy_rx(ring->dev, skb, rxhdr);
  1211. drop:
  1212. return;
  1213. }
  1214. void b43legacy_dma_rx(struct b43legacy_dmaring *ring)
  1215. {
  1216. int slot;
  1217. int current_slot;
  1218. int used_slots = 0;
  1219. B43legacy_WARN_ON(ring->tx);
  1220. current_slot = op32_get_current_rxslot(ring);
  1221. B43legacy_WARN_ON(!(current_slot >= 0 && current_slot <
  1222. ring->nr_slots));
  1223. slot = ring->current_slot;
  1224. for (; slot != current_slot; slot = next_slot(ring, slot)) {
  1225. dma_rx(ring, &slot);
  1226. update_max_used_slots(ring, ++used_slots);
  1227. }
  1228. op32_set_current_rxslot(ring, slot);
  1229. ring->current_slot = slot;
  1230. }
  1231. static void b43legacy_dma_tx_suspend_ring(struct b43legacy_dmaring *ring)
  1232. {
  1233. unsigned long flags;
  1234. spin_lock_irqsave(&ring->lock, flags);
  1235. B43legacy_WARN_ON(!ring->tx);
  1236. op32_tx_suspend(ring);
  1237. spin_unlock_irqrestore(&ring->lock, flags);
  1238. }
  1239. static void b43legacy_dma_tx_resume_ring(struct b43legacy_dmaring *ring)
  1240. {
  1241. unsigned long flags;
  1242. spin_lock_irqsave(&ring->lock, flags);
  1243. B43legacy_WARN_ON(!ring->tx);
  1244. op32_tx_resume(ring);
  1245. spin_unlock_irqrestore(&ring->lock, flags);
  1246. }
  1247. void b43legacy_dma_tx_suspend(struct b43legacy_wldev *dev)
  1248. {
  1249. b43legacy_power_saving_ctl_bits(dev, -1, 1);
  1250. b43legacy_dma_tx_suspend_ring(dev->dma.tx_ring0);
  1251. b43legacy_dma_tx_suspend_ring(dev->dma.tx_ring1);
  1252. b43legacy_dma_tx_suspend_ring(dev->dma.tx_ring2);
  1253. b43legacy_dma_tx_suspend_ring(dev->dma.tx_ring3);
  1254. b43legacy_dma_tx_suspend_ring(dev->dma.tx_ring4);
  1255. b43legacy_dma_tx_suspend_ring(dev->dma.tx_ring5);
  1256. }
  1257. void b43legacy_dma_tx_resume(struct b43legacy_wldev *dev)
  1258. {
  1259. b43legacy_dma_tx_resume_ring(dev->dma.tx_ring5);
  1260. b43legacy_dma_tx_resume_ring(dev->dma.tx_ring4);
  1261. b43legacy_dma_tx_resume_ring(dev->dma.tx_ring3);
  1262. b43legacy_dma_tx_resume_ring(dev->dma.tx_ring2);
  1263. b43legacy_dma_tx_resume_ring(dev->dma.tx_ring1);
  1264. b43legacy_dma_tx_resume_ring(dev->dma.tx_ring0);
  1265. b43legacy_power_saving_ctl_bits(dev, -1, -1);
  1266. }