1 /* $OpenBSD: if_urtwn.c,v 1.16 2011/02/10 17:26:40 jakemsr Exp $ */ 2 3 /*- 4 * Copyright (c) 2010 Damien Bergamini <damien.bergamini@free.fr> 5 * Copyright (c) 2014 Kevin Lo <kevlo@FreeBSD.org> 6 * Copyright (c) 2015-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 #include <sys/linker.h> 39 40 #include <net/if.h> 41 #include <net/ethernet.h> 42 #include <net/if_media.h> 43 44 #include <net80211/ieee80211_var.h> 45 #include <net80211/ieee80211_radiotap.h> 46 47 #include <dev/rtwn/if_rtwnreg.h> 48 #include <dev/rtwn/if_rtwnvar.h> 49 #include <dev/rtwn/if_rtwn_ridx.h> 50 51 #include <dev/rtwn/rtl8192c/r92c.h> 52 #include <dev/rtwn/rtl8192c/r92c_rx_desc.h> 53 54 55 int 56 r92c_classify_intr(struct rtwn_softc *sc, void *buf, int len) 57 { 58 /* NB: reports are fetched from C2H_MSG register. */ 59 return (RTWN_RX_DATA); 60 } 61 62 int8_t 63 r92c_get_rssi_cck(struct rtwn_softc *sc, void *physt) 64 { 65 static const int8_t cckoff[] = { 16, -12, -26, -46 }; 66 struct r92c_rx_cck *cck = (struct r92c_rx_cck *)physt; 67 uint8_t rpt; 68 int8_t rssi; 69 70 if (sc->sc_flags & RTWN_FLAG_CCK_HIPWR) { 71 rpt = (cck->agc_rpt >> 5) & 0x03; 72 rssi = (cck->agc_rpt & 0x1f) << 1; 73 } else { 74 rpt = (cck->agc_rpt >> 6) & 0x03; 75 rssi = cck->agc_rpt & 0x3e; 76 } 77 rssi = cckoff[rpt] - rssi; 78 79 return (rssi); 80 } 81 82 int8_t 83 r92c_get_rssi_ofdm(struct rtwn_softc *sc, void *physt) 84 { 85 struct r92c_rx_phystat *phy = (struct r92c_rx_phystat *)physt; 86 int rssi; 87 88 /* Get average RSSI. */ 89 rssi = ((phy->pwdb_all >> 1) & 0x7f) - 110; 90 91 return (rssi); 92 } 93 94 uint8_t 95 r92c_rx_radiotap_flags(const void *buf) 96 { 97 const struct r92c_rx_stat *stat = buf; 98 uint8_t flags, rate; 99 100 if (!(stat->rxdw3 & htole32(R92C_RXDW3_SPLCP))) 101 return (0); 102 103 rate = MS(le32toh(stat->rxdw3), R92C_RXDW3_RATE); 104 if (RTWN_RATE_IS_CCK(rate)) 105 flags = IEEE80211_RADIOTAP_F_SHORTPRE; 106 else 107 flags = IEEE80211_RADIOTAP_F_SHORTGI; 108 return (flags); 109 } 110 111 void 112 r92c_get_rx_stats(struct rtwn_softc *sc, struct ieee80211_rx_stats *rxs, 113 const void *desc, const void *physt_ptr) 114 { 115 const struct r92c_rx_stat *stat = desc; 116 uint32_t rxdw1, rxdw3; 117 uint8_t rate; 118 119 rxdw1 = le32toh(stat->rxdw1); 120 rxdw3 = le32toh(stat->rxdw3); 121 rate = MS(rxdw3, R92C_RXDW3_RATE); 122 123 if (rxdw1 & R92C_RXDW1_AMPDU) 124 rxs->c_pktflags |= IEEE80211_RX_F_AMPDU; 125 else if (rxdw1 & R92C_RXDW1_AMPDU_MORE) 126 rxs->c_pktflags |= IEEE80211_RX_F_AMPDU_MORE; 127 if ((rxdw3 & R92C_RXDW3_SPLCP) && rate >= RTWN_RIDX_HT_MCS(0)) 128 rxs->c_pktflags |= IEEE80211_RX_F_SHORTGI; 129 130 if (rxdw3 & R92C_RXDW3_HT40) 131 rxs->c_width = IEEE80211_RX_FW_40MHZ; 132 else 133 rxs->c_width = IEEE80211_RX_FW_20MHZ; 134 135 if (RTWN_RATE_IS_CCK(rate)) 136 rxs->c_phytype = IEEE80211_RX_FP_11B; 137 else if (rate < RTWN_RIDX_HT_MCS(0)) 138 rxs->c_phytype = IEEE80211_RX_FP_11G; 139 else 140 rxs->c_phytype = IEEE80211_RX_FP_11NG; 141 142 /* Map HW rate index to 802.11 rate. */ 143 if (rate < RTWN_RIDX_HT_MCS(0)) { 144 rxs->c_rate = ridx2rate[rate]; 145 if (RTWN_RATE_IS_CCK(rate)) 146 rxs->c_pktflags |= IEEE80211_RX_F_CCK; 147 else 148 rxs->c_pktflags |= IEEE80211_RX_F_OFDM; 149 } else { /* MCS0~15. */ 150 rxs->c_rate = 151 IEEE80211_RATE_MCS | (rate - RTWN_RIDX_HT_MCS_SHIFT); 152 rxs->c_pktflags |= IEEE80211_RX_F_HT; 153 } 154 } 155