1 /* $OpenBSD: if_rtwn.c,v 1.6 2015/08/28 00:03:53 deraadt Exp $ */ 2 3 /*- 4 * Copyright (c) 2010 Damien Bergamini <damien.bergamini@free.fr> 5 * Copyright (c) 2015 Stefan Sperling <stsp@openbsd.org> 6 * Copyright (c) 2016 Andriy Voskoboinyk <avos@FreeBSD.org> 7 * 8 * Permission to use, copy, modify, and distribute this software for any 9 * purpose with or without fee is hereby granted, provided that the above 10 * copyright notice and this permission notice appear in all copies. 11 * 12 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 13 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 14 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 15 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 16 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 17 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 18 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 19 */ 20 21 #include <sys/cdefs.h> 22 __FBSDID("$FreeBSD$"); 23 24 #include "opt_wlan.h" 25 26 #include <sys/param.h> 27 #include <sys/lock.h> 28 #include <sys/mutex.h> 29 #include <sys/mbuf.h> 30 #include <sys/kernel.h> 31 #include <sys/socket.h> 32 #include <sys/systm.h> 33 #include <sys/malloc.h> 34 #include <sys/queue.h> 35 #include <sys/taskqueue.h> 36 #include <sys/bus.h> 37 #include <sys/endian.h> 38 39 #include <machine/bus.h> 40 #include <machine/resource.h> 41 #include <sys/rman.h> 42 43 #include <net/if.h> 44 #include <net/if_var.h> 45 #include <net/ethernet.h> 46 #include <net/if_media.h> 47 48 #include <net80211/ieee80211_var.h> 49 #include <net80211/ieee80211_radiotap.h> 50 51 #include <dev/rtwn/if_rtwnreg.h> 52 #include <dev/rtwn/if_rtwnvar.h> 53 #include <dev/rtwn/if_rtwn_debug.h> 54 55 #include <dev/rtwn/pci/rtwn_pci_var.h> 56 #include <dev/rtwn/pci/rtwn_pci_tx.h> 57 58 #include <dev/rtwn/rtl8192c/pci/r92ce_reg.h> 59 60 61 static int 62 rtwn_pci_tx_start_frame(struct rtwn_softc *sc, struct ieee80211_node *ni, 63 struct mbuf *m, uint8_t *tx_desc, uint8_t type) 64 { 65 struct rtwn_pci_softc *pc = RTWN_PCI_SOFTC(sc); 66 struct rtwn_tx_ring *ring; 67 struct rtwn_tx_data *data; 68 struct rtwn_tx_desc_common *txd; 69 bus_dma_segment_t segs[1]; 70 uint8_t qid; 71 int nsegs, error; 72 73 RTWN_ASSERT_LOCKED(sc); 74 75 switch (type) { 76 case IEEE80211_FC0_TYPE_CTL: 77 case IEEE80211_FC0_TYPE_MGT: 78 qid = RTWN_PCI_MGNT_QUEUE; 79 break; 80 default: 81 qid = M_WME_GETAC(m); 82 break; 83 } 84 85 ring = &pc->tx_ring[qid]; 86 data = &ring->tx_data[ring->cur]; 87 if (data->m != NULL) { 88 RTWN_DPRINTF(sc, RTWN_DEBUG_XMIT, 89 "%s: ring #%u is full (m %p)\n", __func__, qid, data->m); 90 return (ENOBUFS); 91 } 92 93 txd = (struct rtwn_tx_desc_common *) 94 ((uint8_t *)ring->desc + sc->txdesc_len * ring->cur); 95 if (txd->flags0 & RTWN_FLAGS0_OWN) { 96 device_printf(sc->sc_dev, 97 "%s: OWN bit is set (tx desc %d, ring %u)!\n", 98 __func__, ring->cur, qid); 99 return (ENOBUFS); 100 } 101 102 /* Copy Tx descriptor. */ 103 rtwn_pci_copy_tx_desc(pc, txd, tx_desc); 104 txd->pktlen = htole16(m->m_pkthdr.len); 105 txd->offset = sc->txdesc_len; 106 107 error = bus_dmamap_load_mbuf_sg(ring->data_dmat, data->map, m, segs, 108 &nsegs, BUS_DMA_NOWAIT); 109 if (error != 0 && error != EFBIG) { 110 device_printf(sc->sc_dev, "can't map mbuf (error %d)\n", 111 error); 112 return (error); 113 } 114 if (error != 0) { 115 struct mbuf *mnew; 116 117 mnew = m_defrag(m, M_NOWAIT); 118 if (mnew == NULL) { 119 device_printf(sc->sc_dev, "can't defragment mbuf\n"); 120 return (ENOBUFS); 121 } 122 m = mnew; 123 124 error = bus_dmamap_load_mbuf_sg(ring->data_dmat, data->map, m, 125 segs, &nsegs, BUS_DMA_NOWAIT); 126 if (error != 0) { 127 device_printf(sc->sc_dev, 128 "can't map mbuf (error %d)\n", error); 129 if (ni != NULL) { 130 if_inc_counter(ni->ni_vap->iv_ifp, 131 IFCOUNTER_OERRORS, 1); 132 ieee80211_free_node(ni); 133 } 134 m_freem(m); 135 return (0); /* XXX */ 136 } 137 } 138 139 rtwn_pci_tx_postsetup(pc, txd, segs); 140 txd->flags0 |= RTWN_FLAGS0_OWN; 141 142 /* Dump Tx descriptor. */ 143 rtwn_dump_tx_desc(sc, txd); 144 145 bus_dmamap_sync(ring->desc_dmat, ring->desc_map, 146 BUS_DMASYNC_POSTWRITE); 147 bus_dmamap_sync(ring->data_dmat, data->map, BUS_DMASYNC_POSTWRITE); 148 149 data->m = m; 150 data->ni = ni; 151 152 ring->cur = (ring->cur + 1) % RTWN_PCI_TX_LIST_COUNT; 153 154 ring->queued++; 155 if (ring->queued >= (RTWN_PCI_TX_LIST_COUNT - 1)) 156 sc->qfullmsk |= (1 << qid); 157 158 #ifndef D4054 159 sc->sc_tx_timer = 5; 160 #endif 161 162 /* Kick TX. */ 163 rtwn_write_2(sc, R92C_PCIE_CTRL_REG, (1 << qid)); 164 165 return (0); 166 } 167 168 static int 169 rtwn_pci_tx_start_beacon(struct rtwn_softc *sc, struct mbuf *m, 170 uint8_t *tx_desc, int id) 171 { 172 struct rtwn_pci_softc *pc = RTWN_PCI_SOFTC(sc); 173 struct rtwn_tx_ring *ring; 174 struct rtwn_tx_data *data; 175 struct rtwn_tx_desc_common *txd; 176 bus_dma_segment_t segs[1]; 177 int nsegs, error, own; 178 179 RTWN_ASSERT_LOCKED(sc); 180 181 KASSERT(id == 0 || id == 1, ("bogus vap id %d\n", id)); 182 183 ring = &pc->tx_ring[RTWN_PCI_BEACON_QUEUE]; 184 data = &ring->tx_data[id]; 185 txd = (struct rtwn_tx_desc_common *) 186 ((uint8_t *)ring->desc + id * sc->txdesc_len); 187 188 bus_dmamap_sync(ring->desc_dmat, ring->desc_map, 189 BUS_DMASYNC_POSTREAD); 190 own = !!(txd->flags0 & RTWN_FLAGS0_OWN); 191 error = 0; 192 if (!own || txd->pktlen != htole16(m->m_pkthdr.len)) { 193 if (!own) { 194 /* Copy Tx descriptor. */ 195 rtwn_pci_copy_tx_desc(pc, txd, tx_desc); 196 txd->offset = sc->txdesc_len; 197 } else { 198 /* Reload mbuf. */ 199 bus_dmamap_unload(ring->data_dmat, data->map); 200 } 201 202 error = bus_dmamap_load_mbuf_sg(ring->data_dmat, 203 data->map, m, segs, &nsegs, BUS_DMA_NOWAIT); 204 if (error != 0) { 205 device_printf(sc->sc_dev, 206 "can't map beacon (error %d)\n", error); 207 txd->flags0 &= ~RTWN_FLAGS0_OWN; 208 goto end; 209 } 210 211 txd->pktlen = htole16(m->m_pkthdr.len); 212 rtwn_pci_tx_postsetup(pc, txd, segs); 213 txd->flags0 |= RTWN_FLAGS0_OWN; 214 end: 215 bus_dmamap_sync(ring->desc_dmat, ring->desc_map, 216 BUS_DMASYNC_PREWRITE); 217 } 218 219 /* Dump Tx descriptor. */ 220 rtwn_dump_tx_desc(sc, txd); 221 222 bus_dmamap_sync(ring->data_dmat, data->map, BUS_DMASYNC_PREWRITE); 223 224 return (0); 225 } 226 227 int 228 rtwn_pci_tx_start(struct rtwn_softc *sc, struct ieee80211_node *ni, 229 struct mbuf *m, uint8_t *tx_desc, uint8_t type, int id) 230 { 231 int error = 0; 232 233 RTWN_ASSERT_LOCKED(sc); 234 235 if (ni == NULL) /* beacon frame */ 236 error = rtwn_pci_tx_start_beacon(sc, m, tx_desc, id); 237 else 238 error = rtwn_pci_tx_start_frame(sc, ni, m, tx_desc, type); 239 240 return (error); 241 } 242