Changeset View
Changeset View
Standalone View
Standalone View
sys/dev/ral/rt2661.c
Show First 20 Lines • Show All 115 Lines • ▼ Show 20 Lines | |||||
static void rt2661_set_channel(struct ieee80211com *); | static void rt2661_set_channel(struct ieee80211com *); | ||||
static void rt2661_setup_tx_desc(struct rt2661_softc *, | static void rt2661_setup_tx_desc(struct rt2661_softc *, | ||||
struct rt2661_tx_desc *, uint32_t, uint16_t, int, | struct rt2661_tx_desc *, uint32_t, uint16_t, int, | ||||
int, const bus_dma_segment_t *, int, int); | int, const bus_dma_segment_t *, int, int); | ||||
static int rt2661_tx_data(struct rt2661_softc *, struct mbuf *, | static int rt2661_tx_data(struct rt2661_softc *, struct mbuf *, | ||||
struct ieee80211_node *, int); | struct ieee80211_node *, int); | ||||
static int rt2661_tx_mgt(struct rt2661_softc *, struct mbuf *, | static int rt2661_tx_mgt(struct rt2661_softc *, struct mbuf *, | ||||
struct ieee80211_node *); | struct ieee80211_node *); | ||||
static void rt2661_start_locked(struct ifnet *); | static int rt2661_transmit(struct ieee80211com *, struct mbuf *); | ||||
static void rt2661_start(struct ifnet *); | static void rt2661_start(struct rt2661_softc *); | ||||
static int rt2661_raw_xmit(struct ieee80211_node *, struct mbuf *, | static int rt2661_raw_xmit(struct ieee80211_node *, struct mbuf *, | ||||
const struct ieee80211_bpf_params *); | const struct ieee80211_bpf_params *); | ||||
static void rt2661_watchdog(void *); | static void rt2661_watchdog(void *); | ||||
static int rt2661_ioctl(struct ifnet *, u_long, caddr_t); | static void rt2661_parent(struct ieee80211com *); | ||||
static void rt2661_bbp_write(struct rt2661_softc *, uint8_t, | static void rt2661_bbp_write(struct rt2661_softc *, uint8_t, | ||||
uint8_t); | uint8_t); | ||||
static uint8_t rt2661_bbp_read(struct rt2661_softc *, uint8_t); | static uint8_t rt2661_bbp_read(struct rt2661_softc *, uint8_t); | ||||
static void rt2661_rf_write(struct rt2661_softc *, uint8_t, | static void rt2661_rf_write(struct rt2661_softc *, uint8_t, | ||||
uint32_t); | uint32_t); | ||||
static int rt2661_tx_cmd(struct rt2661_softc *, uint8_t, | static int rt2661_tx_cmd(struct rt2661_softc *, uint8_t, | ||||
uint16_t); | uint16_t); | ||||
static void rt2661_select_antenna(struct rt2661_softc *); | static void rt2661_select_antenna(struct rt2661_softc *); | ||||
▲ Show 20 Lines • Show All 54 Lines • ▼ Show 20 Lines | |||||
}, rt2661_rf5225_2[] = { | }, rt2661_rf5225_2[] = { | ||||
RT2661_RF5225_2 | RT2661_RF5225_2 | ||||
}; | }; | ||||
int | int | ||||
rt2661_attach(device_t dev, int id) | rt2661_attach(device_t dev, int id) | ||||
{ | { | ||||
struct rt2661_softc *sc = device_get_softc(dev); | struct rt2661_softc *sc = device_get_softc(dev); | ||||
struct ieee80211com *ic; | struct ieee80211com *ic = &sc->sc_ic; | ||||
struct ifnet *ifp; | |||||
uint32_t val; | uint32_t val; | ||||
int error, ac, ntries; | int error, ac, ntries; | ||||
uint8_t bands; | uint8_t bands; | ||||
uint8_t macaddr[IEEE80211_ADDR_LEN]; | |||||
sc->sc_id = id; | sc->sc_id = id; | ||||
sc->sc_dev = dev; | sc->sc_dev = dev; | ||||
ifp = sc->sc_ifp = if_alloc(IFT_IEEE80211); | |||||
if (ifp == NULL) { | |||||
device_printf(sc->sc_dev, "can not if_alloc()\n"); | |||||
return ENOMEM; | |||||
} | |||||
ic = ifp->if_l2com; | |||||
mtx_init(&sc->sc_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK, | mtx_init(&sc->sc_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK, | ||||
MTX_DEF | MTX_RECURSE); | MTX_DEF | MTX_RECURSE); | ||||
callout_init_mtx(&sc->watchdog_ch, &sc->sc_mtx, 0); | callout_init_mtx(&sc->watchdog_ch, &sc->sc_mtx, 0); | ||||
mbufq_init(&sc->sc_snd, ifqmaxlen); | |||||
/* wait for NIC to initialize */ | /* wait for NIC to initialize */ | ||||
for (ntries = 0; ntries < 1000; ntries++) { | for (ntries = 0; ntries < 1000; ntries++) { | ||||
if ((val = RAL_READ(sc, RT2661_MAC_CSR0)) != 0) | if ((val = RAL_READ(sc, RT2661_MAC_CSR0)) != 0) | ||||
break; | break; | ||||
DELAY(1000); | DELAY(1000); | ||||
} | } | ||||
if (ntries == 1000) { | if (ntries == 1000) { | ||||
device_printf(sc->sc_dev, | device_printf(sc->sc_dev, | ||||
"timeout waiting for NIC to initialize\n"); | "timeout waiting for NIC to initialize\n"); | ||||
error = EIO; | error = EIO; | ||||
goto fail1; | goto fail1; | ||||
} | } | ||||
/* retrieve RF rev. no and various other things from EEPROM */ | /* retrieve RF rev. no and various other things from EEPROM */ | ||||
rt2661_read_eeprom(sc, macaddr); | rt2661_read_eeprom(sc, ic->ic_macaddr); | ||||
device_printf(dev, "MAC/BBP RT%X, RF %s\n", val, | device_printf(dev, "MAC/BBP RT%X, RF %s\n", val, | ||||
rt2661_get_rf(sc->rf_rev)); | rt2661_get_rf(sc->rf_rev)); | ||||
/* | /* | ||||
* Allocate Tx and Rx rings. | * Allocate Tx and Rx rings. | ||||
*/ | */ | ||||
for (ac = 0; ac < 4; ac++) { | for (ac = 0; ac < 4; ac++) { | ||||
Show All 13 Lines | rt2661_attach(device_t dev, int id) | ||||
} | } | ||||
error = rt2661_alloc_rx_ring(sc, &sc->rxq, RT2661_RX_RING_COUNT); | error = rt2661_alloc_rx_ring(sc, &sc->rxq, RT2661_RX_RING_COUNT); | ||||
if (error != 0) { | if (error != 0) { | ||||
device_printf(sc->sc_dev, "could not allocate Rx ring\n"); | device_printf(sc->sc_dev, "could not allocate Rx ring\n"); | ||||
goto fail3; | goto fail3; | ||||
} | } | ||||
ifp->if_softc = sc; | |||||
if_initname(ifp, device_get_name(dev), device_get_unit(dev)); | |||||
ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; | |||||
ifp->if_init = rt2661_init; | |||||
ifp->if_ioctl = rt2661_ioctl; | |||||
ifp->if_start = rt2661_start; | |||||
IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen); | |||||
ifp->if_snd.ifq_drv_maxlen = ifqmaxlen; | |||||
IFQ_SET_READY(&ifp->if_snd); | |||||
ic->ic_ifp = ifp; | |||||
ic->ic_softc = sc; | ic->ic_softc = sc; | ||||
ic->ic_name = device_get_nameunit(dev); | ic->ic_name = device_get_nameunit(dev); | ||||
ic->ic_opmode = IEEE80211_M_STA; | ic->ic_opmode = IEEE80211_M_STA; | ||||
ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ | ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ | ||||
/* set device capabilities */ | /* set device capabilities */ | ||||
ic->ic_caps = | ic->ic_caps = | ||||
IEEE80211_C_STA /* station mode */ | IEEE80211_C_STA /* station mode */ | ||||
Show All 15 Lines | #endif | ||||
bands = 0; | bands = 0; | ||||
setbit(&bands, IEEE80211_MODE_11B); | setbit(&bands, IEEE80211_MODE_11B); | ||||
setbit(&bands, IEEE80211_MODE_11G); | setbit(&bands, IEEE80211_MODE_11G); | ||||
if (sc->rf_rev == RT2661_RF_5225 || sc->rf_rev == RT2661_RF_5325) | if (sc->rf_rev == RT2661_RF_5225 || sc->rf_rev == RT2661_RF_5325) | ||||
setbit(&bands, IEEE80211_MODE_11A); | setbit(&bands, IEEE80211_MODE_11A); | ||||
ieee80211_init_channels(ic, NULL, &bands); | ieee80211_init_channels(ic, NULL, &bands); | ||||
ieee80211_ifattach(ic, macaddr); | ieee80211_ifattach(ic); | ||||
#if 0 | #if 0 | ||||
ic->ic_wme.wme_update = rt2661_wme_update; | ic->ic_wme.wme_update = rt2661_wme_update; | ||||
#endif | #endif | ||||
ic->ic_scan_start = rt2661_scan_start; | ic->ic_scan_start = rt2661_scan_start; | ||||
ic->ic_scan_end = rt2661_scan_end; | ic->ic_scan_end = rt2661_scan_end; | ||||
ic->ic_set_channel = rt2661_set_channel; | ic->ic_set_channel = rt2661_set_channel; | ||||
ic->ic_updateslot = rt2661_update_slot; | ic->ic_updateslot = rt2661_update_slot; | ||||
ic->ic_update_promisc = rt2661_update_promisc; | ic->ic_update_promisc = rt2661_update_promisc; | ||||
ic->ic_raw_xmit = rt2661_raw_xmit; | ic->ic_raw_xmit = rt2661_raw_xmit; | ||||
ic->ic_transmit = rt2661_transmit; | |||||
ic->ic_parent = rt2661_parent; | |||||
ic->ic_vap_create = rt2661_vap_create; | ic->ic_vap_create = rt2661_vap_create; | ||||
ic->ic_vap_delete = rt2661_vap_delete; | ic->ic_vap_delete = rt2661_vap_delete; | ||||
ieee80211_radiotap_attach(ic, | ieee80211_radiotap_attach(ic, | ||||
&sc->sc_txtap.wt_ihdr, sizeof(sc->sc_txtap), | &sc->sc_txtap.wt_ihdr, sizeof(sc->sc_txtap), | ||||
RT2661_TX_RADIOTAP_PRESENT, | RT2661_TX_RADIOTAP_PRESENT, | ||||
&sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap), | &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap), | ||||
RT2661_RX_RADIOTAP_PRESENT); | RT2661_RX_RADIOTAP_PRESENT); | ||||
#ifdef RAL_DEBUG | #ifdef RAL_DEBUG | ||||
SYSCTL_ADD_INT(device_get_sysctl_ctx(dev), | SYSCTL_ADD_INT(device_get_sysctl_ctx(dev), | ||||
SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, | SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, | ||||
"debug", CTLFLAG_RW, &sc->sc_debug, 0, "debug msgs"); | "debug", CTLFLAG_RW, &sc->sc_debug, 0, "debug msgs"); | ||||
#endif | #endif | ||||
if (bootverbose) | if (bootverbose) | ||||
ieee80211_announce(ic); | ieee80211_announce(ic); | ||||
return 0; | return 0; | ||||
fail3: rt2661_free_tx_ring(sc, &sc->mgtq); | fail3: rt2661_free_tx_ring(sc, &sc->mgtq); | ||||
fail2: while (--ac >= 0) | fail2: while (--ac >= 0) | ||||
rt2661_free_tx_ring(sc, &sc->txq[ac]); | rt2661_free_tx_ring(sc, &sc->txq[ac]); | ||||
fail1: mtx_destroy(&sc->sc_mtx); | fail1: mtx_destroy(&sc->sc_mtx); | ||||
if_free(ifp); | |||||
return error; | return error; | ||||
} | } | ||||
int | int | ||||
rt2661_detach(void *xsc) | rt2661_detach(void *xsc) | ||||
{ | { | ||||
struct rt2661_softc *sc = xsc; | struct rt2661_softc *sc = xsc; | ||||
struct ifnet *ifp = sc->sc_ifp; | struct ieee80211com *ic = &sc->sc_ic; | ||||
struct ieee80211com *ic = ifp->if_l2com; | |||||
RAL_LOCK(sc); | RAL_LOCK(sc); | ||||
rt2661_stop_locked(sc); | rt2661_stop_locked(sc); | ||||
RAL_UNLOCK(sc); | RAL_UNLOCK(sc); | ||||
ieee80211_ifdetach(ic); | ieee80211_ifdetach(ic); | ||||
mbufq_drain(&sc->sc_snd); | |||||
rt2661_free_tx_ring(sc, &sc->txq[0]); | rt2661_free_tx_ring(sc, &sc->txq[0]); | ||||
rt2661_free_tx_ring(sc, &sc->txq[1]); | rt2661_free_tx_ring(sc, &sc->txq[1]); | ||||
rt2661_free_tx_ring(sc, &sc->txq[2]); | rt2661_free_tx_ring(sc, &sc->txq[2]); | ||||
rt2661_free_tx_ring(sc, &sc->txq[3]); | rt2661_free_tx_ring(sc, &sc->txq[3]); | ||||
rt2661_free_tx_ring(sc, &sc->mgtq); | rt2661_free_tx_ring(sc, &sc->mgtq); | ||||
rt2661_free_rx_ring(sc, &sc->rxq); | rt2661_free_rx_ring(sc, &sc->rxq); | ||||
if_free(ifp); | |||||
mtx_destroy(&sc->sc_mtx); | mtx_destroy(&sc->sc_mtx); | ||||
return 0; | return 0; | ||||
} | } | ||||
static struct ieee80211vap * | static struct ieee80211vap * | ||||
rt2661_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit, | rt2661_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit, | ||||
enum ieee80211_opmode opmode, int flags, | enum ieee80211_opmode opmode, int flags, | ||||
const uint8_t bssid[IEEE80211_ADDR_LEN], | const uint8_t bssid[IEEE80211_ADDR_LEN], | ||||
const uint8_t mac[IEEE80211_ADDR_LEN]) | const uint8_t mac[IEEE80211_ADDR_LEN]) | ||||
{ | { | ||||
struct ifnet *ifp = ic->ic_ifp; | struct rt2661_softc *sc = ic->ic_softc; | ||||
struct rt2661_vap *rvp; | struct rt2661_vap *rvp; | ||||
struct ieee80211vap *vap; | struct ieee80211vap *vap; | ||||
switch (opmode) { | switch (opmode) { | ||||
case IEEE80211_M_STA: | case IEEE80211_M_STA: | ||||
case IEEE80211_M_IBSS: | case IEEE80211_M_IBSS: | ||||
case IEEE80211_M_AHDEMO: | case IEEE80211_M_AHDEMO: | ||||
case IEEE80211_M_MONITOR: | case IEEE80211_M_MONITOR: | ||||
case IEEE80211_M_HOSTAP: | case IEEE80211_M_HOSTAP: | ||||
case IEEE80211_M_MBSS: | case IEEE80211_M_MBSS: | ||||
/* XXXRP: TBD */ | /* XXXRP: TBD */ | ||||
if (!TAILQ_EMPTY(&ic->ic_vaps)) { | if (!TAILQ_EMPTY(&ic->ic_vaps)) { | ||||
if_printf(ifp, "only 1 vap supported\n"); | device_printf(sc->sc_dev, "only 1 vap supported\n"); | ||||
return NULL; | return NULL; | ||||
} | } | ||||
if (opmode == IEEE80211_M_STA) | if (opmode == IEEE80211_M_STA) | ||||
flags |= IEEE80211_CLONE_NOBEACONS; | flags |= IEEE80211_CLONE_NOBEACONS; | ||||
break; | break; | ||||
case IEEE80211_M_WDS: | case IEEE80211_M_WDS: | ||||
if (TAILQ_EMPTY(&ic->ic_vaps) || | if (TAILQ_EMPTY(&ic->ic_vaps) || | ||||
ic->ic_opmode != IEEE80211_M_HOSTAP) { | ic->ic_opmode != IEEE80211_M_HOSTAP) { | ||||
if_printf(ifp, "wds only supported in ap mode\n"); | device_printf(sc->sc_dev, | ||||
"wds only supported in ap mode\n"); | |||||
return NULL; | return NULL; | ||||
} | } | ||||
/* | /* | ||||
* Silently remove any request for a unique | * Silently remove any request for a unique | ||||
* bssid; WDS vap's always share the local | * bssid; WDS vap's always share the local | ||||
* mac address. | * mac address. | ||||
*/ | */ | ||||
flags &= ~IEEE80211_CLONE_BSSID; | flags &= ~IEEE80211_CLONE_BSSID; | ||||
break; | break; | ||||
default: | default: | ||||
if_printf(ifp, "unknown opmode %d\n", opmode); | device_printf(sc->sc_dev, "unknown opmode %d\n", opmode); | ||||
return NULL; | return NULL; | ||||
} | } | ||||
rvp = (struct rt2661_vap *) malloc(sizeof(struct rt2661_vap), | rvp = malloc(sizeof(struct rt2661_vap), M_80211_VAP, M_WAITOK | M_ZERO); | ||||
M_80211_VAP, M_NOWAIT | M_ZERO); | |||||
if (rvp == NULL) | |||||
return NULL; | |||||
vap = &rvp->ral_vap; | vap = &rvp->ral_vap; | ||||
ieee80211_vap_setup(ic, vap, name, unit, opmode, flags, bssid, mac); | ieee80211_vap_setup(ic, vap, name, unit, opmode, flags, bssid); | ||||
/* override state transition machine */ | /* override state transition machine */ | ||||
rvp->ral_newstate = vap->iv_newstate; | rvp->ral_newstate = vap->iv_newstate; | ||||
vap->iv_newstate = rt2661_newstate; | vap->iv_newstate = rt2661_newstate; | ||||
#if 0 | #if 0 | ||||
vap->iv_update_beacon = rt2661_beacon_update; | vap->iv_update_beacon = rt2661_beacon_update; | ||||
#endif | #endif | ||||
ieee80211_ratectl_init(vap); | ieee80211_ratectl_init(vap); | ||||
/* complete setup */ | /* complete setup */ | ||||
ieee80211_vap_attach(vap, ieee80211_media_change, ieee80211_media_status); | ieee80211_vap_attach(vap, ieee80211_media_change, | ||||
ieee80211_media_status, mac); | |||||
if (TAILQ_FIRST(&ic->ic_vaps) == vap) | if (TAILQ_FIRST(&ic->ic_vaps) == vap) | ||||
ic->ic_opmode = opmode; | ic->ic_opmode = opmode; | ||||
return vap; | return vap; | ||||
} | } | ||||
static void | static void | ||||
rt2661_vap_delete(struct ieee80211vap *vap) | rt2661_vap_delete(struct ieee80211vap *vap) | ||||
{ | { | ||||
Show All 19 Lines | rt2661_suspend(void *xsc) | ||||
rt2661_stop(sc); | rt2661_stop(sc); | ||||
} | } | ||||
void | void | ||||
rt2661_resume(void *xsc) | rt2661_resume(void *xsc) | ||||
{ | { | ||||
struct rt2661_softc *sc = xsc; | struct rt2661_softc *sc = xsc; | ||||
struct ifnet *ifp = sc->sc_ifp; | |||||
if (ifp->if_flags & IFF_UP) | if (sc->sc_ic.ic_nrunning > 0) | ||||
rt2661_init(sc); | rt2661_init(sc); | ||||
} | } | ||||
static void | static void | ||||
rt2661_dma_map_addr(void *arg, bus_dma_segment_t *segs, int nseg, int error) | rt2661_dma_map_addr(void *arg, bus_dma_segment_t *segs, int nseg, int error) | ||||
{ | { | ||||
if (error != 0) | if (error != 0) | ||||
return; | return; | ||||
▲ Show 20 Lines • Show All 287 Lines • ▼ Show 20 Lines | if (ring->data_dmat != NULL) | ||||
bus_dma_tag_destroy(ring->data_dmat); | bus_dma_tag_destroy(ring->data_dmat); | ||||
} | } | ||||
static int | static int | ||||
rt2661_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) | rt2661_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) | ||||
{ | { | ||||
struct rt2661_vap *rvp = RT2661_VAP(vap); | struct rt2661_vap *rvp = RT2661_VAP(vap); | ||||
struct ieee80211com *ic = vap->iv_ic; | struct ieee80211com *ic = vap->iv_ic; | ||||
struct rt2661_softc *sc = ic->ic_ifp->if_softc; | struct rt2661_softc *sc = ic->ic_softc; | ||||
int error; | int error; | ||||
if (nstate == IEEE80211_S_INIT && vap->iv_state == IEEE80211_S_RUN) { | if (nstate == IEEE80211_S_INIT && vap->iv_state == IEEE80211_S_RUN) { | ||||
uint32_t tmp; | uint32_t tmp; | ||||
/* abort TSF synchronization */ | /* abort TSF synchronization */ | ||||
tmp = RAL_READ(sc, RT2661_TXRX_CSR9); | tmp = RAL_READ(sc, RT2661_TXRX_CSR9); | ||||
RAL_WRITE(sc, RT2661_TXRX_CSR9, tmp & ~0x00ffffff); | RAL_WRITE(sc, RT2661_TXRX_CSR9, tmp & ~0x00ffffff); | ||||
▲ Show 20 Lines • Show All 82 Lines • ▼ Show 20 Lines | rt2661_eeprom_read(struct rt2661_softc *sc, uint8_t addr) | ||||
RT2661_EEPROM_CTL(sc, RT2661_C); | RT2661_EEPROM_CTL(sc, RT2661_C); | ||||
return val; | return val; | ||||
} | } | ||||
static void | static void | ||||
rt2661_tx_intr(struct rt2661_softc *sc) | rt2661_tx_intr(struct rt2661_softc *sc) | ||||
{ | { | ||||
struct ifnet *ifp = sc->sc_ifp; | |||||
struct rt2661_tx_ring *txq; | struct rt2661_tx_ring *txq; | ||||
struct rt2661_tx_data *data; | struct rt2661_tx_data *data; | ||||
uint32_t val; | uint32_t val; | ||||
int qid, retrycnt; | int error, qid, retrycnt; | ||||
struct ieee80211vap *vap; | struct ieee80211vap *vap; | ||||
for (;;) { | for (;;) { | ||||
struct ieee80211_node *ni; | struct ieee80211_node *ni; | ||||
struct mbuf *m; | struct mbuf *m; | ||||
val = RAL_READ(sc, RT2661_STA_CSR4); | val = RAL_READ(sc, RT2661_STA_CSR4); | ||||
if (!(val & RT2661_TX_STAT_VALID)) | if (!(val & RT2661_TX_STAT_VALID)) | ||||
Show All 21 Lines | case RT2661_TX_SUCCESS: | ||||
retrycnt = RT2661_TX_RETRYCNT(val); | retrycnt = RT2661_TX_RETRYCNT(val); | ||||
DPRINTFN(sc, 10, "data frame sent successfully after " | DPRINTFN(sc, 10, "data frame sent successfully after " | ||||
"%d retries\n", retrycnt); | "%d retries\n", retrycnt); | ||||
if (data->rix != IEEE80211_FIXED_RATE_NONE) | if (data->rix != IEEE80211_FIXED_RATE_NONE) | ||||
ieee80211_ratectl_tx_complete(vap, ni, | ieee80211_ratectl_tx_complete(vap, ni, | ||||
IEEE80211_RATECTL_TX_SUCCESS, | IEEE80211_RATECTL_TX_SUCCESS, | ||||
&retrycnt, NULL); | &retrycnt, NULL); | ||||
if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1); | error = 0; | ||||
break; | break; | ||||
case RT2661_TX_RETRY_FAIL: | case RT2661_TX_RETRY_FAIL: | ||||
retrycnt = RT2661_TX_RETRYCNT(val); | retrycnt = RT2661_TX_RETRYCNT(val); | ||||
DPRINTFN(sc, 9, "%s\n", | DPRINTFN(sc, 9, "%s\n", | ||||
"sending data frame failed (too much retries)"); | "sending data frame failed (too much retries)"); | ||||
if (data->rix != IEEE80211_FIXED_RATE_NONE) | if (data->rix != IEEE80211_FIXED_RATE_NONE) | ||||
ieee80211_ratectl_tx_complete(vap, ni, | ieee80211_ratectl_tx_complete(vap, ni, | ||||
IEEE80211_RATECTL_TX_FAILURE, | IEEE80211_RATECTL_TX_FAILURE, | ||||
&retrycnt, NULL); | &retrycnt, NULL); | ||||
if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); | error = 1; | ||||
break; | break; | ||||
default: | default: | ||||
/* other failure */ | /* other failure */ | ||||
device_printf(sc->sc_dev, | device_printf(sc->sc_dev, | ||||
"sending data frame failed 0x%08x\n", val); | "sending data frame failed 0x%08x\n", val); | ||||
if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); | error = 1; | ||||
} | } | ||||
DPRINTFN(sc, 15, "tx done q=%d idx=%u\n", qid, txq->stat); | DPRINTFN(sc, 15, "tx done q=%d idx=%u\n", qid, txq->stat); | ||||
txq->queued--; | txq->queued--; | ||||
if (++txq->stat >= txq->count) /* faster than % count */ | if (++txq->stat >= txq->count) /* faster than % count */ | ||||
txq->stat = 0; | txq->stat = 0; | ||||
if (m->m_flags & M_TXCB) | ieee80211_tx_complete(ni, m, error); | ||||
ieee80211_process_callback(ni, m, | |||||
RT2661_TX_RESULT(val) != RT2661_TX_SUCCESS); | |||||
m_freem(m); | |||||
ieee80211_free_node(ni); | |||||
} | } | ||||
sc->sc_tx_timer = 0; | sc->sc_tx_timer = 0; | ||||
ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; | |||||
rt2661_start_locked(ifp); | rt2661_start(sc); | ||||
} | } | ||||
static void | static void | ||||
rt2661_tx_dma_intr(struct rt2661_softc *sc, struct rt2661_tx_ring *txq) | rt2661_tx_dma_intr(struct rt2661_softc *sc, struct rt2661_tx_ring *txq) | ||||
{ | { | ||||
struct rt2661_tx_desc *desc; | struct rt2661_tx_desc *desc; | ||||
struct rt2661_tx_data *data; | struct rt2661_tx_data *data; | ||||
Show All 21 Lines | rt2661_tx_dma_intr(struct rt2661_softc *sc, struct rt2661_tx_ring *txq) | ||||
} | } | ||||
bus_dmamap_sync(txq->desc_dmat, txq->desc_map, BUS_DMASYNC_PREWRITE); | bus_dmamap_sync(txq->desc_dmat, txq->desc_map, BUS_DMASYNC_PREWRITE); | ||||
} | } | ||||
static void | static void | ||||
rt2661_rx_intr(struct rt2661_softc *sc) | rt2661_rx_intr(struct rt2661_softc *sc) | ||||
{ | { | ||||
struct ifnet *ifp = sc->sc_ifp; | struct ieee80211com *ic = &sc->sc_ic; | ||||
struct ieee80211com *ic = ifp->if_l2com; | |||||
struct rt2661_rx_desc *desc; | struct rt2661_rx_desc *desc; | ||||
struct rt2661_rx_data *data; | struct rt2661_rx_data *data; | ||||
bus_addr_t physaddr; | bus_addr_t physaddr; | ||||
struct ieee80211_frame *wh; | struct ieee80211_frame *wh; | ||||
struct ieee80211_node *ni; | struct ieee80211_node *ni; | ||||
struct mbuf *mnew, *m; | struct mbuf *mnew, *m; | ||||
int error; | int error; | ||||
Show All 12 Lines | for (;;) { | ||||
if ((le32toh(desc->flags) & RT2661_RX_PHY_ERROR) || | if ((le32toh(desc->flags) & RT2661_RX_PHY_ERROR) || | ||||
(le32toh(desc->flags) & RT2661_RX_CRC_ERROR)) { | (le32toh(desc->flags) & RT2661_RX_CRC_ERROR)) { | ||||
/* | /* | ||||
* This should not happen since we did not request | * This should not happen since we did not request | ||||
* to receive those frames when we filled TXRX_CSR0. | * to receive those frames when we filled TXRX_CSR0. | ||||
*/ | */ | ||||
DPRINTFN(sc, 5, "PHY or CRC error flags 0x%08x\n", | DPRINTFN(sc, 5, "PHY or CRC error flags 0x%08x\n", | ||||
le32toh(desc->flags)); | le32toh(desc->flags)); | ||||
if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); | counter_u64_add(ic->ic_ierrors, 1); | ||||
goto skip; | goto skip; | ||||
} | } | ||||
if ((le32toh(desc->flags) & RT2661_RX_CIPHER_MASK) != 0) { | if ((le32toh(desc->flags) & RT2661_RX_CIPHER_MASK) != 0) { | ||||
if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); | counter_u64_add(ic->ic_ierrors, 1); | ||||
goto skip; | goto skip; | ||||
} | } | ||||
/* | /* | ||||
* Try to allocate a new mbuf for this ring element and load it | * Try to allocate a new mbuf for this ring element and load it | ||||
* before processing the current mbuf. If the ring element | * before processing the current mbuf. If the ring element | ||||
* cannot be loaded, drop the received packet and reuse the old | * cannot be loaded, drop the received packet and reuse the old | ||||
* mbuf. In the unlikely case that the old mbuf can't be | * mbuf. In the unlikely case that the old mbuf can't be | ||||
* reloaded either, explicitly panic. | * reloaded either, explicitly panic. | ||||
*/ | */ | ||||
mnew = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); | mnew = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); | ||||
if (mnew == NULL) { | if (mnew == NULL) { | ||||
if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); | counter_u64_add(ic->ic_ierrors, 1); | ||||
goto skip; | goto skip; | ||||
} | } | ||||
bus_dmamap_sync(sc->rxq.data_dmat, data->map, | bus_dmamap_sync(sc->rxq.data_dmat, data->map, | ||||
BUS_DMASYNC_POSTREAD); | BUS_DMASYNC_POSTREAD); | ||||
bus_dmamap_unload(sc->rxq.data_dmat, data->map); | bus_dmamap_unload(sc->rxq.data_dmat, data->map); | ||||
error = bus_dmamap_load(sc->rxq.data_dmat, data->map, | error = bus_dmamap_load(sc->rxq.data_dmat, data->map, | ||||
mtod(mnew, void *), MCLBYTES, rt2661_dma_map_addr, | mtod(mnew, void *), MCLBYTES, rt2661_dma_map_addr, | ||||
&physaddr, 0); | &physaddr, 0); | ||||
if (error != 0) { | if (error != 0) { | ||||
m_freem(mnew); | m_freem(mnew); | ||||
/* try to reload the old mbuf */ | /* try to reload the old mbuf */ | ||||
error = bus_dmamap_load(sc->rxq.data_dmat, data->map, | error = bus_dmamap_load(sc->rxq.data_dmat, data->map, | ||||
mtod(data->m, void *), MCLBYTES, | mtod(data->m, void *), MCLBYTES, | ||||
rt2661_dma_map_addr, &physaddr, 0); | rt2661_dma_map_addr, &physaddr, 0); | ||||
if (error != 0) { | if (error != 0) { | ||||
/* very unlikely that it will fail... */ | /* very unlikely that it will fail... */ | ||||
panic("%s: could not load old rx mbuf", | panic("%s: could not load old rx mbuf", | ||||
device_get_name(sc->sc_dev)); | device_get_name(sc->sc_dev)); | ||||
} | } | ||||
if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); | counter_u64_add(ic->ic_ierrors, 1); | ||||
goto skip; | goto skip; | ||||
} | } | ||||
/* | /* | ||||
* New mbuf successfully loaded, update Rx ring and continue | * New mbuf successfully loaded, update Rx ring and continue | ||||
* processing. | * processing. | ||||
*/ | */ | ||||
m = data->m; | m = data->m; | ||||
data->m = mnew; | data->m = mnew; | ||||
desc->physaddr = htole32(physaddr); | desc->physaddr = htole32(physaddr); | ||||
/* finalize mbuf */ | /* finalize mbuf */ | ||||
m->m_pkthdr.rcvif = ifp; | |||||
m->m_pkthdr.len = m->m_len = | m->m_pkthdr.len = m->m_len = | ||||
(le32toh(desc->flags) >> 16) & 0xfff; | (le32toh(desc->flags) >> 16) & 0xfff; | ||||
rssi = rt2661_get_rssi(sc, desc->rssi); | rssi = rt2661_get_rssi(sc, desc->rssi); | ||||
/* Error happened during RSSI conversion. */ | /* Error happened during RSSI conversion. */ | ||||
if (rssi < 0) | if (rssi < 0) | ||||
rssi = -30; /* XXX ignored by net80211 */ | rssi = -30; /* XXX ignored by net80211 */ | ||||
nf = RT2661_NOISE_FLOOR; | nf = RT2661_NOISE_FLOOR; | ||||
▲ Show 20 Lines • Show All 68 Lines • ▼ Show 20 Lines | rt2661_mcu_cmd_intr(struct rt2661_softc *sc) | ||||
RAL_READ(sc, RT2661_M2H_CMD_DONE_CSR); | RAL_READ(sc, RT2661_M2H_CMD_DONE_CSR); | ||||
RAL_WRITE(sc, RT2661_M2H_CMD_DONE_CSR, 0xffffffff); | RAL_WRITE(sc, RT2661_M2H_CMD_DONE_CSR, 0xffffffff); | ||||
} | } | ||||
void | void | ||||
rt2661_intr(void *arg) | rt2661_intr(void *arg) | ||||
{ | { | ||||
struct rt2661_softc *sc = arg; | struct rt2661_softc *sc = arg; | ||||
struct ifnet *ifp = sc->sc_ifp; | |||||
uint32_t r1, r2; | uint32_t r1, r2; | ||||
RAL_LOCK(sc); | RAL_LOCK(sc); | ||||
/* disable MAC and MCU interrupts */ | /* disable MAC and MCU interrupts */ | ||||
RAL_WRITE(sc, RT2661_INT_MASK_CSR, 0xffffff7f); | RAL_WRITE(sc, RT2661_INT_MASK_CSR, 0xffffff7f); | ||||
RAL_WRITE(sc, RT2661_MCU_INT_MASK_CSR, 0xffffffff); | RAL_WRITE(sc, RT2661_MCU_INT_MASK_CSR, 0xffffffff); | ||||
/* don't re-enable interrupts if we're shutting down */ | /* don't re-enable interrupts if we're shutting down */ | ||||
if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) { | if (!(sc->sc_flags & RAL_RUNNING)) { | ||||
RAL_UNLOCK(sc); | RAL_UNLOCK(sc); | ||||
return; | return; | ||||
} | } | ||||
r1 = RAL_READ(sc, RT2661_INT_SOURCE_CSR); | r1 = RAL_READ(sc, RT2661_INT_SOURCE_CSR); | ||||
RAL_WRITE(sc, RT2661_INT_SOURCE_CSR, r1); | RAL_WRITE(sc, RT2661_INT_SOURCE_CSR, r1); | ||||
r2 = RAL_READ(sc, RT2661_MCU_INT_SOURCE_CSR); | r2 = RAL_READ(sc, RT2661_MCU_INT_SOURCE_CSR); | ||||
▲ Show 20 Lines • Show All 59 Lines • ▼ Show 20 Lines | rt2661_plcp_signal(int rate) | ||||
return 0xff; /* XXX unsupported/unknown rate */ | return 0xff; /* XXX unsupported/unknown rate */ | ||||
} | } | ||||
static void | static void | ||||
rt2661_setup_tx_desc(struct rt2661_softc *sc, struct rt2661_tx_desc *desc, | rt2661_setup_tx_desc(struct rt2661_softc *sc, struct rt2661_tx_desc *desc, | ||||
uint32_t flags, uint16_t xflags, int len, int rate, | uint32_t flags, uint16_t xflags, int len, int rate, | ||||
const bus_dma_segment_t *segs, int nsegs, int ac) | const bus_dma_segment_t *segs, int nsegs, int ac) | ||||
{ | { | ||||
struct ifnet *ifp = sc->sc_ifp; | struct ieee80211com *ic = &sc->sc_ic; | ||||
struct ieee80211com *ic = ifp->if_l2com; | |||||
uint16_t plcp_length; | uint16_t plcp_length; | ||||
int i, remainder; | int i, remainder; | ||||
desc->flags = htole32(flags); | desc->flags = htole32(flags); | ||||
desc->flags |= htole32(len << 16); | desc->flags |= htole32(len << 16); | ||||
desc->flags |= htole32(RT2661_TX_BUSY | RT2661_TX_VALID); | desc->flags |= htole32(RT2661_TX_BUSY | RT2661_TX_VALID); | ||||
desc->xflags = htole16(xflags); | desc->xflags = htole16(xflags); | ||||
▲ Show 20 Lines • Show All 201 Lines • ▼ Show 20 Lines | rt2661_sendprot(struct rt2661_softc *sc, int ac, | ||||
return 0; | return 0; | ||||
} | } | ||||
static int | static int | ||||
rt2661_tx_data(struct rt2661_softc *sc, struct mbuf *m0, | rt2661_tx_data(struct rt2661_softc *sc, struct mbuf *m0, | ||||
struct ieee80211_node *ni, int ac) | struct ieee80211_node *ni, int ac) | ||||
{ | { | ||||
struct ieee80211vap *vap = ni->ni_vap; | struct ieee80211vap *vap = ni->ni_vap; | ||||
struct ifnet *ifp = sc->sc_ifp; | struct ieee80211com *ic = &sc->sc_ic; | ||||
struct ieee80211com *ic = ifp->if_l2com; | |||||
struct rt2661_tx_ring *txq = &sc->txq[ac]; | struct rt2661_tx_ring *txq = &sc->txq[ac]; | ||||
struct rt2661_tx_desc *desc; | struct rt2661_tx_desc *desc; | ||||
struct rt2661_tx_data *data; | struct rt2661_tx_data *data; | ||||
struct ieee80211_frame *wh; | struct ieee80211_frame *wh; | ||||
const struct ieee80211_txparam *tp; | const struct ieee80211_txparam *tp; | ||||
struct ieee80211_key *k; | struct ieee80211_key *k; | ||||
const struct chanAccParams *cap; | const struct chanAccParams *cap; | ||||
struct mbuf *mnew; | struct mbuf *mnew; | ||||
▲ Show 20 Lines • Show All 125 Lines • ▼ Show 20 Lines | rt2661_tx_data(struct rt2661_softc *sc, struct mbuf *m0, | ||||
/* kick Tx */ | /* kick Tx */ | ||||
txq->queued++; | txq->queued++; | ||||
txq->cur = (txq->cur + 1) % RT2661_TX_RING_COUNT; | txq->cur = (txq->cur + 1) % RT2661_TX_RING_COUNT; | ||||
RAL_WRITE(sc, RT2661_TX_CNTL_CSR, 1 << ac); | RAL_WRITE(sc, RT2661_TX_CNTL_CSR, 1 << ac); | ||||
return 0; | return 0; | ||||
} | } | ||||
static int | |||||
rt2661_transmit(struct ieee80211com *ic, struct mbuf *m) | |||||
{ | |||||
struct rt2661_softc *sc = ic->ic_softc; | |||||
int error; | |||||
RAL_LOCK(sc); | |||||
if ((sc->sc_flags & RAL_RUNNING) == 0) { | |||||
RAL_UNLOCK(sc); | |||||
return (ENXIO); | |||||
} | |||||
error = mbufq_enqueue(&sc->sc_snd, m); | |||||
if (error) { | |||||
RAL_UNLOCK(sc); | |||||
return (error); | |||||
} | |||||
rt2661_start(sc); | |||||
RAL_UNLOCK(sc); | |||||
return (0); | |||||
} | |||||
static void | static void | ||||
rt2661_start_locked(struct ifnet *ifp) | rt2661_start(struct rt2661_softc *sc) | ||||
{ | { | ||||
struct rt2661_softc *sc = ifp->if_softc; | |||||
struct mbuf *m; | struct mbuf *m; | ||||
struct ieee80211_node *ni; | struct ieee80211_node *ni; | ||||
int ac; | int ac; | ||||
RAL_LOCK_ASSERT(sc); | RAL_LOCK_ASSERT(sc); | ||||
/* prevent management frames from being sent if we're not ready */ | /* prevent management frames from being sent if we're not ready */ | ||||
if (!(ifp->if_drv_flags & IFF_DRV_RUNNING) || sc->sc_invalid) | if (!(sc->sc_flags & RAL_RUNNING) || sc->sc_invalid) | ||||
return; | return; | ||||
for (;;) { | while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) { | ||||
IFQ_DRV_DEQUEUE(&ifp->if_snd, m); | |||||
if (m == NULL) | |||||
break; | |||||
ac = M_WME_GETAC(m); | ac = M_WME_GETAC(m); | ||||
if (sc->txq[ac].queued >= RT2661_TX_RING_COUNT - 1) { | if (sc->txq[ac].queued >= RT2661_TX_RING_COUNT - 1) { | ||||
/* there is no place left in this ring */ | /* there is no place left in this ring */ | ||||
IFQ_DRV_PREPEND(&ifp->if_snd, m); | mbufq_prepend(&sc->sc_snd, m); | ||||
ifp->if_drv_flags |= IFF_DRV_OACTIVE; | |||||
break; | break; | ||||
} | } | ||||
ni = (struct ieee80211_node *) m->m_pkthdr.rcvif; | ni = (struct ieee80211_node *) m->m_pkthdr.rcvif; | ||||
if (rt2661_tx_data(sc, m, ni, ac) != 0) { | if (rt2661_tx_data(sc, m, ni, ac) != 0) { | ||||
ieee80211_free_node(ni); | ieee80211_free_node(ni); | ||||
if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); | if_inc_counter(ni->ni_vap->iv_ifp, | ||||
IFCOUNTER_OERRORS, 1); | |||||
break; | break; | ||||
} | } | ||||
sc->sc_tx_timer = 5; | sc->sc_tx_timer = 5; | ||||
} | } | ||||
} | } | ||||
static void | |||||
rt2661_start(struct ifnet *ifp) | |||||
{ | |||||
struct rt2661_softc *sc = ifp->if_softc; | |||||
RAL_LOCK(sc); | |||||
rt2661_start_locked(ifp); | |||||
RAL_UNLOCK(sc); | |||||
} | |||||
static int | static int | ||||
rt2661_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, | rt2661_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, | ||||
const struct ieee80211_bpf_params *params) | const struct ieee80211_bpf_params *params) | ||||
{ | { | ||||
struct ieee80211com *ic = ni->ni_ic; | struct ieee80211com *ic = ni->ni_ic; | ||||
struct ifnet *ifp = ic->ic_ifp; | struct rt2661_softc *sc = ic->ic_softc; | ||||
struct rt2661_softc *sc = ifp->if_softc; | |||||
RAL_LOCK(sc); | RAL_LOCK(sc); | ||||
/* prevent management frames from being sent if we're not ready */ | /* prevent management frames from being sent if we're not ready */ | ||||
if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) { | if (!(sc->sc_flags & RAL_RUNNING)) { | ||||
RAL_UNLOCK(sc); | RAL_UNLOCK(sc); | ||||
m_freem(m); | m_freem(m); | ||||
ieee80211_free_node(ni); | ieee80211_free_node(ni); | ||||
return ENETDOWN; | return ENETDOWN; | ||||
} | } | ||||
if (sc->mgtq.queued >= RT2661_MGT_RING_COUNT) { | if (sc->mgtq.queued >= RT2661_MGT_RING_COUNT) { | ||||
ifp->if_drv_flags |= IFF_DRV_OACTIVE; | |||||
RAL_UNLOCK(sc); | RAL_UNLOCK(sc); | ||||
m_freem(m); | m_freem(m); | ||||
ieee80211_free_node(ni); | ieee80211_free_node(ni); | ||||
return ENOBUFS; /* XXX */ | return ENOBUFS; /* XXX */ | ||||
} | } | ||||
if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1); | |||||
/* | /* | ||||
* Legacy path; interpret frame contents to decide | * Legacy path; interpret frame contents to decide | ||||
* precisely how to send the frame. | * precisely how to send the frame. | ||||
* XXX raw path | * XXX raw path | ||||
*/ | */ | ||||
if (rt2661_tx_mgt(sc, m, ni) != 0) | if (rt2661_tx_mgt(sc, m, ni) != 0) | ||||
goto bad; | goto bad; | ||||
sc->sc_tx_timer = 5; | sc->sc_tx_timer = 5; | ||||
RAL_UNLOCK(sc); | RAL_UNLOCK(sc); | ||||
return 0; | return 0; | ||||
bad: | bad: | ||||
if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); | |||||
ieee80211_free_node(ni); | ieee80211_free_node(ni); | ||||
RAL_UNLOCK(sc); | RAL_UNLOCK(sc); | ||||
return EIO; /* XXX */ | return EIO; /* XXX */ | ||||
} | } | ||||
static void | static void | ||||
rt2661_watchdog(void *arg) | rt2661_watchdog(void *arg) | ||||
{ | { | ||||
struct rt2661_softc *sc = (struct rt2661_softc *)arg; | struct rt2661_softc *sc = (struct rt2661_softc *)arg; | ||||
struct ifnet *ifp = sc->sc_ifp; | |||||
RAL_LOCK_ASSERT(sc); | RAL_LOCK_ASSERT(sc); | ||||
KASSERT(ifp->if_drv_flags & IFF_DRV_RUNNING, ("not running")); | KASSERT(ifp->if_drv_flags & RAL_RUNNING, ("not running")); | ||||
if (sc->sc_invalid) /* card ejected */ | if (sc->sc_invalid) /* card ejected */ | ||||
return; | return; | ||||
if (sc->sc_tx_timer > 0 && --sc->sc_tx_timer == 0) { | if (sc->sc_tx_timer > 0 && --sc->sc_tx_timer == 0) { | ||||
if_printf(ifp, "device timeout\n"); | device_printf(sc->sc_dev, "device timeout\n"); | ||||
rt2661_init_locked(sc); | rt2661_init_locked(sc); | ||||
if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); | counter_u64_add(sc->sc_ic.ic_oerrors, 1); | ||||
/* NB: callout is reset in rt2661_init() */ | /* NB: callout is reset in rt2661_init() */ | ||||
return; | return; | ||||
} | } | ||||
callout_reset(&sc->watchdog_ch, hz, rt2661_watchdog, sc); | callout_reset(&sc->watchdog_ch, hz, rt2661_watchdog, sc); | ||||
} | } | ||||
static int | static void | ||||
rt2661_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) | rt2661_parent(struct ieee80211com *ic) | ||||
{ | { | ||||
struct rt2661_softc *sc = ifp->if_softc; | struct rt2661_softc *sc = ic->ic_softc; | ||||
struct ieee80211com *ic = ifp->if_l2com; | int startall = 0; | ||||
struct ifreq *ifr = (struct ifreq *) data; | |||||
int error = 0, startall = 0; | |||||
switch (cmd) { | |||||
case SIOCSIFFLAGS: | |||||
RAL_LOCK(sc); | RAL_LOCK(sc); | ||||
if (ifp->if_flags & IFF_UP) { | if (ic->ic_nrunning > 0) { | ||||
if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) { | if ((sc->sc_flags & RAL_RUNNING) == 0) { | ||||
rt2661_init_locked(sc); | rt2661_init_locked(sc); | ||||
startall = 1; | startall = 1; | ||||
} else | } else | ||||
rt2661_update_promisc(ic); | rt2661_update_promisc(ic); | ||||
} else { | } else if (sc->sc_flags & RAL_RUNNING) | ||||
if (ifp->if_drv_flags & IFF_DRV_RUNNING) | |||||
rt2661_stop_locked(sc); | rt2661_stop_locked(sc); | ||||
} | |||||
RAL_UNLOCK(sc); | RAL_UNLOCK(sc); | ||||
if (startall) | if (startall) | ||||
ieee80211_start_all(ic); | ieee80211_start_all(ic); | ||||
break; | |||||
case SIOCGIFMEDIA: | |||||
error = ifmedia_ioctl(ifp, ifr, &ic->ic_media, cmd); | |||||
break; | |||||
case SIOCGIFADDR: | |||||
error = ether_ioctl(ifp, cmd, data); | |||||
break; | |||||
default: | |||||
error = EINVAL; | |||||
break; | |||||
} | } | ||||
return error; | |||||
} | |||||
static void | static void | ||||
rt2661_bbp_write(struct rt2661_softc *sc, uint8_t reg, uint8_t val) | rt2661_bbp_write(struct rt2661_softc *sc, uint8_t reg, uint8_t val) | ||||
{ | { | ||||
uint32_t tmp; | uint32_t tmp; | ||||
int ntries; | int ntries; | ||||
for (ntries = 0; ntries < 100; ntries++) { | for (ntries = 0; ntries < 100; ntries++) { | ||||
▲ Show 20 Lines • Show All 106 Lines • ▼ Show 20 Lines | |||||
/* | /* | ||||
* Enable multi-rate retries for frames sent at OFDM rates. | * Enable multi-rate retries for frames sent at OFDM rates. | ||||
* In 802.11b/g mode, allow fallback to CCK rates. | * In 802.11b/g mode, allow fallback to CCK rates. | ||||
*/ | */ | ||||
static void | static void | ||||
rt2661_enable_mrr(struct rt2661_softc *sc) | rt2661_enable_mrr(struct rt2661_softc *sc) | ||||
{ | { | ||||
struct ifnet *ifp = sc->sc_ifp; | struct ieee80211com *ic = &sc->sc_ic; | ||||
struct ieee80211com *ic = ifp->if_l2com; | |||||
uint32_t tmp; | uint32_t tmp; | ||||
tmp = RAL_READ(sc, RT2661_TXRX_CSR4); | tmp = RAL_READ(sc, RT2661_TXRX_CSR4); | ||||
tmp &= ~RT2661_MRR_CCK_FALLBACK; | tmp &= ~RT2661_MRR_CCK_FALLBACK; | ||||
if (!IEEE80211_IS_CHAN_5GHZ(ic->ic_bsschan)) | if (!IEEE80211_IS_CHAN_5GHZ(ic->ic_bsschan)) | ||||
tmp |= RT2661_MRR_CCK_FALLBACK; | tmp |= RT2661_MRR_CCK_FALLBACK; | ||||
tmp |= RT2661_MRR_ENABLED; | tmp |= RT2661_MRR_ENABLED; | ||||
RAL_WRITE(sc, RT2661_TXRX_CSR4, tmp); | RAL_WRITE(sc, RT2661_TXRX_CSR4, tmp); | ||||
} | } | ||||
static void | static void | ||||
rt2661_set_txpreamble(struct rt2661_softc *sc) | rt2661_set_txpreamble(struct rt2661_softc *sc) | ||||
{ | { | ||||
struct ifnet *ifp = sc->sc_ifp; | struct ieee80211com *ic = &sc->sc_ic; | ||||
struct ieee80211com *ic = ifp->if_l2com; | |||||
uint32_t tmp; | uint32_t tmp; | ||||
tmp = RAL_READ(sc, RT2661_TXRX_CSR4); | tmp = RAL_READ(sc, RT2661_TXRX_CSR4); | ||||
tmp &= ~RT2661_SHORT_PREAMBLE; | tmp &= ~RT2661_SHORT_PREAMBLE; | ||||
if (ic->ic_flags & IEEE80211_F_SHPREAMBLE) | if (ic->ic_flags & IEEE80211_F_SHPREAMBLE) | ||||
tmp |= RT2661_SHORT_PREAMBLE; | tmp |= RT2661_SHORT_PREAMBLE; | ||||
RAL_WRITE(sc, RT2661_TXRX_CSR4, tmp); | RAL_WRITE(sc, RT2661_TXRX_CSR4, tmp); | ||||
} | } | ||||
static void | static void | ||||
rt2661_set_basicrates(struct rt2661_softc *sc, | rt2661_set_basicrates(struct rt2661_softc *sc, | ||||
const struct ieee80211_rateset *rs) | const struct ieee80211_rateset *rs) | ||||
{ | { | ||||
#define RV(r) ((r) & IEEE80211_RATE_VAL) | #define RV(r) ((r) & IEEE80211_RATE_VAL) | ||||
struct ifnet *ifp = sc->sc_ifp; | struct ieee80211com *ic = &sc->sc_ic; | ||||
struct ieee80211com *ic = ifp->if_l2com; | |||||
uint32_t mask = 0; | uint32_t mask = 0; | ||||
uint8_t rate; | uint8_t rate; | ||||
int i; | int i; | ||||
for (i = 0; i < rs->rs_nrates; i++) { | for (i = 0; i < rs->rs_nrates; i++) { | ||||
rate = rs->rs_rates[i]; | rate = rs->rs_rates[i]; | ||||
if (!(rate & IEEE80211_RATE_BASIC)) | if (!(rate & IEEE80211_RATE_BASIC)) | ||||
▲ Show 20 Lines • Show All 52 Lines • ▼ Show 20 Lines | rt2661_select_band(struct rt2661_softc *sc, struct ieee80211_channel *c) | ||||
else | else | ||||
tmp |= RT2661_PA_PE_5GHZ; | tmp |= RT2661_PA_PE_5GHZ; | ||||
RAL_WRITE(sc, RT2661_PHY_CSR0, tmp); | RAL_WRITE(sc, RT2661_PHY_CSR0, tmp); | ||||
} | } | ||||
static void | static void | ||||
rt2661_set_chan(struct rt2661_softc *sc, struct ieee80211_channel *c) | rt2661_set_chan(struct rt2661_softc *sc, struct ieee80211_channel *c) | ||||
{ | { | ||||
struct ifnet *ifp = sc->sc_ifp; | struct ieee80211com *ic = &sc->sc_ic; | ||||
struct ieee80211com *ic = ifp->if_l2com; | |||||
const struct rfprog *rfprog; | const struct rfprog *rfprog; | ||||
uint8_t bbp3, bbp94 = RT2661_BBPR94_DEFAULT; | uint8_t bbp3, bbp94 = RT2661_BBPR94_DEFAULT; | ||||
int8_t power; | int8_t power; | ||||
u_int i, chan; | u_int i, chan; | ||||
chan = ieee80211_chan2ieee(ic, c); | chan = ieee80211_chan2ieee(ic, c); | ||||
KASSERT(chan != 0 && chan != IEEE80211_CHAN_ANY, ("chan 0x%x", chan)); | KASSERT(chan != 0 && chan != IEEE80211_CHAN_ANY, ("chan 0x%x", chan)); | ||||
▲ Show 20 Lines • Show All 86 Lines • ▼ Show 20 Lines | |||||
rt2661_update_promisc(struct ieee80211com *ic) | rt2661_update_promisc(struct ieee80211com *ic) | ||||
{ | { | ||||
struct rt2661_softc *sc = ic->ic_softc; | struct rt2661_softc *sc = ic->ic_softc; | ||||
uint32_t tmp; | uint32_t tmp; | ||||
tmp = RAL_READ(sc, RT2661_TXRX_CSR0); | tmp = RAL_READ(sc, RT2661_TXRX_CSR0); | ||||
tmp &= ~RT2661_DROP_NOT_TO_ME; | tmp &= ~RT2661_DROP_NOT_TO_ME; | ||||
if (!(ic->ic_ifp->if_flags & IFF_PROMISC)) | if (ic->ic_promisc == 0) | ||||
tmp |= RT2661_DROP_NOT_TO_ME; | tmp |= RT2661_DROP_NOT_TO_ME; | ||||
RAL_WRITE(sc, RT2661_TXRX_CSR0, tmp); | RAL_WRITE(sc, RT2661_TXRX_CSR0, tmp); | ||||
DPRINTF(sc, "%s promiscuous mode\n", | DPRINTF(sc, "%s promiscuous mode\n", | ||||
(ic->ic_ifp->if_flags & IFF_PROMISC) ? "entering" : "leaving"); | (ic->ic_promisc > 0) ? "entering" : "leaving"); | ||||
} | } | ||||
/* | /* | ||||
* Update QoS (802.11e) settings for each h/w Tx ring. | * Update QoS (802.11e) settings for each h/w Tx ring. | ||||
*/ | */ | ||||
static int | static int | ||||
rt2661_wme_update(struct ieee80211com *ic) | rt2661_wme_update(struct ieee80211com *ic) | ||||
{ | { | ||||
struct rt2661_softc *sc = ic->ic_ifp->if_softc; | struct rt2661_softc *sc = ic->ic_softc; | ||||
const struct wmeParams *wmep; | const struct wmeParams *wmep; | ||||
wmep = ic->ic_wme.wme_chanParams.cap_wmeParams; | wmep = ic->ic_wme.wme_chanParams.cap_wmeParams; | ||||
/* XXX: not sure about shifts. */ | /* XXX: not sure about shifts. */ | ||||
/* XXX: the reference driver plays with AC_VI settings too. */ | /* XXX: the reference driver plays with AC_VI settings too. */ | ||||
/* update TxOp */ | /* update TxOp */ | ||||
▲ Show 20 Lines • Show All 181 Lines • ▼ Show 20 Lines | #define N(a) (sizeof (a) / sizeof ((a)[0])) | ||||
return 0; | return 0; | ||||
#undef N | #undef N | ||||
} | } | ||||
static void | static void | ||||
rt2661_init_locked(struct rt2661_softc *sc) | rt2661_init_locked(struct rt2661_softc *sc) | ||||
{ | { | ||||
#define N(a) (sizeof (a) / sizeof ((a)[0])) | #define N(a) (sizeof (a) / sizeof ((a)[0])) | ||||
struct ifnet *ifp = sc->sc_ifp; | struct ieee80211com *ic = &sc->sc_ic; | ||||
struct ieee80211com *ic = ifp->if_l2com; | struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); | ||||
uint32_t tmp, sta[3]; | uint32_t tmp, sta[3]; | ||||
int i, error, ntries; | int i, error, ntries; | ||||
RAL_LOCK_ASSERT(sc); | RAL_LOCK_ASSERT(sc); | ||||
if ((sc->sc_flags & RAL_FW_LOADED) == 0) { | if ((sc->sc_flags & RAL_FW_LOADED) == 0) { | ||||
error = rt2661_load_microcode(sc); | error = rt2661_load_microcode(sc); | ||||
if (error != 0) { | if (error != 0) { | ||||
if_printf(ifp, | device_printf(sc->sc_dev, | ||||
"%s: could not load 8051 microcode, error %d\n", | "%s: could not load 8051 microcode, error %d\n", | ||||
__func__, error); | __func__, error); | ||||
return; | return; | ||||
} | } | ||||
sc->sc_flags |= RAL_FW_LOADED; | sc->sc_flags |= RAL_FW_LOADED; | ||||
} | } | ||||
rt2661_stop_locked(sc); | rt2661_stop_locked(sc); | ||||
Show All 36 Lines | #define N(a) (sizeof (a) / sizeof ((a)[0])) | ||||
/* load base address of Rx ring */ | /* load base address of Rx ring */ | ||||
RAL_WRITE(sc, RT2661_RX_CNTL_CSR, 2); | RAL_WRITE(sc, RT2661_RX_CNTL_CSR, 2); | ||||
/* initialize MAC registers to default values */ | /* initialize MAC registers to default values */ | ||||
for (i = 0; i < N(rt2661_def_mac); i++) | for (i = 0; i < N(rt2661_def_mac); i++) | ||||
RAL_WRITE(sc, rt2661_def_mac[i].reg, rt2661_def_mac[i].val); | RAL_WRITE(sc, rt2661_def_mac[i].reg, rt2661_def_mac[i].val); | ||||
rt2661_set_macaddr(sc, IF_LLADDR(ifp)); | rt2661_set_macaddr(sc, vap ? vap->iv_myaddr : ic->ic_macaddr); | ||||
/* set host ready */ | /* set host ready */ | ||||
RAL_WRITE(sc, RT2661_MAC_CSR1, 3); | RAL_WRITE(sc, RT2661_MAC_CSR1, 3); | ||||
RAL_WRITE(sc, RT2661_MAC_CSR1, 0); | RAL_WRITE(sc, RT2661_MAC_CSR1, 0); | ||||
/* wait for BBP/RF to wakeup */ | /* wait for BBP/RF to wakeup */ | ||||
for (ntries = 0; ntries < 1000; ntries++) { | for (ntries = 0; ntries < 1000; ntries++) { | ||||
if (RAL_READ(sc, RT2661_MAC_CSR12) & 8) | if (RAL_READ(sc, RT2661_MAC_CSR12) & 8) | ||||
Show All 22 Lines | #define N(a) (sizeof (a) / sizeof ((a)[0])) | ||||
tmp |= RT2661_DROP_PHY_ERROR | RT2661_DROP_CRC_ERROR; | tmp |= RT2661_DROP_PHY_ERROR | RT2661_DROP_CRC_ERROR; | ||||
if (ic->ic_opmode != IEEE80211_M_MONITOR) { | if (ic->ic_opmode != IEEE80211_M_MONITOR) { | ||||
tmp |= RT2661_DROP_CTL | RT2661_DROP_VER_ERROR | | tmp |= RT2661_DROP_CTL | RT2661_DROP_VER_ERROR | | ||||
RT2661_DROP_ACKCTS; | RT2661_DROP_ACKCTS; | ||||
if (ic->ic_opmode != IEEE80211_M_HOSTAP && | if (ic->ic_opmode != IEEE80211_M_HOSTAP && | ||||
ic->ic_opmode != IEEE80211_M_MBSS) | ic->ic_opmode != IEEE80211_M_MBSS) | ||||
tmp |= RT2661_DROP_TODS; | tmp |= RT2661_DROP_TODS; | ||||
if (!(ifp->if_flags & IFF_PROMISC)) | if (ic->ic_promisc == 0) | ||||
tmp |= RT2661_DROP_NOT_TO_ME; | tmp |= RT2661_DROP_NOT_TO_ME; | ||||
} | } | ||||
RAL_WRITE(sc, RT2661_TXRX_CSR0, tmp); | RAL_WRITE(sc, RT2661_TXRX_CSR0, tmp); | ||||
/* clear STA registers */ | /* clear STA registers */ | ||||
RAL_READ_REGION_4(sc, RT2661_STA_CSR0, sta, N(sta)); | RAL_READ_REGION_4(sc, RT2661_STA_CSR0, sta, N(sta)); | ||||
/* initialize ASIC */ | /* initialize ASIC */ | ||||
RAL_WRITE(sc, RT2661_MAC_CSR1, 4); | RAL_WRITE(sc, RT2661_MAC_CSR1, 4); | ||||
/* clear any pending interrupt */ | /* clear any pending interrupt */ | ||||
RAL_WRITE(sc, RT2661_INT_SOURCE_CSR, 0xffffffff); | RAL_WRITE(sc, RT2661_INT_SOURCE_CSR, 0xffffffff); | ||||
/* enable interrupts */ | /* enable interrupts */ | ||||
RAL_WRITE(sc, RT2661_INT_MASK_CSR, 0x0000ff10); | RAL_WRITE(sc, RT2661_INT_MASK_CSR, 0x0000ff10); | ||||
RAL_WRITE(sc, RT2661_MCU_INT_MASK_CSR, 0); | RAL_WRITE(sc, RT2661_MCU_INT_MASK_CSR, 0); | ||||
/* kick Rx */ | /* kick Rx */ | ||||
RAL_WRITE(sc, RT2661_RX_CNTL_CSR, 1); | RAL_WRITE(sc, RT2661_RX_CNTL_CSR, 1); | ||||
ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; | sc->sc_flags |= RAL_RUNNING; | ||||
ifp->if_drv_flags |= IFF_DRV_RUNNING; | |||||
callout_reset(&sc->watchdog_ch, hz, rt2661_watchdog, sc); | callout_reset(&sc->watchdog_ch, hz, rt2661_watchdog, sc); | ||||
#undef N | #undef N | ||||
} | } | ||||
static void | static void | ||||
rt2661_init(void *priv) | rt2661_init(void *priv) | ||||
{ | { | ||||
struct rt2661_softc *sc = priv; | struct rt2661_softc *sc = priv; | ||||
struct ifnet *ifp = sc->sc_ifp; | struct ieee80211com *ic = &sc->sc_ic; | ||||
struct ieee80211com *ic = ifp->if_l2com; | |||||
RAL_LOCK(sc); | RAL_LOCK(sc); | ||||
rt2661_init_locked(sc); | rt2661_init_locked(sc); | ||||
RAL_UNLOCK(sc); | RAL_UNLOCK(sc); | ||||
if (ifp->if_drv_flags & IFF_DRV_RUNNING) | if (sc->sc_flags & RAL_RUNNING) | ||||
ieee80211_start_all(ic); /* start all vap's */ | ieee80211_start_all(ic); /* start all vap's */ | ||||
} | } | ||||
void | void | ||||
rt2661_stop_locked(struct rt2661_softc *sc) | rt2661_stop_locked(struct rt2661_softc *sc) | ||||
{ | { | ||||
struct ifnet *ifp = sc->sc_ifp; | |||||
uint32_t tmp; | |||||
volatile int *flags = &sc->sc_flags; | volatile int *flags = &sc->sc_flags; | ||||
uint32_t tmp; | |||||
while (*flags & RAL_INPUT_RUNNING) | while (*flags & RAL_INPUT_RUNNING) | ||||
msleep(sc, &sc->sc_mtx, 0, "ralrunning", hz/10); | msleep(sc, &sc->sc_mtx, 0, "ralrunning", hz/10); | ||||
callout_stop(&sc->watchdog_ch); | callout_stop(&sc->watchdog_ch); | ||||
sc->sc_tx_timer = 0; | sc->sc_tx_timer = 0; | ||||
if (ifp->if_drv_flags & IFF_DRV_RUNNING) { | if (sc->sc_flags & RAL_RUNNING) { | ||||
ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); | sc->sc_flags &= ~RAL_RUNNING; | ||||
/* abort Tx (for all 5 Tx rings) */ | /* abort Tx (for all 5 Tx rings) */ | ||||
RAL_WRITE(sc, RT2661_TX_CNTL_CSR, 0x1f << 16); | RAL_WRITE(sc, RT2661_TX_CNTL_CSR, 0x1f << 16); | ||||
/* disable Rx (value remains after reset!) */ | /* disable Rx (value remains after reset!) */ | ||||
tmp = RAL_READ(sc, RT2661_TXRX_CSR0); | tmp = RAL_READ(sc, RT2661_TXRX_CSR0); | ||||
RAL_WRITE(sc, RT2661_TXRX_CSR0, tmp | RT2661_DISABLE_RX); | RAL_WRITE(sc, RT2661_TXRX_CSR0, tmp | RT2661_DISABLE_RX); | ||||
Show All 27 Lines | rt2661_stop(void *priv) | ||||
RAL_LOCK(sc); | RAL_LOCK(sc); | ||||
rt2661_stop_locked(sc); | rt2661_stop_locked(sc); | ||||
RAL_UNLOCK(sc); | RAL_UNLOCK(sc); | ||||
} | } | ||||
static int | static int | ||||
rt2661_load_microcode(struct rt2661_softc *sc) | rt2661_load_microcode(struct rt2661_softc *sc) | ||||
{ | { | ||||
struct ifnet *ifp = sc->sc_ifp; | |||||
const struct firmware *fp; | const struct firmware *fp; | ||||
const char *imagename; | const char *imagename; | ||||
int ntries, error; | int ntries, error; | ||||
RAL_LOCK_ASSERT(sc); | RAL_LOCK_ASSERT(sc); | ||||
switch (sc->sc_id) { | switch (sc->sc_id) { | ||||
case 0x0301: imagename = "rt2561sfw"; break; | case 0x0301: imagename = "rt2561sfw"; break; | ||||
case 0x0302: imagename = "rt2561fw"; break; | case 0x0302: imagename = "rt2561fw"; break; | ||||
case 0x0401: imagename = "rt2661fw"; break; | case 0x0401: imagename = "rt2661fw"; break; | ||||
default: | default: | ||||
if_printf(ifp, "%s: unexpected pci device id 0x%x, " | device_printf(sc->sc_dev, "%s: unexpected pci device id 0x%x, " | ||||
"don't know how to retrieve firmware\n", | "don't know how to retrieve firmware\n", | ||||
__func__, sc->sc_id); | __func__, sc->sc_id); | ||||
return EINVAL; | return EINVAL; | ||||
} | } | ||||
RAL_UNLOCK(sc); | RAL_UNLOCK(sc); | ||||
fp = firmware_get(imagename); | fp = firmware_get(imagename); | ||||
RAL_LOCK(sc); | RAL_LOCK(sc); | ||||
if (fp == NULL) { | if (fp == NULL) { | ||||
if_printf(ifp, "%s: unable to retrieve firmware image %s\n", | device_printf(sc->sc_dev, | ||||
"%s: unable to retrieve firmware image %s\n", | |||||
__func__, imagename); | __func__, imagename); | ||||
return EINVAL; | return EINVAL; | ||||
} | } | ||||
/* | /* | ||||
* Load 8051 microcode into NIC. | * Load 8051 microcode into NIC. | ||||
*/ | */ | ||||
/* reset 8051 */ | /* reset 8051 */ | ||||
Show All 14 Lines | rt2661_load_microcode(struct rt2661_softc *sc) | ||||
/* wait for 8051 to initialize */ | /* wait for 8051 to initialize */ | ||||
for (ntries = 0; ntries < 500; ntries++) { | for (ntries = 0; ntries < 500; ntries++) { | ||||
if (RAL_READ(sc, RT2661_MCU_CNTL_CSR) & RT2661_MCU_READY) | if (RAL_READ(sc, RT2661_MCU_CNTL_CSR) & RT2661_MCU_READY) | ||||
break; | break; | ||||
DELAY(100); | DELAY(100); | ||||
} | } | ||||
if (ntries == 500) { | if (ntries == 500) { | ||||
if_printf(ifp, "%s: timeout waiting for MCU to initialize\n", | device_printf(sc->sc_dev, | ||||
__func__); | "%s: timeout waiting for MCU to initialize\n", __func__); | ||||
error = EIO; | error = EIO; | ||||
} else | } else | ||||
error = 0; | error = 0; | ||||
firmware_put(fp, FIRMWARE_UNLOAD); | firmware_put(fp, FIRMWARE_UNLOAD); | ||||
return error; | return error; | ||||
} | } | ||||
▲ Show 20 Lines • Show All 151 Lines • ▼ Show 20 Lines | |||||
/* | /* | ||||
* Enable TSF synchronization and tell h/w to start sending beacons for IBSS | * Enable TSF synchronization and tell h/w to start sending beacons for IBSS | ||||
* and HostAP operating modes. | * and HostAP operating modes. | ||||
*/ | */ | ||||
static void | static void | ||||
rt2661_enable_tsf_sync(struct rt2661_softc *sc) | rt2661_enable_tsf_sync(struct rt2661_softc *sc) | ||||
{ | { | ||||
struct ifnet *ifp = sc->sc_ifp; | struct ieee80211com *ic = &sc->sc_ic; | ||||
struct ieee80211com *ic = ifp->if_l2com; | |||||
struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); | struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); | ||||
uint32_t tmp; | uint32_t tmp; | ||||
if (vap->iv_opmode != IEEE80211_M_STA) { | if (vap->iv_opmode != IEEE80211_M_STA) { | ||||
/* | /* | ||||
* Change default 16ms TBTT adjustment to 8ms. | * Change default 16ms TBTT adjustment to 8ms. | ||||
* Must be done before enabling beacon generation. | * Must be done before enabling beacon generation. | ||||
*/ | */ | ||||
▲ Show 20 Lines • Show All 67 Lines • ▼ Show 20 Lines | else if (lna == 3) | ||||
rssi -= 100; | rssi -= 100; | ||||
} | } | ||||
return rssi; | return rssi; | ||||
} | } | ||||
static void | static void | ||||
rt2661_scan_start(struct ieee80211com *ic) | rt2661_scan_start(struct ieee80211com *ic) | ||||
{ | { | ||||
struct ifnet *ifp = ic->ic_ifp; | struct rt2661_softc *sc = ic->ic_softc; | ||||
struct rt2661_softc *sc = ifp->if_softc; | |||||
uint32_t tmp; | uint32_t tmp; | ||||
/* abort TSF synchronization */ | /* abort TSF synchronization */ | ||||
tmp = RAL_READ(sc, RT2661_TXRX_CSR9); | tmp = RAL_READ(sc, RT2661_TXRX_CSR9); | ||||
RAL_WRITE(sc, RT2661_TXRX_CSR9, tmp & ~0xffffff); | RAL_WRITE(sc, RT2661_TXRX_CSR9, tmp & ~0xffffff); | ||||
rt2661_set_bssid(sc, ifp->if_broadcastaddr); | rt2661_set_bssid(sc, ieee80211broadcastaddr); | ||||
} | } | ||||
static void | static void | ||||
rt2661_scan_end(struct ieee80211com *ic) | rt2661_scan_end(struct ieee80211com *ic) | ||||
{ | { | ||||
struct ifnet *ifp = ic->ic_ifp; | struct rt2661_softc *sc = ic->ic_softc; | ||||
struct rt2661_softc *sc = ifp->if_softc; | |||||
struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); | struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); | ||||
rt2661_enable_tsf_sync(sc); | rt2661_enable_tsf_sync(sc); | ||||
/* XXX keep local copy */ | /* XXX keep local copy */ | ||||
rt2661_set_bssid(sc, vap->iv_bss->ni_bssid); | rt2661_set_bssid(sc, vap->iv_bss->ni_bssid); | ||||
} | } | ||||
static void | static void | ||||
rt2661_set_channel(struct ieee80211com *ic) | rt2661_set_channel(struct ieee80211com *ic) | ||||
{ | { | ||||
struct ifnet *ifp = ic->ic_ifp; | struct rt2661_softc *sc = ic->ic_softc; | ||||
struct rt2661_softc *sc = ifp->if_softc; | |||||
RAL_LOCK(sc); | RAL_LOCK(sc); | ||||
rt2661_set_chan(sc, ic->ic_curchan); | rt2661_set_chan(sc, ic->ic_curchan); | ||||
RAL_UNLOCK(sc); | RAL_UNLOCK(sc); | ||||
} | } |