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 50 #include <dev/rtwn/if_rtwn_debug.h> 51 #include <dev/rtwn/if_rtwn_ridx.h> 52 53 #include <dev/rtwn/rtl8192c/r92c_var.h> 54 55 #include <dev/rtwn/rtl8188e/r88e.h> 56 #include <dev/rtwn/rtl8188e/r88e_priv.h> 57 #include <dev/rtwn/rtl8188e/r88e_reg.h> 58 59 60 static int 61 r88e_get_power_group(struct rtwn_softc *sc, struct ieee80211_channel *c) 62 { 63 uint8_t chan; 64 int group; 65 66 chan = rtwn_chan2centieee(c); 67 if (IEEE80211_IS_CHAN_2GHZ(c)) { 68 if (chan <= 2) group = 0; 69 else if (chan <= 5) group = 1; 70 else if (chan <= 8) group = 2; 71 else if (chan <= 11) group = 3; 72 else if (chan <= 13) group = 4; 73 else if (chan <= 14) group = 5; 74 else { 75 KASSERT(0, ("wrong 2GHz channel %d!\n", chan)); 76 return (-1); 77 } 78 } else { 79 KASSERT(0, ("wrong channel band (flags %08X)\n", c->ic_flags)); 80 return (-1); 81 } 82 83 return (group); 84 } 85 86 void 87 r88e_get_txpower(struct rtwn_softc *sc, int chain, 88 struct ieee80211_channel *c, uint8_t power[RTWN_RIDX_COUNT]) 89 { 90 struct r92c_softc *rs = sc->sc_priv; 91 const struct rtwn_r88e_txpwr *rt = rs->rs_txpwr; 92 uint8_t cckpow, ofdmpow, bw20pow, htpow = 0; 93 int max_mcs, ridx, group; 94 95 /* Determine channel group. */ 96 group = r88e_get_power_group(sc, c); 97 if (group == -1) { /* shouldn't happen */ 98 device_printf(sc->sc_dev, "%s: incorrect channel\n", __func__); 99 return; 100 } 101 102 /* XXX net80211 regulatory */ 103 104 max_mcs = RTWN_RIDX_HT_MCS(sc->ntxchains * 8 - 1); 105 KASSERT(max_mcs <= RTWN_RIDX_COUNT, ("increase ridx limit\n")); 106 107 memset(power, 0, max_mcs * sizeof(power[0])); 108 109 /* Compute per-CCK rate Tx power. */ 110 cckpow = rt->cck_tx_pwr[group]; 111 for (ridx = RTWN_RIDX_CCK1; ridx <= RTWN_RIDX_CCK11; ridx++) { 112 power[ridx] = (ridx == RTWN_RIDX_CCK2) ? cckpow - 9 : cckpow; 113 } 114 115 if (group < 5) 116 htpow = rt->ht40_tx_pwr[group]; 117 118 /* Compute per-OFDM rate Tx power. */ 119 ofdmpow = htpow + rt->ofdm_tx_pwr_diff; 120 for (ridx = RTWN_RIDX_OFDM6; ridx <= RTWN_RIDX_OFDM54; ridx++) 121 power[ridx] = ofdmpow; 122 123 bw20pow = htpow + rt->bw20_tx_pwr_diff; 124 for (ridx = RTWN_RIDX_HT_MCS(0); ridx <= max_mcs; ridx++) 125 power[ridx] = bw20pow; 126 127 /* Apply max limit. */ 128 for (ridx = RTWN_RIDX_CCK1; ridx <= max_mcs; ridx++) { 129 if (power[ridx] > R92C_MAX_TX_PWR) 130 power[ridx] = R92C_MAX_TX_PWR; 131 } 132 } 133 134 void 135 r88e_set_bw20(struct rtwn_softc *sc, uint8_t chan) 136 { 137 struct r92c_softc *rs = sc->sc_priv; 138 139 rtwn_setbits_1(sc, R92C_BWOPMODE, 0, R92C_BWOPMODE_20MHZ); 140 141 rtwn_bb_setbits(sc, R92C_FPGA0_RFMOD, R92C_RFMOD_40MHZ, 0); 142 rtwn_bb_setbits(sc, R92C_FPGA1_RFMOD, R92C_RFMOD_40MHZ, 0); 143 144 /* Select 20MHz bandwidth. */ 145 rtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 146 (rs->rf_chnlbw[0] & ~0xfff) | chan | R88E_RF_CHNLBW_BW20); 147 } 148 149 void 150 r88e_set_gain(struct rtwn_softc *sc, uint8_t gain) 151 { 152 153 rtwn_bb_setbits(sc, R92C_OFDM0_AGCCORE1(0), 154 R92C_OFDM0_AGCCORE1_GAIN_M, gain); 155 } 156