#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: atw.c,v 1.172 2021/09/21 14:42:01 christos Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/callout.h>
#include <sys/mbuf.h>
#include <sys/malloc.h>
#include <sys/kernel.h>
#include <sys/socket.h>
#include <sys/ioctl.h>
#include <sys/errno.h>
#include <sys/device.h>
#include <sys/kauth.h>
#include <sys/time.h>
#include <sys/proc.h>
#include <sys/atomic.h>
#include <lib/libkern/libkern.h>
#include <machine/endian.h>
#include <net/if.h>
#include <net/if_dl.h>
#include <net/if_media.h>
#include <net/if_ether.h>
#include <net80211/ieee80211_netbsd.h>
#include <net80211/ieee80211_var.h>
#include <net80211/ieee80211_radiotap.h>
#include <net/bpf.h>
#include <sys/bus.h>
#include <sys/intr.h>
#include <dev/ic/atwreg.h>
#include <dev/ic/rf3000reg.h>
#include <dev/ic/si4136reg.h>
#include <dev/ic/atwvar.h>
#include <dev/ic/smc93cx6var.h>
#define ATW_REFSLAVE
int atw_pseudo_milli = 1;
int atw_magic_delay1 = 100 * 1000;
int atw_magic_delay2 = 100 * 1000;
int atw_nar_delay = 20 * 1000;
int atw_magic_delay4 = 10 * 1000;
int atw_rf_delay1 = 10 * 1000;
int atw_rf_delay2 = 5 * 1000;
int atw_plcphd_delay = 2 * 1000;
int atw_bbp_io_enable_delay = 20 * 1000;
int atw_bbp_io_disable_delay = 2 * 1000;
int atw_writewep_delay = 1000;
int atw_beacon_len_adjust = 4;
int atw_dwelltime = 200;
int atw_xindiv2 = 0;
#ifdef ATW_DEBUG
int atw_debug = 0;
#define ATW_DPRINTF(x) if (atw_debug > 0) printf x
#define ATW_DPRINTF2(x) if (atw_debug > 1) printf x
#define ATW_DPRINTF3(x) if (atw_debug > 2) printf x
#define DPRINTF(sc, x) if ((sc)->sc_if.if_flags & IFF_DEBUG) printf x
#define DPRINTF2(sc, x) if ((sc)->sc_if.if_flags & IFF_DEBUG) ATW_DPRINTF2(x)
#define DPRINTF3(sc, x) if ((sc)->sc_if.if_flags & IFF_DEBUG) ATW_DPRINTF3(x)
static void atw_dump_pkt(struct ifnet *, struct mbuf *);
static void atw_print_regs(struct atw_softc *, const char *);
# ifdef ATW_BBPDEBUG
static void atw_rf3000_print(struct atw_softc *);
static int atw_rf3000_read(struct atw_softc *sc, u_int, u_int *);
# endif
# ifdef ATW_SYNDEBUG
static void atw_si4126_print(struct atw_softc *);
static int atw_si4126_read(struct atw_softc *, u_int, u_int *);
# endif
#define __atwdebugused
#else
#define ATW_DPRINTF(x)
#define ATW_DPRINTF2(x)
#define ATW_DPRINTF3(x)
#define DPRINTF(sc, x)
#define DPRINTF2(sc, x)
#define DPRINTF3(sc, x)
#define __atwdebugused __unused
#endif
int atw_init(struct ifnet *);
int atw_ioctl(struct ifnet *, u_long, void *);
void atw_start(struct ifnet *);
void atw_stop(struct ifnet *, int);
void atw_watchdog(struct ifnet *);
void atw_attach(struct atw_softc *);
int atw_detach(struct atw_softc *);
static void atw_evcnt_attach(struct atw_softc *);
static void atw_evcnt_detach(struct atw_softc *);
int atw_add_rxbuf(struct atw_softc *, int);
void atw_idle(struct atw_softc *, uint32_t);
void atw_rxdrain(struct atw_softc *);
void atw_txdrain(struct atw_softc *);
void atw_reset(struct atw_softc *);
void atw_softintr(void *);
void atw_linkintr(struct atw_softc *, uint32_t);
void atw_rxintr(struct atw_softc *);
void atw_txintr(struct atw_softc *, uint32_t);
static int atw_newstate(struct ieee80211com *, enum ieee80211_state, int);
static void atw_next_scan(void *);
static void atw_recv_mgmt(struct ieee80211com *, struct mbuf *,
struct ieee80211_node *, int, int, uint32_t);
static int atw_tune(struct atw_softc *);
static void atw_bbp_io_init(struct atw_softc *);
static void atw_cfp_init(struct atw_softc *);
static void atw_cmdr_init(struct atw_softc *);
static void atw_ifs_init(struct atw_softc *);
static void atw_nar_init(struct atw_softc *);
static void atw_response_times_init(struct atw_softc *);
static void atw_rf_reset(struct atw_softc *);
static void atw_test1_init(struct atw_softc *);
static void atw_tofs0_init(struct atw_softc *);
static void atw_tofs2_init(struct atw_softc *);
static void atw_txlmt_init(struct atw_softc *);
static void atw_wcsr_init(struct atw_softc *);
static int atw_key_delete(struct ieee80211com *, const struct ieee80211_key *);
static int atw_key_set(struct ieee80211com *, const struct ieee80211_key *,
const uint8_t[IEEE80211_ADDR_LEN]);
static void atw_key_update_begin(struct ieee80211com *);
static void atw_key_update_end(struct ieee80211com *);
static void atw_clear_sram(struct atw_softc *);
static void atw_write_sram(struct atw_softc *, u_int, uint8_t *, u_int);
static int atw_read_srom(struct atw_softc *);
static void atw_predict_beacon(struct atw_softc *);
static void atw_start_beacon(struct atw_softc *, int);
static void atw_write_bssid(struct atw_softc *);
static void atw_write_ssid(struct atw_softc *);
static void atw_write_sup_rates(struct atw_softc *);
static void atw_write_wep(struct atw_softc *);
static int atw_media_change(struct ifnet *);
static void atw_filter_setup(struct atw_softc *);
static uint64_t atw_get_tsft(struct atw_softc *);
static inline uint32_t atw_last_even_tsft(uint32_t, uint32_t,
uint32_t);
static struct ieee80211_node *atw_node_alloc(struct ieee80211_node_table *);
static void atw_node_free(struct ieee80211_node *);
static void atw_bbp_io_enable(struct atw_softc *, int);
static int atw_rf3000_init(struct atw_softc *);
static int atw_rf3000_tune(struct atw_softc *, u_int);
static int atw_rf3000_write(struct atw_softc *, u_int, u_int);
static void atw_si4126_tune(struct atw_softc *, u_int);
static void atw_si4126_write(struct atw_softc *, u_int, u_int);
const struct atw_txthresh_tab atw_txthresh_tab_lo[] = ATW_TXTHRESH_TAB_LO_RATE;
const struct atw_txthresh_tab atw_txthresh_tab_hi[] = ATW_TXTHRESH_TAB_HI_RATE;
const char *atw_tx_state[] = {
"STOPPED",
"RUNNING - read descriptor",
"RUNNING - transmitting",
"RUNNING - filling fifo",
"SUSPENDED",
"RUNNING -- write descriptor",
"RUNNING -- write last descriptor",
"RUNNING - fifo full"
};
const char *atw_rx_state[] = {
"STOPPED",
"RUNNING - read descriptor",
"RUNNING - check this packet, pre-fetch next",
"RUNNING - wait for reception",
"SUSPENDED",
"RUNNING - write descriptor",
"RUNNING - flush fifo",
"RUNNING - fifo drain"
};
static inline int
is_running(struct ifnet *ifp)
{
return (ifp->if_flags & (IFF_RUNNING | IFF_UP))
== (IFF_RUNNING | IFF_UP);
}
int
atw_activate(device_t self, enum devact act)
{
struct atw_softc *sc = device_private(self);
switch (act) {
case DVACT_DEACTIVATE:
if_deactivate(&sc->sc_if);
return 0;
default:
return EOPNOTSUPP;
}
}
bool
atw_suspend(device_t self, const pmf_qual_t *qual)
{
struct atw_softc *sc = device_private(self);
atw_rxdrain(sc);
sc->sc_flags &= ~ATWF_WEP_SRAM_VALID;
return true;
}
static int
atw_read_srom(struct atw_softc *sc)
{
struct seeprom_descriptor sd;
uint32_t test0, fail_bits;
(void)memset(&sd, 0, sizeof(sd));
test0 = ATW_READ(sc, ATW_TEST0);
switch (sc->sc_rev) {
case ATW_REVISION_BA:
case ATW_REVISION_CA:
fail_bits = ATW_TEST0_EPNE;
break;
default:
fail_bits = ATW_TEST0_EPNE | ATW_TEST0_EPSNM;
break;
}
if ((test0 & fail_bits) != 0) {
aprint_error_dev(sc->sc_dev, "bad or missing/bad SROM\n");
return -1;
}
switch (test0 & ATW_TEST0_EPTYP_MASK) {
case ATW_TEST0_EPTYP_93c66:
ATW_DPRINTF(("%s: 93c66 SROM\n", device_xname(sc->sc_dev)));
sc->sc_sromsz = 512;
sd.sd_chip = C56_66;
break;
case ATW_TEST0_EPTYP_93c46:
ATW_DPRINTF(("%s: 93c46 SROM\n", device_xname(sc->sc_dev)));
sc->sc_sromsz = 128;
sd.sd_chip = C46;
break;
default:
printf("%s: unknown SROM type %" __PRIuBITS "\n",
device_xname(sc->sc_dev),
__SHIFTOUT(test0, ATW_TEST0_EPTYP_MASK));
return -1;
}
sc->sc_srom = malloc(sc->sc_sromsz, M_DEVBUF, M_WAITOK | M_ZERO);
sd.sd_tag = sc->sc_st;
sd.sd_bsh = sc->sc_sh;
sd.sd_regsize = 4;
sd.sd_control_offset = ATW_SPR;
sd.sd_status_offset = ATW_SPR;
sd.sd_dataout_offset = ATW_SPR;
sd.sd_CK = ATW_SPR_SCLK;
sd.sd_CS = ATW_SPR_SCS;
sd.sd_DI = ATW_SPR_SDO;
sd.sd_DO = ATW_SPR_SDI;
sd.sd_MS = ATW_SPR_SRS;
sd.sd_RDY = 0;
if (!read_seeprom(&sd, sc->sc_srom, 0, sc->sc_sromsz/2)) {
aprint_error_dev(sc->sc_dev, "could not read SROM\n");
free(sc->sc_srom, M_DEVBUF);
return -1;
}
#ifdef ATW_DEBUG
{
int i;
ATW_DPRINTF(("\nSerial EEPROM:\n\t"));
for (i = 0; i < sc->sc_sromsz/2; i = i + 1) {
if (((i % 8) == 0) && (i != 0)) {
ATW_DPRINTF(("\n\t"));
}
ATW_DPRINTF((" 0x%x", sc->sc_srom[i]));
}
ATW_DPRINTF(("\n"));
}
#endif
return 0;
}
#ifdef ATW_DEBUG
static void
atw_print_regs(struct atw_softc *sc, const char *where)
{
#define PRINTREG(sc, reg) \
ATW_DPRINTF2(("%s: reg[ " #reg " / %03x ] = %08x\n", \
device_xname(sc->sc_dev), reg, ATW_READ(sc, reg)))
ATW_DPRINTF2(("%s: %s\n", device_xname(sc->sc_dev), where));
PRINTREG(sc, ATW_PAR);
PRINTREG(sc, ATW_FRCTL);
PRINTREG(sc, ATW_TDR);
PRINTREG(sc, ATW_WTDP);
PRINTREG(sc, ATW_RDR);
PRINTREG(sc, ATW_WRDP);
PRINTREG(sc, ATW_RDB);
PRINTREG(sc, ATW_CSR3A);
PRINTREG(sc, ATW_TDBD);
PRINTREG(sc, ATW_TDBP);
PRINTREG(sc, ATW_STSR);
PRINTREG(sc, ATW_CSR5A);
PRINTREG(sc, ATW_NAR);
PRINTREG(sc, ATW_CSR6A);
PRINTREG(sc, ATW_IER);
PRINTREG(sc, ATW_CSR7A);
PRINTREG(sc, ATW_LPC);
PRINTREG(sc, ATW_TEST1);
PRINTREG(sc, ATW_SPR);
PRINTREG(sc, ATW_TEST0);
PRINTREG(sc, ATW_WCSR);
PRINTREG(sc, ATW_WPDR);
PRINTREG(sc, ATW_GPTMR);
PRINTREG(sc, ATW_GPIO);
PRINTREG(sc, ATW_BBPCTL);
PRINTREG(sc, ATW_SYNCTL);
PRINTREG(sc, ATW_PLCPHD);
PRINTREG(sc, ATW_MMIWADDR);
PRINTREG(sc, ATW_MMIRADDR1);
PRINTREG(sc, ATW_MMIRADDR2);
PRINTREG(sc, ATW_TXBR);
PRINTREG(sc, ATW_CSR15A);
PRINTREG(sc, ATW_ALCSTAT);
PRINTREG(sc, ATW_TOFS2);
PRINTREG(sc, ATW_CMDR);
PRINTREG(sc, ATW_PCIC);
PRINTREG(sc, ATW_PMCSR);
PRINTREG(sc, ATW_PAR0);
PRINTREG(sc, ATW_PAR1);
PRINTREG(sc, ATW_MAR0);
PRINTREG(sc, ATW_MAR1);
PRINTREG(sc, ATW_ATIMDA0);
PRINTREG(sc, ATW_ABDA1);
PRINTREG(sc, ATW_BSSID0);
PRINTREG(sc, ATW_TXLMT);
PRINTREG(sc, ATW_MIBCNT);
PRINTREG(sc, ATW_BCNT);
PRINTREG(sc, ATW_TSFTH);
PRINTREG(sc, ATW_TSC);
PRINTREG(sc, ATW_SYNRF);
PRINTREG(sc, ATW_BPLI);
PRINTREG(sc, ATW_CAP0);
PRINTREG(sc, ATW_CAP1);
PRINTREG(sc, ATW_RMD);
PRINTREG(sc, ATW_CFPP);
PRINTREG(sc, ATW_TOFS0);
PRINTREG(sc, ATW_TOFS1);
PRINTREG(sc, ATW_IFST);
PRINTREG(sc, ATW_RSPT);
PRINTREG(sc, ATW_TSFTL);
PRINTREG(sc, ATW_WEPCTL);
PRINTREG(sc, ATW_WESK);
PRINTREG(sc, ATW_WEPCNT);
PRINTREG(sc, ATW_MACTEST);
PRINTREG(sc, ATW_FER);
PRINTREG(sc, ATW_FEMR);
PRINTREG(sc, ATW_FPSR);
PRINTREG(sc, ATW_FFER);
#undef PRINTREG
}
#endif
void
atw_attach(struct atw_softc *sc)
{
static const uint8_t empty_macaddr[IEEE80211_ADDR_LEN] = {
0x00, 0x00, 0x00, 0x00, 0x00, 0x00
};
struct ieee80211com *ic = &sc->sc_ic;
struct ifnet *ifp = &sc->sc_if;
int country_code, error, i, srom_major;
uint32_t reg;
static const char *type_strings[] = {"Intersil (not supported)",
"RFMD", "Marvel (not supported)"};
pmf_self_suspensor_init(sc->sc_dev, &sc->sc_suspensor, &sc->sc_qual);
sc->sc_soft_ih = softint_establish(SOFTINT_NET, atw_softintr, sc);
if (sc->sc_soft_ih == NULL) {
aprint_error_dev(sc->sc_dev, "unable to establish softint\n");
goto fail_0;
}
sc->sc_txth = atw_txthresh_tab_lo;
SIMPLEQ_INIT(&sc->sc_txfreeq);
SIMPLEQ_INIT(&sc->sc_txdirtyq);
#ifdef ATW_DEBUG
atw_print_regs(sc, "atw_attach");
#endif
if ((error = bus_dmamem_alloc(sc->sc_dmat,
sizeof(struct atw_control_data), PAGE_SIZE, 0, &sc->sc_cdseg,
1, &sc->sc_cdnseg, 0)) != 0) {
aprint_error_dev(sc->sc_dev,
"unable to allocate control data, error = %d\n",
error);
goto fail_0;
}
if ((error = bus_dmamem_map(sc->sc_dmat, &sc->sc_cdseg, sc->sc_cdnseg,
sizeof(struct atw_control_data), (void **)&sc->sc_control_data,
BUS_DMA_COHERENT)) != 0) {
aprint_error_dev(sc->sc_dev,
"unable to map control data, error = %d\n",
error);
goto fail_1;
}
if ((error = bus_dmamap_create(sc->sc_dmat,
sizeof(struct atw_control_data), 1,
sizeof(struct atw_control_data), 0, 0, &sc->sc_cddmamap)) != 0) {
aprint_error_dev(sc->sc_dev,
"unable to create control data DMA map, error = %d\n",
error);
goto fail_2;
}
if ((error = bus_dmamap_load(sc->sc_dmat, sc->sc_cddmamap,
sc->sc_control_data, sizeof(struct atw_control_data), NULL,
0)) != 0) {
aprint_error_dev(sc->sc_dev,
"unable to load control data DMA map, error = %d\n", error);
goto fail_3;
}
sc->sc_ntxsegs = ATW_NTXSEGS;
for (i = 0; i < ATW_TXQUEUELEN; i++) {
if ((error = bus_dmamap_create(sc->sc_dmat, MCLBYTES,
sc->sc_ntxsegs, MCLBYTES, 0, 0,
&sc->sc_txsoft[i].txs_dmamap)) != 0) {
aprint_error_dev(sc->sc_dev,
"unable to create tx DMA map %d, error = %d\n", i,
error);
goto fail_4;
}
}
for (i = 0; i < ATW_NRXDESC; i++) {
if ((error = bus_dmamap_create(sc->sc_dmat, MCLBYTES, 1,
MCLBYTES, 0, 0, &sc->sc_rxsoft[i].rxs_dmamap)) != 0) {
aprint_error_dev(sc->sc_dev,
"unable to create rx DMA map %d, error = %d\n", i,
error);
goto fail_5;
}
}
for (i = 0; i < ATW_NRXDESC; i++) {
sc->sc_rxsoft[i].rxs_mbuf = NULL;
}
switch (sc->sc_rev) {
case ATW_REVISION_AB:
case ATW_REVISION_AF:
sc->sc_sramlen = ATW_SRAM_A_SIZE;
break;
case ATW_REVISION_BA:
case ATW_REVISION_CA:
sc->sc_sramlen = ATW_SRAM_B_SIZE;
break;
}
atw_reset(sc);
if (atw_read_srom(sc) == -1)
goto fail_5;
sc->sc_rftype = __SHIFTOUT(sc->sc_srom[ATW_SR_CSR20],
ATW_SR_RFTYPE_MASK);
sc->sc_bbptype = __SHIFTOUT(sc->sc_srom[ATW_SR_CSR20],
ATW_SR_BBPTYPE_MASK);
if (sc->sc_rftype >= __arraycount(type_strings)) {
aprint_error_dev(sc->sc_dev, "unknown RF\n");
goto fail_5;
}
if (sc->sc_bbptype >= __arraycount(type_strings)) {
aprint_error_dev(sc->sc_dev, "unknown BBP\n");
goto fail_5;
}
aprint_normal_dev(sc->sc_dev, "%s RF, %s BBP",
type_strings[sc->sc_rftype], type_strings[sc->sc_bbptype]);
reg = __SHIFTIN(sc->sc_rftype, ATW_SYNCTL_RFTYPE_MASK);
switch (sc->sc_rftype) {
case ATW_RFTYPE_INTERSIL:
reg |= ATW_SYNCTL_CS1;
break;
case ATW_RFTYPE_RFMD:
reg |= ATW_SYNCTL_CS0;
break;
case ATW_RFTYPE_MARVEL:
break;
}
sc->sc_synctl_rd = reg | ATW_SYNCTL_RD;
sc->sc_synctl_wr = reg | ATW_SYNCTL_WR;
reg = __SHIFTIN(sc->sc_bbptype, ATW_BBPCTL_TYPE_MASK);
switch (sc->sc_bbptype) {
case ATW_BBPTYPE_INTERSIL:
reg |= ATW_BBPCTL_TWI;
break;
case ATW_BBPTYPE_RFMD:
reg |= ATW_BBPCTL_RF3KADDR_ADDR | ATW_BBPCTL_NEGEDGE_DO |
ATW_BBPCTL_CCA_ACTLO;
break;
case ATW_BBPTYPE_MARVEL:
break;
case ATW_C_BBPTYPE_RFMD:
aprint_error_dev(sc->sc_dev,
"ADM8211C MAC/RFMD BBP not supported yet.\n");
break;
}
sc->sc_bbpctl_wr = reg | ATW_BBPCTL_WR;
sc->sc_bbpctl_rd = reg | ATW_BBPCTL_RD;
sc->sc_flags |= ATWF_ATTACHED;
ATW_DPRINTF((" SROM MAC %04x%04x%04x",
htole16(sc->sc_srom[ATW_SR_MAC00]),
htole16(sc->sc_srom[ATW_SR_MAC01]),
htole16(sc->sc_srom[ATW_SR_MAC10])));
srom_major = __SHIFTOUT(sc->sc_srom[ATW_SR_FORMAT_VERSION],
ATW_SR_MAJOR_MASK);
if (srom_major < 2)
sc->sc_rf3000_options1 = 0;
else if (sc->sc_rev == ATW_REVISION_BA) {
sc->sc_rf3000_options1 =
__SHIFTOUT(sc->sc_srom[ATW_SR_CR28_CR03],
ATW_SR_CR28_MASK);
} else
sc->sc_rf3000_options1 = 0;
sc->sc_rf3000_options2 = __SHIFTOUT(sc->sc_srom[ATW_SR_CTRY_CR29],
ATW_SR_CR29_MASK);
country_code = __SHIFTOUT(sc->sc_srom[ATW_SR_CTRY_CR29],
ATW_SR_CTRY_MASK);
#define ADD_CHANNEL(_ic, _chan) do { \
_ic->ic_channels[_chan].ic_flags = IEEE80211_CHAN_B; \
_ic->ic_channels[_chan].ic_freq = \
ieee80211_ieee2mhz(_chan, _ic->ic_channels[_chan].ic_flags);\
} while (0)
switch (country_code) {
case COUNTRY_MMK2:
ADD_CHANNEL(ic, 14);
case COUNTRY_ETSI:
for (i = 1; i <= 13; i++)
ADD_CHANNEL(ic, i);
break;
case COUNTRY_FCC:
case COUNTRY_IC:
for (i = 1; i <= 11; i++)
ADD_CHANNEL(ic, i);
break;
case COUNTRY_MMK:
ADD_CHANNEL(ic, 14);
break;
case COUNTRY_FRANCE:
for (i = 10; i <= 13; i++)
ADD_CHANNEL(ic, i);
break;
default:
case COUNTRY_SPAIN:
for (i = 10; i <= 11; i++)
ADD_CHANNEL(ic, i);
break;
}
reg = ATW_READ(sc, ATW_PAR0);
ic->ic_myaddr[0] = __SHIFTOUT(reg, ATW_PAR0_PAB0_MASK);
ic->ic_myaddr[1] = __SHIFTOUT(reg, ATW_PAR0_PAB1_MASK);
ic->ic_myaddr[2] = __SHIFTOUT(reg, ATW_PAR0_PAB2_MASK);
ic->ic_myaddr[3] = __SHIFTOUT(reg, ATW_PAR0_PAB3_MASK);
reg = ATW_READ(sc, ATW_PAR1);
ic->ic_myaddr[4] = __SHIFTOUT(reg, ATW_PAR1_PAB4_MASK);
ic->ic_myaddr[5] = __SHIFTOUT(reg, ATW_PAR1_PAB5_MASK);
if (IEEE80211_ADDR_EQ(ic->ic_myaddr, empty_macaddr)) {
aprint_error_dev(sc->sc_dev,
"could not get mac address, attach failed\n");
goto fail_5;
}
aprint_normal(" 802.11 address %s\n", ether_sprintf(ic->ic_myaddr));
memcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
ifp->if_softc = sc;
ifp->if_flags = IFF_SIMPLEX | IFF_BROADCAST | IFF_MULTICAST;
ifp->if_ioctl = atw_ioctl;
ifp->if_start = atw_start;
ifp->if_watchdog = atw_watchdog;
ifp->if_init = atw_init;
ifp->if_stop = atw_stop;
IFQ_SET_READY(&ifp->if_snd);
ic->ic_ifp = ifp;
ic->ic_phytype = IEEE80211_T_DS;
ic->ic_opmode = IEEE80211_M_STA;
ic->ic_caps = IEEE80211_C_PMGT | IEEE80211_C_IBSS |
IEEE80211_C_HOSTAP | IEEE80211_C_MONITOR;
ic->ic_sup_rates[IEEE80211_MODE_11B] = ieee80211_std_rateset_11b;
if_initialize(ifp);
ieee80211_ifattach(ic);
ifp->if_percpuq = if_percpuq_create(ifp);
if_register(ifp);
atw_evcnt_attach(sc);
sc->sc_newstate = ic->ic_newstate;
ic->ic_newstate = atw_newstate;
sc->sc_recv_mgmt = ic->ic_recv_mgmt;
ic->ic_recv_mgmt = atw_recv_mgmt;
sc->sc_node_free = ic->ic_node_free;
ic->ic_node_free = atw_node_free;
sc->sc_node_alloc = ic->ic_node_alloc;
ic->ic_node_alloc = atw_node_alloc;
ic->ic_crypto.cs_key_delete = atw_key_delete;
ic->ic_crypto.cs_key_set = atw_key_set;
ic->ic_crypto.cs_key_update_begin = atw_key_update_begin;
ic->ic_crypto.cs_key_update_end = atw_key_update_end;
ieee80211_media_init(ic, atw_media_change, ieee80211_media_status);
callout_init(&sc->sc_scan_ch, 0);
bpf_attach2(ifp, DLT_IEEE802_11_RADIO,
sizeof(struct ieee80211_frame) + 64, &sc->sc_radiobpf);
memset(&sc->sc_rxtapu, 0, sizeof(sc->sc_rxtapu));
sc->sc_rxtap.ar_ihdr.it_len = htole16(sizeof(sc->sc_rxtapu));
sc->sc_rxtap.ar_ihdr.it_present = htole32(ATW_RX_RADIOTAP_PRESENT);
memset(&sc->sc_txtapu, 0, sizeof(sc->sc_txtapu));
sc->sc_txtap.at_ihdr.it_len = htole16(sizeof(sc->sc_txtapu));
sc->sc_txtap.at_ihdr.it_present = htole32(ATW_TX_RADIOTAP_PRESENT);
ieee80211_announce(ic);
return;
fail_5:
for (i = 0; i < ATW_NRXDESC; i++) {
if (sc->sc_rxsoft[i].rxs_dmamap == NULL)
continue;
bus_dmamap_destroy(sc->sc_dmat, sc->sc_rxsoft[i].rxs_dmamap);
}
fail_4:
for (i = 0; i < ATW_TXQUEUELEN; i++) {
if (sc->sc_txsoft[i].txs_dmamap == NULL)
continue;
bus_dmamap_destroy(sc->sc_dmat, sc->sc_txsoft[i].txs_dmamap);
}
bus_dmamap_unload(sc->sc_dmat, sc->sc_cddmamap);
fail_3:
bus_dmamap_destroy(sc->sc_dmat, sc->sc_cddmamap);
fail_2:
bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_control_data,
sizeof(struct atw_control_data));
fail_1:
bus_dmamem_free(sc->sc_dmat, &sc->sc_cdseg, sc->sc_cdnseg);
fail_0:
if (sc->sc_soft_ih != NULL) {
softint_disestablish(sc->sc_soft_ih);
sc->sc_soft_ih = NULL;
}
}
static struct ieee80211_node *
atw_node_alloc(struct ieee80211_node_table *nt)
{
struct atw_softc *sc = (struct atw_softc *)nt->nt_ic->ic_ifp->if_softc;
struct ieee80211_node *ni = (*sc->sc_node_alloc)(nt);
DPRINTF(sc, ("%s: alloc node %p\n", device_xname(sc->sc_dev), ni));
return ni;
}
static void
atw_node_free(struct ieee80211_node *ni)
{
struct atw_softc *sc = (struct atw_softc *)ni->ni_ic->ic_ifp->if_softc;
DPRINTF(sc, ("%s: freeing node %p %s\n", device_xname(sc->sc_dev), ni,
ether_sprintf(ni->ni_bssid)));
(*sc->sc_node_free)(ni);
}
static void
atw_test1_reset(struct atw_softc *sc)
{
switch (sc->sc_rev) {
case ATW_REVISION_BA:
if (1 ) {
ATW_SET(sc, ATW_TEST1, ATW_TEST1_TESTMODE_MONITOR);
}
break;
case ATW_REVISION_CA:
ATW_CLR(sc, ATW_TEST1, ATW_TEST1_TESTMODE_MASK);
break;
default:
break;
}
}
void
atw_reset(struct atw_softc *sc)
{
int i;
uint32_t lpc __atwdebugused;
ATW_WRITE(sc, ATW_NAR, 0x0);
DELAY(atw_nar_delay);
ATW_WRITE(sc, ATW_FRCTL, 0x0);
ATW_WRITE(sc, ATW_PAR, ATW_PAR_SWR);
for (i = 0; i < 50000 / atw_pseudo_milli; i++) {
if ((ATW_READ(sc, ATW_PAR) & ATW_PAR_SWR) == 0)
break;
DELAY(atw_pseudo_milli);
}
DELAY(atw_magic_delay1);
DPRINTF2(sc, ("%s: atw_reset %d iterations\n", device_xname(sc->sc_dev), i));
if (ATW_ISSET(sc, ATW_PAR, ATW_PAR_SWR))
aprint_error_dev(sc->sc_dev, "reset failed to complete\n");
sc->sc_busmode = ATW_PAR_PBL_8DW;
ATW_WRITE(sc, ATW_PAR, sc->sc_busmode);
DPRINTF(sc, ("%s: ATW_PAR %08x busmode %08x\n", device_xname(sc->sc_dev),
ATW_READ(sc, ATW_PAR), sc->sc_busmode));
atw_test1_reset(sc);
ATW_WRITE(sc, ATW_FRCTL, 0x0);
DELAY(atw_magic_delay2);
ATW_SET(sc, ATW_TEST0, ATW_TEST0_EPRLD);
DELAY(atw_magic_delay4);
lpc = ATW_READ(sc, ATW_LPC);
DPRINTF(sc, ("%s: ATW_LPC %#08x\n", __func__, lpc));
atw_clear_sram(sc);
memset(sc->sc_bssid, 0xff, sizeof(sc->sc_bssid));
}
static void
atw_clear_sram(struct atw_softc *sc)
{
memset(sc->sc_sram, 0, sizeof(sc->sc_sram));
sc->sc_flags &= ~ATWF_WEP_SRAM_VALID;
atw_write_sram(sc, 0, sc->sc_sram, sc->sc_sramlen);
}
static void
atw_wcsr_init(struct atw_softc *sc)
{
uint32_t wcsr;
wcsr = ATW_READ(sc, ATW_WCSR);
wcsr &= ~ATW_WCSR_BLN_MASK;
wcsr |= __SHIFTIN(7, ATW_WCSR_BLN_MASK);
wcsr |= ATW_WCSR_LSOE | ATW_WCSR_TSFTWE;
ATW_WRITE(sc, ATW_WCSR, wcsr);
DPRINTF(sc, ("%s: %s reg[WCSR] = %08x\n",
device_xname(sc->sc_dev), __func__, ATW_READ(sc, ATW_WCSR)));
}
static void
atw_cmdr_init(struct atw_softc *sc)
{
uint32_t cmdr;
cmdr = ATW_READ(sc, ATW_CMDR);
cmdr &= ~ATW_CMDR_APM;
cmdr |= ATW_CMDR_RTE;
cmdr &= ~ATW_CMDR_DRT_MASK;
cmdr |= ATW_CMDR_DRT_SF;
ATW_WRITE(sc, ATW_CMDR, cmdr);
}
static void
atw_tofs2_init(struct atw_softc *sc)
{
uint32_t tofs2;
#ifndef ATW_REFSLAVE
tofs2 = __SHIFTIN(4, ATW_TOFS2_PWR1UP_MASK) |
__SHIFTIN(13, ATW_TOFS2_PWR0PAPE_MASK) |
__SHIFTIN(8, ATW_TOFS2_PWR1PAPE_MASK) |
__SHIFTIN(5, ATW_TOFS2_PWR0TRSW_MASK) |
__SHIFTIN(12, ATW_TOFS2_PWR1TRSW_MASK) |
__SHIFTIN(13, ATW_TOFS2_PWR0PE2_MASK) |
__SHIFTIN(4, ATW_TOFS2_PWR1PE2_MASK) |
__SHIFTIN(5, ATW_TOFS2_PWR0TXPE_MASK);
#else
tofs2 = __SHIFTIN(8, ATW_TOFS2_PWR1UP_MASK) |
__SHIFTIN(8, ATW_TOFS2_PWR0PAPE_MASK) |
__SHIFTIN(1, ATW_TOFS2_PWR1PAPE_MASK) |
__SHIFTIN(5, ATW_TOFS2_PWR0TRSW_MASK) |
__SHIFTIN(12, ATW_TOFS2_PWR1TRSW_MASK) |
__SHIFTIN(13, ATW_TOFS2_PWR0PE2_MASK) |
__SHIFTIN(1, ATW_TOFS2_PWR1PE2_MASK) |
__SHIFTIN(8, ATW_TOFS2_PWR0TXPE_MASK);
#endif
ATW_WRITE(sc, ATW_TOFS2, tofs2);
}
static void
atw_nar_init(struct atw_softc *sc)
{
ATW_WRITE(sc, ATW_NAR, ATW_NAR_SF | ATW_NAR_PB);
}
static void
atw_txlmt_init(struct atw_softc *sc)
{
ATW_WRITE(sc, ATW_TXLMT, __SHIFTIN(512, ATW_TXLMT_MTMLT_MASK) |
__SHIFTIN(1, ATW_TXLMT_SRTYLIM_MASK));
}
static void
atw_test1_init(struct atw_softc *sc)
{
uint32_t test1;
test1 = ATW_READ(sc, ATW_TEST1);
test1 &= ~(ATW_TEST1_DBGREAD_MASK | ATW_TEST1_CONTROL);
test1 |= __SHIFTIN(0x1, ATW_TEST1_DBGREAD_MASK) | ATW_TEST1_CONTROL;
ATW_WRITE(sc, ATW_TEST1, test1);
}
static void
atw_rf_reset(struct atw_softc *sc)
{
ATW_WRITE(sc, ATW_SYNRF, ATW_SYNRF_INTERSIL_EN);
DELAY(atw_rf_delay1);
ATW_WRITE(sc, ATW_SYNRF, 0);
DELAY(atw_rf_delay2);
}
static void
atw_cfp_init(struct atw_softc *sc)
{
uint32_t cfpp;
cfpp = ATW_READ(sc, ATW_CFPP);
cfpp &= ~ATW_CFPP_CFPMD;
cfpp |= __SHIFTIN(16, ATW_CFPP_CFPMD);
ATW_WRITE(sc, ATW_CFPP, cfpp);
}
static void
atw_tofs0_init(struct atw_softc *sc)
{
ATW_WRITE(sc, ATW_TOFS0,
__SHIFTIN(22, ATW_TOFS0_USCNT_MASK) |
ATW_TOFS0_TUCNT_MASK );
}
static void
atw_ifs_init(struct atw_softc *sc)
{
uint32_t ifst;
ifst = __SHIFTIN(IEEE80211_DUR_DS_SLOT, ATW_IFST_SLOT_MASK) |
__SHIFTIN(22 * 10 ,
ATW_IFST_SIFS_MASK) |
__SHIFTIN(IEEE80211_DUR_DS_DIFS, ATW_IFST_DIFS_MASK) |
__SHIFTIN(IEEE80211_DUR_DS_EIFS, ATW_IFST_EIFS_MASK);
ATW_WRITE(sc, ATW_IFST, ifst);
}
static void
atw_response_times_init(struct atw_softc *sc)
{
ATW_WRITE(sc, ATW_RSPT, __SHIFTIN(0xffff, ATW_RSPT_MART_MASK) |
__SHIFTIN(0xff, ATW_RSPT_MIRT_MASK));
}
static void
atw_bbp_io_init(struct atw_softc *sc)
{
uint32_t mmiraddr2;
switch (sc->sc_rev) {
case ATW_REVISION_AB:
case ATW_REVISION_AF:
mmiraddr2 = 0x0;
break;
default:
mmiraddr2 = ATW_READ(sc, ATW_MMIRADDR2);
mmiraddr2 &=
~(ATW_MMIRADDR2_PROREXT | ATW_MMIRADDR2_PRORLEN_MASK);
break;
}
switch (sc->sc_bbptype) {
case ATW_BBPTYPE_INTERSIL:
ATW_WRITE(sc, ATW_MMIWADDR, ATW_MMIWADDR_INTERSIL);
ATW_WRITE(sc, ATW_MMIRADDR1, ATW_MMIRADDR1_INTERSIL);
mmiraddr2 |= ATW_MMIRADDR2_INTERSIL;
break;
case ATW_BBPTYPE_MARVEL:
break;
case ATW_BBPTYPE_RFMD:
default:
ATW_WRITE(sc, ATW_MMIWADDR, ATW_MMIWADDR_RFMD);
ATW_WRITE(sc, ATW_MMIRADDR1, ATW_MMIRADDR1_RFMD);
mmiraddr2 |= ATW_MMIRADDR2_RFMD;
break;
}
ATW_WRITE(sc, ATW_MMIRADDR2, mmiraddr2);
ATW_WRITE(sc, ATW_MACTEST, ATW_MACTEST_MMI_USETXCLK);
}
int
atw_init(struct ifnet *ifp)
{
struct atw_softc *sc = ifp->if_softc;
struct ieee80211com *ic = &sc->sc_ic;
struct atw_txsoft *txs;
struct atw_rxsoft *rxs;
int i, error = 0;
if (device_is_active(sc->sc_dev)) {
atw_stop(ifp, 0);
} else if (!pmf_device_subtree_resume(sc->sc_dev, &sc->sc_qual) ||
!device_is_active(sc->sc_dev))
return 0;
atw_reset(sc);
DPRINTF(sc, ("%s: channel %d freq %d flags 0x%04x\n",
__func__, ieee80211_chan2ieee(ic, ic->ic_curchan),
ic->ic_curchan->ic_freq, ic->ic_curchan->ic_flags));
atw_wcsr_init(sc);
atw_cmdr_init(sc);
ATW_WRITE(sc, ATW_PLCPHD, __SHIFTIN(10, ATW_PLCPHD_SIGNAL_MASK) |
__SHIFTIN(0xb0, ATW_PLCPHD_SERVICE_MASK));
atw_tofs2_init(sc);
atw_nar_init(sc);
atw_txlmt_init(sc);
atw_test1_init(sc);
atw_rf_reset(sc);
atw_cfp_init(sc);
atw_tofs0_init(sc);
atw_ifs_init(sc);
ATW_WRITE(sc, ATW_RMD,
__SHIFTIN(1, ATW_RMD_PCNT) | __SHIFTIN(0xffff, ATW_RMD_RMRD_MASK));
atw_response_times_init(sc);
atw_bbp_io_init(sc);
ATW_WRITE(sc, ATW_STSR, 0xffffffff);
if ((error = atw_rf3000_init(sc)) != 0)
goto out;
ATW_WRITE(sc, ATW_PAR, sc->sc_busmode);
DPRINTF(sc, ("%s: ATW_PAR %08x busmode %08x\n", device_xname(sc->sc_dev),
ATW_READ(sc, ATW_PAR), sc->sc_busmode));
memset(sc->sc_txdescs, 0, sizeof(sc->sc_txdescs));
for (i = 0; i < ATW_NTXDESC; i++) {
sc->sc_txdescs[i].at_ctl = 0;
sc->sc_txdescs[i].at_flags = 0 ;
sc->sc_txdescs[i].at_buf2 =
htole32(ATW_CDTXADDR(sc, ATW_NEXTTX(i)));
}
sc->sc_txdescs[ATW_NTXDESC - 1].at_flags |= htole32(ATW_TXFLAG_TER);
ATW_CDTXSYNC(sc, 0, ATW_NTXDESC,
BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
sc->sc_txfree = ATW_NTXDESC;
sc->sc_txnext = 0;
SIMPLEQ_INIT(&sc->sc_txfreeq);
SIMPLEQ_INIT(&sc->sc_txdirtyq);
for (i = 0; i < ATW_TXQUEUELEN; i++) {
txs = &sc->sc_txsoft[i];
txs->txs_mbuf = NULL;
SIMPLEQ_INSERT_TAIL(&sc->sc_txfreeq, txs, txs_q);
}
for (i = 0; i < ATW_NRXDESC; i++) {
rxs = &sc->sc_rxsoft[i];
if (rxs->rxs_mbuf == NULL) {
if ((error = atw_add_rxbuf(sc, i)) != 0) {
aprint_error_dev(sc->sc_dev,
"unable to allocate or map rx buffer %d, "
"error = %d\n", i, error);
atw_rxdrain(sc);
goto out;
}
} else
atw_init_rxdesc(sc, i);
}
sc->sc_rxptr = 0;
sc->sc_inten = ATW_INTR_TCI | ATW_INTR_TDU | ATW_INTR_RCI |
ATW_INTR_NISS | ATW_INTR_LINKON | ATW_INTR_BCNTC;
sc->sc_inten |= ATW_INTR_TPS | ATW_INTR_TLT | ATW_INTR_TRT |
ATW_INTR_TUF | ATW_INTR_RDU | ATW_INTR_RPS | ATW_INTR_AISS |
ATW_INTR_FBE | ATW_INTR_LINKOFF | ATW_INTR_TSFTF | ATW_INTR_TSCZ;
sc->sc_linkint_mask = ATW_INTR_LINKON | ATW_INTR_LINKOFF |
ATW_INTR_BCNTC | ATW_INTR_TSFTF | ATW_INTR_TSCZ;
sc->sc_rxint_mask = ATW_INTR_RCI | ATW_INTR_RDU;
sc->sc_txint_mask = ATW_INTR_TCI | ATW_INTR_TUF | ATW_INTR_TLT |
ATW_INTR_TRT;
sc->sc_linkint_mask &= sc->sc_inten;
sc->sc_rxint_mask &= sc->sc_inten;
sc->sc_txint_mask &= sc->sc_inten;
ATW_WRITE(sc, ATW_IER, sc->sc_inten);
ATW_WRITE(sc, ATW_STSR, 0xffffffff);
DPRINTF(sc, ("%s: ATW_IER %08x, inten %08x\n",
device_xname(sc->sc_dev), ATW_READ(sc, ATW_IER), sc->sc_inten));
ATW_WRITE(sc, ATW_RDB, ATW_CDRXADDR(sc, sc->sc_rxptr));
ATW_WRITE(sc, ATW_TDBD, ATW_CDTXADDR(sc, sc->sc_txnext));
sc->sc_txthresh = 0;
sc->sc_opmode = ATW_NAR_SR | ATW_NAR_ST |
sc->sc_txth[sc->sc_txthresh].txth_opmode;
ic->ic_flags &= ~IEEE80211_F_IBSSON;
switch (ic->ic_opmode) {
case IEEE80211_M_STA:
break;
case IEEE80211_M_AHDEMO:
case IEEE80211_M_IBSS:
ic->ic_flags |= IEEE80211_F_IBSSON;
case IEEE80211_M_HOSTAP:
break;
case IEEE80211_M_MONITOR:
break;
}
switch (ic->ic_opmode) {
case IEEE80211_M_AHDEMO:
case IEEE80211_M_HOSTAP:
#ifndef IEEE80211_NO_HOSTAP
ic->ic_bss->ni_intval = ic->ic_lintval;
ic->ic_bss->ni_rssi = 0;
ic->ic_bss->ni_rstamp = 0;
#endif
break;
default:
break;
}
sc->sc_wepctl = 0;
atw_write_ssid(sc);
atw_write_sup_rates(sc);
atw_write_wep(sc);
ic->ic_state = IEEE80211_S_INIT;
atw_filter_setup(sc);
ATW_WRITE(sc, ATW_RDR, 0x1);
ifp->if_flags |= IFF_RUNNING;
atw_start_beacon(sc, 0);
if (ic->ic_opmode == IEEE80211_M_MONITOR)
error = ieee80211_new_state(ic, IEEE80211_S_RUN, -1);
else
error = ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
out:
if (error) {
ifp->if_flags &= ~IFF_RUNNING;
sc->sc_tx_timer = 0;
ifp->if_timer = 0;
printf("%s: interface not running\n", device_xname(sc->sc_dev));
}
#ifdef ATW_DEBUG
atw_print_regs(sc, "end of init");
#endif
return (error);
}
static void
atw_bbp_io_enable(struct atw_softc *sc, int enable)
{
if (enable) {
ATW_WRITE(sc, ATW_SYNRF,
ATW_SYNRF_SELRF | ATW_SYNRF_PE1 | ATW_SYNRF_PHYRST);
DELAY(atw_bbp_io_enable_delay);
} else {
ATW_WRITE(sc, ATW_SYNRF, 0);
DELAY(atw_bbp_io_disable_delay);
}
}
static int
atw_tune(struct atw_softc *sc)
{
int rc;
u_int chan;
struct ieee80211com *ic = &sc->sc_ic;
chan = ieee80211_chan2ieee(ic, ic->ic_curchan);
if (chan == IEEE80211_CHAN_ANY)
panic("%s: chan == IEEE80211_CHAN_ANY\n", __func__);
if (chan == sc->sc_cur_chan)
return 0;
DPRINTF(sc, ("%s: chan %d -> %d\n", device_xname(sc->sc_dev),
sc->sc_cur_chan, chan));
atw_idle(sc, ATW_NAR_SR | ATW_NAR_ST);
atw_si4126_tune(sc, chan);
if ((rc = atw_rf3000_tune(sc, chan)) != 0)
printf("%s: failed to tune channel %d\n", device_xname(sc->sc_dev),
chan);
ATW_WRITE(sc, ATW_NAR, sc->sc_opmode);
DELAY(atw_nar_delay);
ATW_WRITE(sc, ATW_RDR, 0x1);
if (rc == 0) {
sc->sc_cur_chan = chan;
sc->sc_rxtap.ar_chan_freq = sc->sc_txtap.at_chan_freq =
htole16(ic->ic_curchan->ic_freq);
sc->sc_rxtap.ar_chan_flags = sc->sc_txtap.at_chan_flags =
htole16(ic->ic_curchan->ic_flags);
}
return rc;
}
#ifdef ATW_SYNDEBUG
static void
atw_si4126_print(struct atw_softc *sc)
{
struct ifnet *ifp = &sc->sc_if;
u_int addr, val;
val = 0;
if (atw_debug < 3 || (ifp->if_flags & IFF_DEBUG) == 0)
return;
for (addr = 0; addr <= 8; addr++) {
printf("%s: synth[%d] = ", device_xname(sc->sc_dev), addr);
if (atw_si4126_read(sc, addr, &val) == 0) {
printf("<unknown> (quitting print-out)\n");
break;
}
printf("%05x\n", val);
}
}
#endif
static void
atw_si4126_tune(struct atw_softc *sc, u_int chan)
{
u_int mhz;
u_int R;
uint32_t gpio;
uint16_t gain;
#ifdef ATW_SYNDEBUG
atw_si4126_print(sc);
#endif
if (chan == 14)
mhz = 2484;
else
mhz = 2412 + 5 * (chan - 1);
if (atw_xindiv2)
R = 44;
else
R = 88;
atw_si4126_write(sc, SI4126_POWER,
SI4126_POWER_PDIB | SI4126_POWER_PDRB);
atw_si4126_write(sc, SI4126_MAIN,
(atw_xindiv2) ? SI4126_MAIN_XINDIV2 : 0);
gain = __SHIFTIN(((mhz - 374) > 2047) ? 1 : 0, SI4126_GAIN_KP2_MASK);
atw_si4126_write(sc, SI4126_GAIN, gain);
atw_si4126_write(sc, SI4126_IFN, 1496);
atw_si4126_write(sc, SI4126_IFR, R);
#ifndef ATW_REFSLAVE
atw_si4126_write(sc, SI4126_RF1R, R);
atw_si4126_write(sc, SI4126_RF1N, mhz - 374);
#endif
atw_si4126_write(sc, SI4126_RF2R, R);
atw_si4126_write(sc, SI4126_RF2N, mhz - 374);
DELAY(100);
gpio = ATW_READ(sc, ATW_GPIO);
gpio &= ~(ATW_GPIO_EN_MASK | ATW_GPIO_O_MASK | ATW_GPIO_I_MASK);
gpio |= __SHIFTIN(1, ATW_GPIO_EN_MASK);
if ((sc->sc_if.if_flags & IFF_LINK1) != 0 && chan != 14) {
gpio |= __SHIFTIN(1, ATW_GPIO_O_MASK);
}
ATW_WRITE(sc, ATW_GPIO, gpio);
#ifdef ATW_SYNDEBUG
atw_si4126_print(sc);
#endif
}
static int
atw_rf3000_init(struct atw_softc *sc)
{
int rc = 0;
atw_bbp_io_enable(sc, 1);
rc = atw_rf3000_write(sc, RF3000_CCACTL,
__SHIFTIN(RF3000_CCACTL_MODE_BOTH, RF3000_CCACTL_MODE_MASK));
if (rc != 0)
goto out;
rc = atw_rf3000_write(sc, RF3000_DIVCTL, RF3000_DIVCTL_ENABLE);
if (rc != 0)
goto out;
rc = atw_rf3000_write(sc, RF3000_GAINCTL,
__SHIFTIN(0x1d, RF3000_GAINCTL_TXVGC_MASK));
if (rc != 0)
goto out;
rc = atw_rf3000_write(sc, RF3000_LOGAINCAL,
__SHIFTIN(0x38, RF3000_LOGAINCAL_CAL_MASK));
if (rc != 0)
goto out;
rc = atw_rf3000_write(sc, RF3000_HIGAINCAL, RF3000_HIGAINCAL_DSSSPAD);
if (rc != 0)
goto out;
rc = atw_rf3000_write(sc, RF3000_OPTIONS1, sc->sc_rf3000_options1);
if (rc != 0)
goto out;
rc = atw_rf3000_write(sc, RF3000_OPTIONS2, sc->sc_rf3000_options2);
if (rc != 0)
goto out;
out:
atw_bbp_io_enable(sc, 0);
return rc;
}
#ifdef ATW_BBPDEBUG
static void
atw_rf3000_print(struct atw_softc *sc)
{
struct ifnet *ifp = &sc->sc_if;
u_int addr, val;
if (atw_debug < 3 || (ifp->if_flags & IFF_DEBUG) == 0)
return;
for (addr = 0x01; addr <= 0x15; addr++) {
printf("%s: bbp[%d] = \n", device_xname(sc->sc_dev), addr);
if (atw_rf3000_read(sc, addr, &val) != 0) {
printf("<unknown> (quitting print-out)\n");
break;
}
printf("%08x\n", val);
}
}
#endif
static int
atw_rf3000_tune(struct atw_softc *sc, u_int chan)
{
int rc = 0;
uint32_t reg;
uint16_t txpower, lpf_cutoff, lna_gs_thresh;
txpower = sc->sc_srom[ATW_SR_TXPOWER(chan)];
lpf_cutoff = sc->sc_srom[ATW_SR_LPF_CUTOFF(chan)];
lna_gs_thresh = sc->sc_srom[ATW_SR_LNA_GS_THRESH(chan)];
if (chan % 2 == 1) {
txpower &= 0xFF;
lpf_cutoff &= 0xFF;
lna_gs_thresh &= 0xFF;
} else {
txpower >>= 8;
lpf_cutoff >>= 8;
lna_gs_thresh >>= 8;
}
#ifdef ATW_BBPDEBUG
atw_rf3000_print(sc);
#endif
DPRINTF(sc, ("%s: chan %d txpower %02x, lpf_cutoff %02x, "
"lna_gs_thresh %02x\n",
device_xname(sc->sc_dev), chan, txpower, lpf_cutoff, lna_gs_thresh));
atw_bbp_io_enable(sc, 1);
if ((rc = atw_rf3000_write(sc, RF3000_GAINCTL,
__SHIFTIN(txpower, RF3000_GAINCTL_TXVGC_MASK))) != 0)
goto out;
if ((rc = atw_rf3000_write(sc, RF3000_LOGAINCAL, lpf_cutoff)) != 0)
goto out;
if ((rc = atw_rf3000_write(sc, RF3000_HIGAINCAL, lna_gs_thresh)) != 0)
goto out;
rc = atw_rf3000_write(sc, RF3000_OPTIONS1, 0x0);
if (rc != 0)
goto out;
rc = atw_rf3000_write(sc, RF3000_OPTIONS2, RF3000_OPTIONS2_LNAGS_DELAY);
if (rc != 0)
goto out;
#ifdef ATW_BBPDEBUG
atw_rf3000_print(sc);
#endif
out:
atw_bbp_io_enable(sc, 0);
reg = ATW_READ(sc, ATW_PLCPHD);
reg &= ~ATW_PLCPHD_SERVICE_MASK;
reg |= __SHIFTIN(__SHIFTIN(txpower, RF3000_GAINCTL_TXVGC_MASK),
ATW_PLCPHD_SERVICE_MASK);
ATW_WRITE(sc, ATW_PLCPHD, reg);
DELAY(atw_plcphd_delay);
return rc;
}
static int
atw_rf3000_write(struct atw_softc *sc, u_int addr, u_int val)
{
uint32_t reg;
int i;
reg = sc->sc_bbpctl_wr |
__SHIFTIN(val & 0xff, ATW_BBPCTL_DATA_MASK) |
__SHIFTIN(addr & 0x7f, ATW_BBPCTL_ADDR_MASK);
for (i = 20000 / atw_pseudo_milli; --i >= 0; ) {
ATW_WRITE(sc, ATW_BBPCTL, reg);
DELAY(2 * atw_pseudo_milli);
if (ATW_ISSET(sc, ATW_BBPCTL, ATW_BBPCTL_WR) == 0)
break;
}
if (i < 0) {
printf("%s: BBPCTL still busy\n", device_xname(sc->sc_dev));
return ETIMEDOUT;
}
return 0;
}
#ifdef ATW_BBPDEBUG
static int
atw_rf3000_read(struct atw_softc *sc, u_int addr, u_int *val)
{
uint32_t reg;
int i;
for (i = 1000; --i >= 0; ) {
if (ATW_ISSET(sc, ATW_BBPCTL, ATW_BBPCTL_RD | ATW_BBPCTL_WR)
== 0)
break;
DELAY(100);
}
if (i < 0) {
printf("%s: start atw_rf3000_read, BBPCTL busy\n",
device_xname(sc->sc_dev));
return ETIMEDOUT;
}
reg = sc->sc_bbpctl_rd | __SHIFTIN(addr & 0x7f, ATW_BBPCTL_ADDR_MASK);
ATW_WRITE(sc, ATW_BBPCTL, reg);
for (i = 1000; --i >= 0; ) {
DELAY(100);
if (ATW_ISSET(sc, ATW_BBPCTL, ATW_BBPCTL_RD) == 0)
break;
}
ATW_CLR(sc, ATW_BBPCTL, ATW_BBPCTL_RD);
if (i < 0) {
printf("%s: atw_rf3000_read wrote %08x; BBPCTL still busy\n",
device_xname(sc->sc_dev), reg);
return ETIMEDOUT;
}
if (val != NULL)
*val = __SHIFTOUT(reg, ATW_BBPCTL_DATA_MASK);
return 0;
}
#endif
static void
atw_si4126_write(struct atw_softc *sc, u_int addr, u_int val)
{
uint32_t bits, mask, reg;
const int nbits = 22;
KASSERT((addr & ~__SHIFTOUT_MASK(SI4126_TWI_ADDR_MASK)) == 0);
KASSERT((val & ~__SHIFTOUT_MASK(SI4126_TWI_DATA_MASK)) == 0);
bits = __SHIFTIN(val, SI4126_TWI_DATA_MASK) |
__SHIFTIN(addr, SI4126_TWI_ADDR_MASK);
reg = ATW_SYNRF_SELSYN;
ATW_WRITE(sc, ATW_SYNRF, reg | ATW_SYNRF_LEIF);
ATW_WRITE(sc, ATW_SYNRF, reg);
for (mask = __BIT(nbits - 1); mask != 0; mask >>= 1) {
if ((bits & mask) != 0)
reg |= ATW_SYNRF_SYNDATA;
else
reg &= ~ATW_SYNRF_SYNDATA;
ATW_WRITE(sc, ATW_SYNRF, reg);
ATW_WRITE(sc, ATW_SYNRF, reg | ATW_SYNRF_SYNCLK);
ATW_WRITE(sc, ATW_SYNRF, reg);
}
ATW_WRITE(sc, ATW_SYNRF, reg | ATW_SYNRF_LEIF);
ATW_WRITE(sc, ATW_SYNRF, 0x0);
}
#ifdef ATW_SYNDEBUG
static int
atw_si4126_read(struct atw_softc *sc, u_int addr, u_int *val)
{
uint32_t reg;
int i;
KASSERT((addr & ~__SHIFTOUT_MASK(SI4126_TWI_ADDR_MASK)) == 0);
for (i = 1000; --i >= 0; ) {
if (ATW_ISSET(sc, ATW_SYNCTL, ATW_SYNCTL_RD | ATW_SYNCTL_WR)
== 0)
break;
DELAY(100);
}
if (i < 0) {
printf("%s: start atw_si4126_read, SYNCTL busy\n",
device_xname(sc->sc_dev));
return ETIMEDOUT;
}
reg = sc->sc_synctl_rd | __SHIFTIN(addr, ATW_SYNCTL_DATA_MASK);
ATW_WRITE(sc, ATW_SYNCTL, reg);
for (i = 1000; --i >= 0; ) {
DELAY(100);
if (ATW_ISSET(sc, ATW_SYNCTL, ATW_SYNCTL_RD) == 0)
break;
}
ATW_CLR(sc, ATW_SYNCTL, ATW_SYNCTL_RD);
if (i < 0) {
printf("%s: atw_si4126_read wrote %#08x, SYNCTL still busy\n",
device_xname(sc->sc_dev), reg);
return ETIMEDOUT;
}
if (val != NULL)
*val = __SHIFTOUT(ATW_READ(sc, ATW_SYNCTL),
ATW_SYNCTL_DATA_MASK);
return 0;
}
#endif
#define atw_calchash(addr) \
(ether_crc32_le((addr), IEEE80211_ADDR_LEN) & __BITS(5, 0))
static void
atw_filter_setup(struct atw_softc *sc)
{
struct ieee80211com *ic = &sc->sc_ic;
struct ethercom *ec = &sc->sc_ec;
struct ifnet *ifp = &sc->sc_if;
int hash;
uint32_t hashes[2];
struct ether_multi *enm;
struct ether_multistep step;
if ((ifp->if_flags & IFF_RUNNING) != 0)
atw_idle(sc, ATW_NAR_SR);
sc->sc_opmode &= ~(ATW_NAR_PB | ATW_NAR_PR | ATW_NAR_MM);
ifp->if_flags &= ~IFF_ALLMULTI;
if (ic->ic_state == IEEE80211_S_SCAN ||
(ifp->if_flags & IFF_PROMISC) != 0) {
sc->sc_opmode |= ATW_NAR_PR | ATW_NAR_PB;
goto allmulti;
}
hashes[0] = hashes[1] = 0x0;
ETHER_LOCK(ec);
ETHER_FIRST_MULTI(step, ec, enm);
while (enm != NULL) {
if (memcmp(enm->enm_addrlo, enm->enm_addrhi,
ETHER_ADDR_LEN) != 0) {
ETHER_UNLOCK(ec);
goto allmulti;
}
hash = atw_calchash(enm->enm_addrlo);
hashes[hash >> 5] |= 1 << (hash & 0x1f);
ETHER_NEXT_MULTI(step, enm);
sc->sc_opmode |= ATW_NAR_MM;
}
ETHER_UNLOCK(ec);
ifp->if_flags &= ~IFF_ALLMULTI;
goto setit;
allmulti:
sc->sc_opmode |= ATW_NAR_MM;
ifp->if_flags |= IFF_ALLMULTI;
hashes[0] = hashes[1] = 0xffffffff;
setit:
ATW_WRITE(sc, ATW_MAR0, hashes[0]);
ATW_WRITE(sc, ATW_MAR1, hashes[1]);
ATW_WRITE(sc, ATW_NAR, sc->sc_opmode);
DELAY(atw_nar_delay);
ATW_WRITE(sc, ATW_RDR, 0x1);
DPRINTF(sc, ("%s: ATW_NAR %08x opmode %08x\n", device_xname(sc->sc_dev),
ATW_READ(sc, ATW_NAR), sc->sc_opmode));
}
static void
atw_write_bssid(struct atw_softc *sc)
{
struct ieee80211com *ic = &sc->sc_ic;
uint8_t *bssid;
bssid = ic->ic_bss->ni_bssid;
ATW_WRITE(sc, ATW_BSSID0,
__SHIFTIN(bssid[0], ATW_BSSID0_BSSIDB0_MASK) |
__SHIFTIN(bssid[1], ATW_BSSID0_BSSIDB1_MASK) |
__SHIFTIN(bssid[2], ATW_BSSID0_BSSIDB2_MASK) |
__SHIFTIN(bssid[3], ATW_BSSID0_BSSIDB3_MASK));
ATW_WRITE(sc, ATW_ABDA1,
(ATW_READ(sc, ATW_ABDA1) &
~(ATW_ABDA1_BSSIDB4_MASK | ATW_ABDA1_BSSIDB5_MASK)) |
__SHIFTIN(bssid[4], ATW_ABDA1_BSSIDB4_MASK) |
__SHIFTIN(bssid[5], ATW_ABDA1_BSSIDB5_MASK));
DPRINTF(sc, ("%s: BSSID %s -> ", device_xname(sc->sc_dev),
ether_sprintf(sc->sc_bssid)));
DPRINTF(sc, ("%s\n", ether_sprintf(bssid)));
memcpy(sc->sc_bssid, bssid, sizeof(sc->sc_bssid));
}
static void
atw_write_sram(struct atw_softc *sc, u_int ofs, uint8_t *buf, u_int buflen)
{
u_int i;
uint8_t *ptr;
memcpy(&sc->sc_sram[ofs], buf, buflen);
KASSERT(ofs % 2 == 0 && buflen % 2 == 0);
KASSERT(buflen + ofs <= sc->sc_sramlen);
ptr = &sc->sc_sram[ofs];
for (i = 0; i < buflen; i += 2) {
ATW_WRITE(sc, ATW_WEPCTL, ATW_WEPCTL_WR |
__SHIFTIN((ofs + i) / 2, ATW_WEPCTL_TBLADD_MASK));
DELAY(atw_writewep_delay);
ATW_WRITE(sc, ATW_WESK,
__SHIFTIN((ptr[i + 1] << 8) | ptr[i], ATW_WESK_DATA_MASK));
DELAY(atw_writewep_delay);
}
ATW_WRITE(sc, ATW_WEPCTL, sc->sc_wepctl);
if (sc->sc_if.if_flags & IFF_DEBUG) {
int n_octets = 0;
printf("%s: wrote %d bytes at 0x%x wepctl 0x%08x\n",
device_xname(sc->sc_dev), buflen, ofs, sc->sc_wepctl);
for (i = 0; i < buflen; i++) {
printf(" %02x", ptr[i]);
if (++n_octets % 24 == 0)
printf("\n");
}
if (n_octets % 24 != 0)
printf("\n");
}
}
static int
atw_key_delete(struct ieee80211com *ic, const struct ieee80211_key *k)
{
struct atw_softc *sc = ic->ic_ifp->if_softc;
u_int keyix = k->wk_keyix;
DPRINTF(sc, ("%s: delete key %u\n", __func__, keyix));
if (keyix >= IEEE80211_WEP_NKID)
return 0;
if (k->wk_keylen != 0)
sc->sc_flags &= ~ATWF_WEP_SRAM_VALID;
return 1;
}
static int
atw_key_set(struct ieee80211com *ic, const struct ieee80211_key *k,
const uint8_t mac[IEEE80211_ADDR_LEN])
{
struct atw_softc *sc = ic->ic_ifp->if_softc;
DPRINTF(sc, ("%s: set key %u\n", __func__, k->wk_keyix));
if (k->wk_keyix >= IEEE80211_WEP_NKID)
return 0;
sc->sc_flags &= ~ATWF_WEP_SRAM_VALID;
return 1;
}
static void
atw_key_update_begin(struct ieee80211com *ic)
{
#ifdef ATW_DEBUG
struct ifnet *ifp = ic->ic_ifp;
struct atw_softc *sc = ifp->if_softc;
#endif
DPRINTF(sc, ("%s:\n", __func__));
}
static void
atw_key_update_end(struct ieee80211com *ic)
{
struct ifnet *ifp = ic->ic_ifp;
struct atw_softc *sc = ifp->if_softc;
DPRINTF(sc, ("%s:\n", __func__));
if ((sc->sc_flags & ATWF_WEP_SRAM_VALID) != 0)
return;
if (!device_activation(sc->sc_dev, DEVACT_LEVEL_DRIVER))
return;
atw_idle(sc, ATW_NAR_SR | ATW_NAR_ST);
atw_write_wep(sc);
ATW_WRITE(sc, ATW_NAR, sc->sc_opmode);
DELAY(atw_nar_delay);
ATW_WRITE(sc, ATW_RDR, 0x1);
}
static void
atw_write_wep(struct atw_softc *sc)
{
#if 0
struct ieee80211com *ic = &sc->sc_ic;
uint32_t reg;
int i;
#endif
uint8_t buf[IEEE80211_WEP_NKID]
[1 + 1 + 12 ];
sc->sc_wepctl = 0;
ATW_WRITE(sc, ATW_WEPCTL, sc->sc_wepctl);
memset(&buf[0][0], 0, sizeof(buf));
#if 0
for (i = 0; i < IEEE80211_WEP_NKID; i++) {
if (ic->ic_nw_keys[i].wk_keylen > 5) {
buf[i][1] = ATW_WEP_ENABLED | ATW_WEP_104BIT;
} else if (ic->ic_nw_keys[i].wk_keylen != 0) {
buf[i][1] = ATW_WEP_ENABLED;
} else {
buf[i][1] = 0;
continue;
}
buf[i][0] = ic->ic_nw_keys[i].wk_key[0];
memcpy(&buf[i][2], &ic->ic_nw_keys[i].wk_key[1],
ic->ic_nw_keys[i].wk_keylen - 1);
}
reg = ATW_READ(sc, ATW_MACTEST);
reg |= ATW_MACTEST_MMI_USETXCLK | ATW_MACTEST_FORCE_KEYID;
reg &= ~ATW_MACTEST_KEYID_MASK;
reg |= __SHIFTIN(ic->ic_def_txkey, ATW_MACTEST_KEYID_MASK);
ATW_WRITE(sc, ATW_MACTEST, reg);
if ((ic->ic_flags & IEEE80211_F_PRIVACY) != 0)
sc->sc_wepctl |= ATW_WEPCTL_WEPENABLE;
switch (sc->sc_rev) {
case ATW_REVISION_AB:
case ATW_REVISION_AF:
sc->sc_wepctl |= ATW_WEPCTL_WEPRXBYP;
break;
default:
break;
}
#endif
atw_write_sram(sc, ATW_SRAM_ADDR_SHARED_KEY, (uint8_t*)&buf[0][0],
sizeof(buf));
sc->sc_flags |= ATWF_WEP_SRAM_VALID;
}
static void
atw_recv_mgmt(struct ieee80211com *ic, struct mbuf *m,
struct ieee80211_node *ni, int subtype, int rssi, uint32_t rstamp)
{
struct atw_softc *sc = (struct atw_softc *)ic->ic_ifp->if_softc;
if (subtype == IEEE80211_FC0_SUBTYPE_PROBE_REQ)
return;
(*sc->sc_recv_mgmt)(ic, m, ni, subtype, rssi, rstamp);
switch (subtype) {
case IEEE80211_FC0_SUBTYPE_PROBE_RESP:
case IEEE80211_FC0_SUBTYPE_BEACON:
if (ic->ic_opmode == IEEE80211_M_IBSS &&
ic->ic_state == IEEE80211_S_RUN) {
if (le64toh(ni->ni_tstamp.tsf) >= atw_get_tsft(sc))
(void)ieee80211_ibss_merge(ni);
}
break;
default:
break;
}
return;
}
static void
atw_write_ssid(struct atw_softc *sc)
{
struct ieee80211com *ic = &sc->sc_ic;
uint8_t buf[roundup(1 + IEEE80211_NWID_LEN, 2)];
memset(buf, 0, sizeof(buf));
buf[0] = ic->ic_bss->ni_esslen;
memcpy(&buf[1], ic->ic_bss->ni_essid, ic->ic_bss->ni_esslen);
atw_write_sram(sc, ATW_SRAM_ADDR_SSID, buf,
roundup(1 + ic->ic_bss->ni_esslen, 2));
}
static void
atw_write_sup_rates(struct atw_softc *sc)
{
struct ieee80211com *ic = &sc->sc_ic;
uint8_t buf[roundup(1 + IEEE80211_RATE_SIZE, 2)];
memset(buf, 0, sizeof(buf));
buf[0] = ic->ic_bss->ni_rates.rs_nrates;
memcpy(&buf[1], ic->ic_bss->ni_rates.rs_rates,
ic->ic_bss->ni_rates.rs_nrates);
atw_write_sram(sc, ATW_SRAM_ADDR_SUPRATES, buf, sizeof(buf));
}
void
atw_start_beacon(struct atw_softc *sc, int start)
{
struct ieee80211com *ic = &sc->sc_ic;
uint16_t chan;
uint32_t bcnt, bpli, cap0, cap1, capinfo;
size_t len;
if (!device_is_active(sc->sc_dev))
return;
len = sizeof(struct ieee80211_frame) +
8 + 2 +
2 +
2 + ic->ic_bss->ni_esslen +
2 + ic->ic_bss->ni_rates.rs_nrates +
3 +
IEEE80211_CRC_LEN;
bcnt = ATW_READ(sc, ATW_BCNT) & ~ATW_BCNT_BCNT_MASK;
cap0 = ATW_READ(sc, ATW_CAP0) & ~ATW_CAP0_CHN_MASK;
cap1 = ATW_READ(sc, ATW_CAP1) & ~ATW_CAP1_CAPI_MASK;
ATW_WRITE(sc, ATW_BCNT, bcnt);
ATW_WRITE(sc, ATW_CAP1, cap1);
if (!start)
return;
capinfo = 0;
if (ic->ic_flags & IEEE80211_F_SHPREAMBLE)
capinfo |= IEEE80211_CAPINFO_SHORT_PREAMBLE;
if (ic->ic_flags & IEEE80211_F_PRIVACY)
capinfo |= IEEE80211_CAPINFO_PRIVACY;
switch (ic->ic_opmode) {
case IEEE80211_M_IBSS:
len += 4;
capinfo |= IEEE80211_CAPINFO_IBSS;
break;
case IEEE80211_M_HOSTAP:
len += atw_beacon_len_adjust;
capinfo |= IEEE80211_CAPINFO_ESS;
break;
default:
return;
}
bpli = __SHIFTIN(ic->ic_bss->ni_intval, ATW_BPLI_BP_MASK) |
__SHIFTIN(ic->ic_lintval / ic->ic_bss->ni_intval, ATW_BPLI_LI_MASK);
chan = ieee80211_chan2ieee(ic, ic->ic_curchan);
bcnt |= __SHIFTIN(len, ATW_BCNT_BCNT_MASK);
cap0 |= __SHIFTIN(chan, ATW_CAP0_CHN_MASK);
cap1 |= __SHIFTIN(capinfo, ATW_CAP1_CAPI_MASK);
ATW_WRITE(sc, ATW_BCNT, bcnt);
ATW_WRITE(sc, ATW_BPLI, bpli);
ATW_WRITE(sc, ATW_CAP0, cap0);
ATW_WRITE(sc, ATW_CAP1, cap1);
DPRINTF(sc, ("%s: atw_start_beacon reg[ATW_BCNT] = %08x\n",
device_xname(sc->sc_dev), bcnt));
DPRINTF(sc, ("%s: atw_start_beacon reg[ATW_CAP1] = %08x\n",
device_xname(sc->sc_dev), cap1));
}
static inline uint32_t
atw_last_even_tsft(uint32_t tsfth, uint32_t tsftl, uint32_t ival)
{
return ((0xFFFFFFFF % ival + 1) * tsfth + tsftl) % ival;
}
static uint64_t
atw_get_tsft(struct atw_softc *sc)
{
int i;
uint32_t tsfth, tsftl;
for (i = 0; i < 2; i++) {
tsfth = ATW_READ(sc, ATW_TSFTH);
tsftl = ATW_READ(sc, ATW_TSFTL);
if (ATW_READ(sc, ATW_TSFTH) == tsfth)
break;
}
return ((uint64_t)tsfth << 32) | tsftl;
}
static void
atw_predict_beacon(struct atw_softc *sc)
{
#define TBTTOFS 20
struct ieee80211com *ic = &sc->sc_ic;
uint64_t tsft;
uint32_t ival, past_even, tbtt, tsfth, tsftl;
union {
uint64_t word;
uint8_t tstamp[8];
} u;
if ((ic->ic_opmode == IEEE80211_M_HOSTAP) ||
((ic->ic_opmode == IEEE80211_M_IBSS) &&
(ic->ic_flags & IEEE80211_F_SIBSS))) {
tsft = atw_get_tsft(sc);
u.word = htole64(tsft);
(void)memcpy(&ic->ic_bss->ni_tstamp, &u.tstamp[0],
sizeof(ic->ic_bss->ni_tstamp));
} else
tsft = le64toh(ic->ic_bss->ni_tstamp.tsf);
ival = ic->ic_bss->ni_intval * IEEE80211_DUR_TU;
tsftl = tsft & 0xFFFFFFFF;
tsfth = tsft >> 32;
past_even = tsftl - atw_last_even_tsft(tsfth, tsftl, ival);
tbtt = past_even + ival * 10;
ATW_WRITE(sc, ATW_TOFS1,
__SHIFTIN(1, ATW_TOFS1_TSFTOFSR_MASK) |
__SHIFTIN(TBTTOFS, ATW_TOFS1_TBTTOFS_MASK) |
__SHIFTIN(__SHIFTOUT(tbtt - TBTTOFS * IEEE80211_DUR_TU,
ATW_TBTTPRE_MASK), ATW_TOFS1_TBTTPRE_MASK));
#undef TBTTOFS
}
static void
atw_next_scan(void *arg)
{
struct atw_softc *sc = arg;
struct ieee80211com *ic = &sc->sc_ic;
int s;
s = splnet();
if (ic->ic_state == IEEE80211_S_SCAN)
ieee80211_next_scan(ic);
splx(s);
}
static int
atw_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg)
{
struct ifnet *ifp = ic->ic_ifp;
struct atw_softc *sc = ifp->if_softc;
int error = 0;
callout_stop(&sc->sc_scan_ch);
switch (nstate) {
case IEEE80211_S_AUTH:
case IEEE80211_S_ASSOC:
atw_write_bssid(sc);
error = atw_tune(sc);
break;
case IEEE80211_S_INIT:
callout_stop(&sc->sc_scan_ch);
sc->sc_cur_chan = IEEE80211_CHAN_ANY;
atw_start_beacon(sc, 0);
break;
case IEEE80211_S_SCAN:
error = atw_tune(sc);
callout_reset(&sc->sc_scan_ch, atw_dwelltime * hz / 1000,
atw_next_scan, sc);
break;
case IEEE80211_S_RUN:
error = atw_tune(sc);
atw_write_bssid(sc);
atw_write_ssid(sc);
atw_write_sup_rates(sc);
if (ic->ic_opmode == IEEE80211_M_AHDEMO ||
ic->ic_opmode == IEEE80211_M_MONITOR)
break;
ATW_WRITE(sc, ATW_BPLI,
__SHIFTIN(ic->ic_bss->ni_intval, ATW_BPLI_BP_MASK) |
__SHIFTIN(ic->ic_lintval / ic->ic_bss->ni_intval,
ATW_BPLI_LI_MASK));
DPRINTF(sc, ("%s: reg[ATW_BPLI] = %08x\n", device_xname(sc->sc_dev),
ATW_READ(sc, ATW_BPLI)));
atw_predict_beacon(sc);
switch (ic->ic_opmode) {
case IEEE80211_M_AHDEMO:
case IEEE80211_M_HOSTAP:
case IEEE80211_M_IBSS:
atw_start_beacon(sc, 1);
break;
case IEEE80211_M_MONITOR:
case IEEE80211_M_STA:
break;
}
break;
}
return (error != 0) ? error : (*sc->sc_newstate)(ic, nstate, arg);
}
int
atw_add_rxbuf(struct atw_softc *sc, int idx)
{
struct atw_rxsoft *rxs = &sc->sc_rxsoft[idx];
struct mbuf *m;
int error;
MGETHDR(m, M_DONTWAIT, MT_DATA);
if (m == NULL)
return (ENOBUFS);
MCLGET(m, M_DONTWAIT);
if ((m->m_flags & M_EXT) == 0) {
m_freem(m);
return (ENOBUFS);
}
if (rxs->rxs_mbuf != NULL)
bus_dmamap_unload(sc->sc_dmat, rxs->rxs_dmamap);
rxs->rxs_mbuf = m;
error = bus_dmamap_load(sc->sc_dmat, rxs->rxs_dmamap,
m->m_ext.ext_buf, m->m_ext.ext_size, NULL,
BUS_DMA_READ | BUS_DMA_NOWAIT);
if (error) {
aprint_error_dev(sc->sc_dev, "can't load rx DMA map %d, error = %d\n",
idx, error);
panic("atw_add_rxbuf");
}
bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_PREREAD);
atw_init_rxdesc(sc, idx);
return (0);
}
void
atw_txdrain(struct atw_softc *sc)
{
struct atw_txsoft *txs;
while ((txs = SIMPLEQ_FIRST(&sc->sc_txdirtyq)) != NULL) {
SIMPLEQ_REMOVE_HEAD(&sc->sc_txdirtyq, txs_q);
if (txs->txs_mbuf != NULL) {
bus_dmamap_unload(sc->sc_dmat, txs->txs_dmamap);
m_freem(txs->txs_mbuf);
txs->txs_mbuf = NULL;
}
SIMPLEQ_INSERT_TAIL(&sc->sc_txfreeq, txs, txs_q);
sc->sc_txfree += txs->txs_ndescs;
}
KASSERT((sc->sc_if.if_flags & IFF_RUNNING) == 0 ||
!(SIMPLEQ_EMPTY(&sc->sc_txfreeq) ||
sc->sc_txfree != ATW_NTXDESC));
sc->sc_if.if_flags &= ~IFF_OACTIVE;
sc->sc_tx_timer = 0;
}
void
atw_stop(struct ifnet *ifp, int disable)
{
struct atw_softc *sc = ifp->if_softc;
struct ieee80211com *ic = &sc->sc_ic;
ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
if (device_is_active(sc->sc_dev)) {
ATW_WRITE(sc, ATW_IER, 0);
ATW_WRITE(sc, ATW_NAR, 0);
DELAY(atw_nar_delay);
ATW_WRITE(sc, ATW_TDBD, 0);
ATW_WRITE(sc, ATW_TDBP, 0);
ATW_WRITE(sc, ATW_RDB, 0);
}
sc->sc_opmode = 0;
atw_txdrain(sc);
ifp->if_flags &= ~IFF_RUNNING;
ifp->if_timer = 0;
if (disable)
pmf_device_suspend(sc->sc_dev, &sc->sc_qual);
}
void
atw_rxdrain(struct atw_softc *sc)
{
struct atw_rxsoft *rxs;
int i;
for (i = 0; i < ATW_NRXDESC; i++) {
rxs = &sc->sc_rxsoft[i];
if (rxs->rxs_mbuf == NULL)
continue;
bus_dmamap_unload(sc->sc_dmat, rxs->rxs_dmamap);
m_freem(rxs->rxs_mbuf);
rxs->rxs_mbuf = NULL;
}
}
int
atw_detach(struct atw_softc *sc)
{
struct ifnet *ifp = &sc->sc_if;
struct atw_rxsoft *rxs;
struct atw_txsoft *txs;
int i;
if ((sc->sc_flags & ATWF_ATTACHED) == 0)
return (0);
pmf_device_deregister(sc->sc_dev);
callout_stop(&sc->sc_scan_ch);
ieee80211_ifdetach(&sc->sc_ic);
if_detach(ifp);
for (i = 0; i < ATW_NRXDESC; i++) {
rxs = &sc->sc_rxsoft[i];
if (rxs->rxs_mbuf != NULL) {
bus_dmamap_unload(sc->sc_dmat, rxs->rxs_dmamap);
m_freem(rxs->rxs_mbuf);
rxs->rxs_mbuf = NULL;
}
bus_dmamap_destroy(sc->sc_dmat, rxs->rxs_dmamap);
}
for (i = 0; i < ATW_TXQUEUELEN; i++) {
txs = &sc->sc_txsoft[i];
if (txs->txs_mbuf != NULL) {
bus_dmamap_unload(sc->sc_dmat, txs->txs_dmamap);
m_freem(txs->txs_mbuf);
txs->txs_mbuf = NULL;
}
bus_dmamap_destroy(sc->sc_dmat, txs->txs_dmamap);
}
bus_dmamap_unload(sc->sc_dmat, sc->sc_cddmamap);
bus_dmamap_destroy(sc->sc_dmat, sc->sc_cddmamap);
bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_control_data,
sizeof(struct atw_control_data));
bus_dmamem_free(sc->sc_dmat, &sc->sc_cdseg, sc->sc_cdnseg);
if (sc->sc_srom)
free(sc->sc_srom, M_DEVBUF);
atw_evcnt_detach(sc);
if (sc->sc_soft_ih != NULL) {
softint_disestablish(sc->sc_soft_ih);
sc->sc_soft_ih = NULL;
}
return (0);
}
bool
atw_shutdown(device_t self, int flags)
{
struct atw_softc *sc = device_private(self);
atw_stop(&sc->sc_if, 1);
return true;
}
#if 0
static void
atw_workaround1(struct atw_softc *sc)
{
uint32_t test1;
test1 = ATW_READ(sc, ATW_TEST1);
sc->sc_misc_ev.ev_count++;
if ((test1 & ATW_TEST1_RXPKT1IN) != 0) {
sc->sc_rxpkt1in_ev.ev_count++;
return;
}
if (__SHIFTOUT(test1, ATW_TEST1_RRA_MASK) ==
__SHIFTOUT(test1, ATW_TEST1_RWA_MASK)) {
sc->sc_rxamatch_ev.ev_count++;
return;
}
sc->sc_workaround1_ev.ev_count++;
(void)atw_init(&sc->sc_if);
}
#endif
int
atw_intr(void *arg)
{
struct atw_softc *sc = arg;
struct ifnet *ifp = &sc->sc_if;
uint32_t status;
#ifdef DEBUG
if (!device_activation(sc->sc_dev, DEVACT_LEVEL_DRIVER))
panic("%s: atw_intr: not enabled", device_xname(sc->sc_dev));
#endif
if ((ifp->if_flags & IFF_RUNNING) == 0 ||
!device_activation(sc->sc_dev, DEVACT_LEVEL_DRIVER))
return (0);
status = ATW_READ(sc, ATW_STSR);
if (status == 0)
return 0;
if ((status & sc->sc_inten) == 0) {
ATW_WRITE(sc, ATW_STSR, status);
return 0;
}
ATW_WRITE(sc, ATW_IER, 0);
softint_schedule(sc->sc_soft_ih);
return 1;
}
void
atw_softintr(void *arg)
{
struct atw_softc *sc = arg;
struct ifnet *ifp = &sc->sc_if;
uint32_t status, rxstatus, txstatus, linkstatus;
int txthresh, s;
if ((ifp->if_flags & IFF_RUNNING) == 0 ||
!device_activation(sc->sc_dev, DEVACT_LEVEL_DRIVER))
return;
for (;;) {
status = ATW_READ(sc, ATW_STSR);
if (status)
ATW_WRITE(sc, ATW_STSR, status);
#ifdef ATW_DEBUG
#define PRINTINTR(flag) do { \
if ((status & flag) != 0) { \
printf("%s" #flag, delim); \
delim = ","; \
} \
} while (0)
if (atw_debug > 1 && status) {
const char *delim = "<";
printf("%s: reg[STSR] = %x",
device_xname(sc->sc_dev), status);
PRINTINTR(ATW_INTR_FBE);
PRINTINTR(ATW_INTR_LINKOFF);
PRINTINTR(ATW_INTR_LINKON);
PRINTINTR(ATW_INTR_RCI);
PRINTINTR(ATW_INTR_RDU);
PRINTINTR(ATW_INTR_REIS);
PRINTINTR(ATW_INTR_RPS);
PRINTINTR(ATW_INTR_TCI);
PRINTINTR(ATW_INTR_TDU);
PRINTINTR(ATW_INTR_TLT);
PRINTINTR(ATW_INTR_TPS);
PRINTINTR(ATW_INTR_TRT);
PRINTINTR(ATW_INTR_TUF);
PRINTINTR(ATW_INTR_BCNTC);
PRINTINTR(ATW_INTR_ATIME);
PRINTINTR(ATW_INTR_TBTT);
PRINTINTR(ATW_INTR_TSCZ);
PRINTINTR(ATW_INTR_TSFTF);
printf(">\n");
}
#undef PRINTINTR
#endif
if ((status & sc->sc_inten) == 0)
break;
rxstatus = status & sc->sc_rxint_mask;
txstatus = status & sc->sc_txint_mask;
linkstatus = status & sc->sc_linkint_mask;
if (linkstatus) {
atw_linkintr(sc, linkstatus);
}
if (rxstatus) {
atw_rxintr(sc);
if (rxstatus & ATW_INTR_RDU) {
printf("%s: receive ring overrun\n",
device_xname(sc->sc_dev));
ATW_WRITE(sc, ATW_RDR, 0x1);
}
}
if (txstatus) {
atw_txintr(sc, txstatus);
if (txstatus & ATW_INTR_TLT) {
DPRINTF(sc, ("%s: tx lifetime exceeded\n",
device_xname(sc->sc_dev)));
(void)atw_init(&sc->sc_if);
}
if (txstatus & ATW_INTR_TRT) {
DPRINTF(sc, ("%s: tx retry limit exceeded\n",
device_xname(sc->sc_dev)));
}
txthresh = sc->sc_txthresh + 1;
if ((txstatus & ATW_INTR_TUF) &&
sc->sc_txth[txthresh].txth_name != NULL) {
atw_idle(sc, ATW_NAR_ST);
sc->sc_txthresh = txthresh;
sc->sc_opmode &= ~(ATW_NAR_TR_MASK|ATW_NAR_SF);
sc->sc_opmode |=
sc->sc_txth[txthresh].txth_opmode;
printf("%s: transmit underrun; new "
"threshold: %s\n", device_xname(sc->sc_dev),
sc->sc_txth[txthresh].txth_name);
ATW_WRITE(sc, ATW_NAR, sc->sc_opmode);
DELAY(atw_nar_delay);
ATW_WRITE(sc, ATW_TDR, 0x1);
}
}
if (status & (ATW_INTR_TPS | ATW_INTR_RPS)) {
if (status & ATW_INTR_TPS)
printf("%s: transmit process stopped\n",
device_xname(sc->sc_dev));
if (status & ATW_INTR_RPS)
printf("%s: receive process stopped\n",
device_xname(sc->sc_dev));
s = splnet();
(void)atw_init(ifp);
splx(s);
break;
}
if (status & ATW_INTR_FBE) {
aprint_error_dev(sc->sc_dev, "fatal bus error\n");
s = splnet();
(void)atw_init(ifp);
splx(s);
break;
}
}
s = splnet();
atw_start(ifp);
splx(s);
ATW_WRITE(sc, ATW_IER, sc->sc_inten);
}
void
atw_idle(struct atw_softc *sc, uint32_t bits)
{
uint32_t ackmask = 0, opmode, stsr, test0;
int i, s;
s = splnet();
opmode = sc->sc_opmode & ~bits;
if (bits & ATW_NAR_SR)
ackmask |= ATW_INTR_RPS;
if (bits & ATW_NAR_ST) {
ackmask |= ATW_INTR_TPS;
opmode |= ATW_NAR_HF;
}
ATW_WRITE(sc, ATW_NAR, opmode);
DELAY(atw_nar_delay);
for (i = 0; i < 1000; i++) {
stsr = ATW_READ(sc, ATW_STSR);
if ((stsr & ackmask) == ackmask)
break;
DELAY(10);
}
ATW_WRITE(sc, ATW_STSR, stsr & ackmask);
if ((stsr & ackmask) == ackmask)
goto out;
test0 = ATW_READ(sc, ATW_TEST0);
if ((bits & ATW_NAR_ST) != 0 && (stsr & ATW_INTR_TPS) == 0 &&
(test0 & ATW_TEST0_TS_MASK) != ATW_TEST0_TS_STOPPED) {
printf("%s: transmit process not idle [%s]\n",
device_xname(sc->sc_dev),
atw_tx_state[__SHIFTOUT(test0, ATW_TEST0_TS_MASK)]);
printf("%s: bits %08x test0 %08x stsr %08x\n",
device_xname(sc->sc_dev), bits, test0, stsr);
}
if ((bits & ATW_NAR_SR) != 0 && (stsr & ATW_INTR_RPS) == 0 &&
(test0 & ATW_TEST0_RS_MASK) != ATW_TEST0_RS_STOPPED) {
DPRINTF2(sc, ("%s: receive process not idle [%s]\n",
device_xname(sc->sc_dev),
atw_rx_state[__SHIFTOUT(test0, ATW_TEST0_RS_MASK)]));
DPRINTF2(sc, ("%s: bits %08x test0 %08x stsr %08x\n",
device_xname(sc->sc_dev), bits, test0, stsr));
}
out:
if ((bits & ATW_NAR_ST) != 0)
atw_txdrain(sc);
splx(s);
return;
}
void
atw_linkintr(struct atw_softc *sc, uint32_t linkstatus)
{
struct ieee80211com *ic = &sc->sc_ic;
if (ic->ic_state != IEEE80211_S_RUN)
return;
if (linkstatus & ATW_INTR_LINKON) {
DPRINTF(sc, ("%s: link on\n", device_xname(sc->sc_dev)));
sc->sc_rescan_timer = 0;
} else if (linkstatus & ATW_INTR_LINKOFF) {
DPRINTF(sc, ("%s: link off\n", device_xname(sc->sc_dev)));
if (ic->ic_opmode != IEEE80211_M_STA)
return;
sc->sc_rescan_timer = 3;
sc->sc_if.if_timer = 1;
}
}
#if 0
static inline int
atw_hw_decrypted(struct atw_softc *sc, struct ieee80211_frame_min *wh)
{
if ((sc->sc_ic.ic_flags & IEEE80211_F_PRIVACY) == 0)
return 0;
if ((wh->i_fc[1] & IEEE80211_FC1_WEP) == 0)
return 0;
return (sc->sc_wepctl & ATW_WEPCTL_WEPRXBYP) == 0;
}
#endif
void
atw_rxintr(struct atw_softc *sc)
{
static int rate_tbl[] = {2, 4, 11, 22, 44};
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_node *ni;
struct ieee80211_frame_min *wh;
struct ifnet *ifp = &sc->sc_if;
struct atw_rxsoft *rxs;
struct mbuf *m;
uint32_t rxstat;
int i, s, len, rate, rate0;
uint32_t rssi, ctlrssi;
for (i = sc->sc_rxptr;; i = sc->sc_rxptr) {
rxs = &sc->sc_rxsoft[i];
ATW_CDRXSYNC(sc, i,
BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
rxstat = le32toh(sc->sc_rxdescs[i].ar_stat);
ctlrssi = le32toh(sc->sc_rxdescs[i].ar_ctlrssi);
rate0 = __SHIFTOUT(rxstat, ATW_RXSTAT_RXDR_MASK);
if (rxstat & ATW_RXSTAT_OWN) {
ATW_CDRXSYNC(sc, i, BUS_DMASYNC_PREREAD);
break;
}
sc->sc_rxptr = ATW_NEXTRX(i);
DPRINTF3(sc,
("%s: rx stat %08x ctlrssi %08x buf1 %08x buf2 %08x\n",
device_xname(sc->sc_dev),
rxstat, ctlrssi,
le32toh(sc->sc_rxdescs[i].ar_buf1),
le32toh(sc->sc_rxdescs[i].ar_buf2)));
if ((rxstat & (ATW_RXSTAT_FS | ATW_RXSTAT_LS)) !=
(ATW_RXSTAT_FS | ATW_RXSTAT_LS)) {
printf("%s: incoming packet spilled, resetting\n",
device_xname(sc->sc_dev));
(void)atw_init(ifp);
return;
}
if ((rxstat & (ATW_RXSTAT_DE | ATW_RXSTAT_RXTOE)) != 0) {
#define PRINTERR(bit, str) \
if (rxstat & (bit)) \
aprint_error_dev(sc->sc_dev, "receive error: %s\n", \
str)
if_statinc(ifp, if_ierrors);
PRINTERR(ATW_RXSTAT_DE, "descriptor error");
PRINTERR(ATW_RXSTAT_RXTOE, "time-out");
#if 0
PRINTERR(ATW_RXSTAT_SFDE, "PLCP SFD error");
PRINTERR(ATW_RXSTAT_SIGE, "PLCP signal error");
PRINTERR(ATW_RXSTAT_CRC16E, "PLCP CRC16 error");
PRINTERR(ATW_RXSTAT_ICVE, "WEP ICV error");
#endif
#undef PRINTERR
atw_init_rxdesc(sc, i);
continue;
}
bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_POSTREAD);
len = __SHIFTOUT(rxstat, ATW_RXSTAT_FL_MASK);
m = rxs->rxs_mbuf;
if (atw_add_rxbuf(sc, i) != 0) {
if_statinc(ifp, if_ierrors);
bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_PREREAD);
atw_init_rxdesc(sc, i);
continue;
}
if_statinc(ifp, if_ipackets);
m_set_rcvif(m, ifp);
m->m_pkthdr.len = m->m_len = MIN(m->m_ext.ext_size, len);
rate = (rate0 < __arraycount(rate_tbl)) ? rate_tbl[rate0] : 0;
if (sc->sc_bbptype == ATW_BBPTYPE_RFMD)
rssi = ctlrssi & RF3000_RSSI_MASK;
else
rssi = ctlrssi;
s = splnet();
if (sc->sc_radiobpf != NULL) {
struct atw_rx_radiotap_header *tap = &sc->sc_rxtap;
tap->ar_rate = rate;
tap->ar_antsignal = (int)rssi;
if (sc->sc_opmode & ATW_NAR_PR)
tap->ar_flags = IEEE80211_RADIOTAP_F_FCS;
else
tap->ar_flags = 0;
if ((rxstat & ATW_RXSTAT_CRC32E) != 0)
tap->ar_flags |= IEEE80211_RADIOTAP_F_BADFCS;
bpf_mtap2(sc->sc_radiobpf, tap, sizeof(sc->sc_rxtapu),
m, BPF_D_IN);
}
sc->sc_recv_ev.ev_count++;
if ((rxstat & (ATW_RXSTAT_CRC16E | ATW_RXSTAT_CRC32E |
ATW_RXSTAT_ICVE | ATW_RXSTAT_SFDE | ATW_RXSTAT_SIGE))
!= 0) {
if (rxstat & ATW_RXSTAT_CRC16E)
sc->sc_crc16e_ev.ev_count++;
if (rxstat & ATW_RXSTAT_CRC32E)
sc->sc_crc32e_ev.ev_count++;
if (rxstat & ATW_RXSTAT_ICVE)
sc->sc_icve_ev.ev_count++;
if (rxstat & ATW_RXSTAT_SFDE)
sc->sc_sfde_ev.ev_count++;
if (rxstat & ATW_RXSTAT_SIGE)
sc->sc_sige_ev.ev_count++;
if_statinc(ifp, if_ierrors);
m_freem(m);
splx(s);
continue;
}
if (sc->sc_opmode & ATW_NAR_PR)
m_adj(m, -IEEE80211_CRC_LEN);
wh = mtod(m, struct ieee80211_frame_min *);
ni = ieee80211_find_rxnode(ic, wh);
#if 0
if (atw_hw_decrypted(sc, wh)) {
wh->i_fc[1] &= ~IEEE80211_FC1_WEP;
DPRINTF(sc, ("%s: hw decrypted\n", __func__));
}
#endif
ieee80211_input(ic, m, ni, (int)rssi, 0);
ieee80211_free_node(ni);
splx(s);
}
}
void
atw_txintr(struct atw_softc *sc, uint32_t status)
{
static char txstat_buf[sizeof("ffffffff<>" ATW_TXSTAT_FMT)];
struct ifnet *ifp = &sc->sc_if;
struct atw_txsoft *txs;
uint32_t txstat;
int s;
DPRINTF3(sc, ("%s: atw_txintr: sc_flags 0x%08x\n",
device_xname(sc->sc_dev), sc->sc_flags));
s = splnet();
while ((txs = SIMPLEQ_FIRST(&sc->sc_txdirtyq)) != NULL) {
ATW_CDTXSYNC(sc, txs->txs_lastdesc, 1,
BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
#ifdef ATW_DEBUG
if ((ifp->if_flags & IFF_DEBUG) != 0 && atw_debug > 2) {
int i;
printf(" txsoft %p transmit chain:\n", txs);
ATW_CDTXSYNC(sc, txs->txs_firstdesc,
txs->txs_ndescs - 1,
BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
for (i = txs->txs_firstdesc;; i = ATW_NEXTTX(i)) {
printf(" descriptor %d:\n", i);
printf(" at_status: 0x%08x\n",
le32toh(sc->sc_txdescs[i].at_stat));
printf(" at_flags: 0x%08x\n",
le32toh(sc->sc_txdescs[i].at_flags));
printf(" at_buf1: 0x%08x\n",
le32toh(sc->sc_txdescs[i].at_buf1));
printf(" at_buf2: 0x%08x\n",
le32toh(sc->sc_txdescs[i].at_buf2));
if (i == txs->txs_lastdesc)
break;
}
ATW_CDTXSYNC(sc, txs->txs_firstdesc,
txs->txs_ndescs - 1, BUS_DMASYNC_PREREAD);
}
#endif
txstat = le32toh(sc->sc_txdescs[txs->txs_lastdesc].at_stat);
if (txstat & ATW_TXSTAT_OWN) {
ATW_CDTXSYNC(sc, txs->txs_lastdesc, 1,
BUS_DMASYNC_PREREAD);
break;
}
SIMPLEQ_REMOVE_HEAD(&sc->sc_txdirtyq, txs_q);
bus_dmamap_sync(sc->sc_dmat, txs->txs_dmamap,
0, txs->txs_dmamap->dm_mapsize,
BUS_DMASYNC_POSTWRITE);
bus_dmamap_unload(sc->sc_dmat, txs->txs_dmamap);
m_freem(txs->txs_mbuf);
txs->txs_mbuf = NULL;
sc->sc_txfree += txs->txs_ndescs;
SIMPLEQ_INSERT_TAIL(&sc->sc_txfreeq, txs, txs_q);
KASSERT(!SIMPLEQ_EMPTY(&sc->sc_txfreeq) && sc->sc_txfree != 0);
sc->sc_tx_timer = 0;
ifp->if_flags &= ~IFF_OACTIVE;
if ((ifp->if_flags & IFF_DEBUG) != 0 &&
(txstat & ATW_TXSTAT_ERRMASK) != 0) {
snprintb(txstat_buf, sizeof(txstat_buf),
ATW_TXSTAT_FMT, txstat & ATW_TXSTAT_ERRMASK);
printf("%s: txstat %s %" __PRIuBITS "\n",
device_xname(sc->sc_dev), txstat_buf,
__SHIFTOUT(txstat, ATW_TXSTAT_ARC_MASK));
}
sc->sc_xmit_ev.ev_count++;
if (txstat & ATW_TXSTAT_TUF)
sc->sc_tuf_ev.ev_count++;
if (txstat & ATW_TXSTAT_TLT)
sc->sc_tlt_ev.ev_count++;
if (txstat & ATW_TXSTAT_TRT)
sc->sc_trt_ev.ev_count++;
if (txstat & ATW_TXSTAT_TRO)
sc->sc_tro_ev.ev_count++;
if (txstat & ATW_TXSTAT_SOFBR)
sc->sc_sofbr_ev.ev_count++;
if ((txstat & ATW_TXSTAT_ES) == 0)
if_statadd(ifp, if_collisions,
__SHIFTOUT(txstat, ATW_TXSTAT_ARC_MASK));
else
if_statinc(ifp, if_oerrors);
if_statinc(ifp, if_opackets);
}
KASSERT(txs != NULL || (ifp->if_flags & IFF_OACTIVE) == 0);
splx(s);
}
void
atw_watchdog(struct ifnet *ifp)
{
struct atw_softc *sc = ifp->if_softc;
struct ieee80211com *ic = &sc->sc_ic;
ifp->if_timer = 0;
if (!device_is_active(sc->sc_dev))
return;
if (sc->sc_rescan_timer != 0 && --sc->sc_rescan_timer == 0)
(void)ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
if (sc->sc_tx_timer != 0 && --sc->sc_tx_timer == 0 &&
!SIMPLEQ_EMPTY(&sc->sc_txdirtyq)) {
printf("%s: transmit timeout\n", ifp->if_xname);
if_statinc(ifp, if_oerrors);
(void)atw_init(ifp);
atw_start(ifp);
}
if (sc->sc_tx_timer != 0 || sc->sc_rescan_timer != 0)
ifp->if_timer = 1;
ieee80211_watchdog(ic);
}
static void
atw_evcnt_detach(struct atw_softc *sc)
{
evcnt_detach(&sc->sc_sige_ev);
evcnt_detach(&sc->sc_sfde_ev);
evcnt_detach(&sc->sc_icve_ev);
evcnt_detach(&sc->sc_crc32e_ev);
evcnt_detach(&sc->sc_crc16e_ev);
evcnt_detach(&sc->sc_recv_ev);
evcnt_detach(&sc->sc_tuf_ev);
evcnt_detach(&sc->sc_tro_ev);
evcnt_detach(&sc->sc_trt_ev);
evcnt_detach(&sc->sc_tlt_ev);
evcnt_detach(&sc->sc_sofbr_ev);
evcnt_detach(&sc->sc_xmit_ev);
evcnt_detach(&sc->sc_rxpkt1in_ev);
evcnt_detach(&sc->sc_rxamatch_ev);
evcnt_detach(&sc->sc_workaround1_ev);
evcnt_detach(&sc->sc_misc_ev);
}
static void
atw_evcnt_attach(struct atw_softc *sc)
{
evcnt_attach_dynamic(&sc->sc_recv_ev, EVCNT_TYPE_MISC,
NULL, sc->sc_if.if_xname, "recv");
evcnt_attach_dynamic(&sc->sc_crc16e_ev, EVCNT_TYPE_MISC,
&sc->sc_recv_ev, sc->sc_if.if_xname, "CRC16 error");
evcnt_attach_dynamic(&sc->sc_crc32e_ev, EVCNT_TYPE_MISC,
&sc->sc_recv_ev, sc->sc_if.if_xname, "CRC32 error");
evcnt_attach_dynamic(&sc->sc_icve_ev, EVCNT_TYPE_MISC,
&sc->sc_recv_ev, sc->sc_if.if_xname, "ICV error");
evcnt_attach_dynamic(&sc->sc_sfde_ev, EVCNT_TYPE_MISC,
&sc->sc_recv_ev, sc->sc_if.if_xname, "PLCP SFD error");
evcnt_attach_dynamic(&sc->sc_sige_ev, EVCNT_TYPE_MISC,
&sc->sc_recv_ev, sc->sc_if.if_xname, "PLCP Signal Field error");
evcnt_attach_dynamic(&sc->sc_xmit_ev, EVCNT_TYPE_MISC,
NULL, sc->sc_if.if_xname, "xmit");
evcnt_attach_dynamic(&sc->sc_tuf_ev, EVCNT_TYPE_MISC,
&sc->sc_xmit_ev, sc->sc_if.if_xname, "transmit underflow");
evcnt_attach_dynamic(&sc->sc_tro_ev, EVCNT_TYPE_MISC,
&sc->sc_xmit_ev, sc->sc_if.if_xname, "transmit overrun");
evcnt_attach_dynamic(&sc->sc_trt_ev, EVCNT_TYPE_MISC,
&sc->sc_xmit_ev, sc->sc_if.if_xname, "retry count exceeded");
evcnt_attach_dynamic(&sc->sc_tlt_ev, EVCNT_TYPE_MISC,
&sc->sc_xmit_ev, sc->sc_if.if_xname, "lifetime exceeded");
evcnt_attach_dynamic(&sc->sc_sofbr_ev, EVCNT_TYPE_MISC,
&sc->sc_xmit_ev, sc->sc_if.if_xname, "packet size mismatch");
evcnt_attach_dynamic(&sc->sc_misc_ev, EVCNT_TYPE_MISC,
NULL, sc->sc_if.if_xname, "misc");
evcnt_attach_dynamic(&sc->sc_workaround1_ev, EVCNT_TYPE_MISC,
&sc->sc_misc_ev, sc->sc_if.if_xname, "workaround #1");
evcnt_attach_dynamic(&sc->sc_rxamatch_ev, EVCNT_TYPE_MISC,
&sc->sc_misc_ev, sc->sc_if.if_xname, "rra equals rwa");
evcnt_attach_dynamic(&sc->sc_rxpkt1in_ev, EVCNT_TYPE_MISC,
&sc->sc_misc_ev, sc->sc_if.if_xname, "rxpkt1in set");
}
#ifdef ATW_DEBUG
static void
atw_dump_pkt(struct ifnet *ifp, struct mbuf *m0)
{
struct atw_softc *sc = ifp->if_softc;
struct mbuf *m;
int i, noctets = 0;
printf("%s: %d-byte packet\n", device_xname(sc->sc_dev),
m0->m_pkthdr.len);
for (m = m0; m; m = m->m_next) {
if (m->m_len == 0)
continue;
for (i = 0; i < m->m_len; i++) {
printf(" %02x", ((uint8_t*)m->m_data)[i]);
if (++noctets % 24 == 0)
printf("\n");
}
}
printf("%s%s: %d bytes emitted\n",
(noctets % 24 != 0) ? "\n" : "", device_xname(sc->sc_dev), noctets);
}
#endif
void
atw_start(struct ifnet *ifp)
{
struct atw_softc *sc = ifp->if_softc;
struct ieee80211_key *k;
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_node *ni;
struct ieee80211_frame_min *whm;
struct ieee80211_frame *wh;
struct atw_frame *hh;
uint16_t hdrctl;
struct mbuf *m0, *m;
struct atw_txsoft *txs;
struct atw_txdesc *txd;
int npkt, rate;
bus_dmamap_t dmamap;
int ctl, error, firsttx, nexttx, lasttx, first, ofree, seg;
DPRINTF2(sc, ("%s: atw_start: sc_flags 0x%08x, if_flags 0x%08x\n",
device_xname(sc->sc_dev), sc->sc_flags, ifp->if_flags));
if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)
return;
ofree = sc->sc_txfree;
firsttx = lasttx = sc->sc_txnext;
DPRINTF2(sc, ("%s: atw_start: txfree %d, txnext %d\n",
device_xname(sc->sc_dev), ofree, firsttx));
while ((txs = SIMPLEQ_FIRST(&sc->sc_txfreeq)) != NULL &&
sc->sc_txfree != 0) {
hdrctl = htole16(ATW_HDRCTL_UNKNOWN1);
IF_DEQUEUE(&ic->ic_mgtq, m0);
if (m0 != NULL) {
ni = M_GETCTX(m0, struct ieee80211_node *);
M_CLEARCTX(m0);
} else if (ic->ic_state != IEEE80211_S_RUN)
break;
else {
IFQ_DEQUEUE(&ifp->if_snd, m0);
if (m0 == NULL)
break;
bpf_mtap(ifp, m0, BPF_D_OUT);
ni = ieee80211_find_txnode(ic,
mtod(m0, struct ether_header *)->ether_dhost);
if (ni == NULL) {
if_statinc(ifp, if_oerrors);
break;
}
if ((m0 = ieee80211_encap(ic, m0, ni)) == NULL) {
ieee80211_free_node(ni);
if_statinc(ifp, if_oerrors);
break;
}
}
rate = MAX(ieee80211_get_rate(ni), 2);
whm = mtod(m0, struct ieee80211_frame_min *);
if ((whm->i_fc[1] & IEEE80211_FC1_WEP) == 0)
k = NULL;
else if ((k = ieee80211_crypto_encap(ic, ni, m0)) == NULL) {
m_freem(m0);
ieee80211_free_node(ni);
if_statinc(ifp, if_oerrors);
break;
}
#if 0
if (IEEE80211_IS_MULTICAST(wh->i_addr1) &&
m0->m_pkthdr.len > ic->ic_fragthreshold)
hdrctl |= htole16(ATW_HDRCTL_MORE_FRAG);
#endif
if (m0->m_pkthdr.len + IEEE80211_CRC_LEN >= ic->ic_rtsthreshold)
hdrctl |= htole16(ATW_HDRCTL_RTSCTS);
if (ieee80211_compute_duration(whm, k, m0->m_pkthdr.len,
ic->ic_flags, ic->ic_fragthreshold, rate,
&txs->txs_d0, &txs->txs_dn, &npkt, 0) == -1) {
DPRINTF2(sc, ("%s: fail compute duration\n", __func__));
m_freem(m0);
break;
}
*(uint16_t *)whm->i_dur = htole16(txs->txs_d0.d_rts_dur);
bpf_mtap3(ic->ic_rawbpf, m0, BPF_D_OUT);
if (sc->sc_radiobpf != NULL) {
struct atw_tx_radiotap_header *tap = &sc->sc_txtap;
tap->at_rate = rate;
bpf_mtap2(sc->sc_radiobpf, tap, sizeof(sc->sc_txtapu),
m0, BPF_D_OUT);
}
M_PREPEND(m0, offsetof(struct atw_frame, atw_ihdr), M_DONTWAIT);
if (ni != NULL)
ieee80211_free_node(ni);
if (m0 == NULL) {
if_statinc(ifp, if_oerrors);
break;
}
m0 = m_pullup(m0, sizeof(struct atw_frame));
if (m0 == NULL) {
if_statinc(ifp, if_oerrors);
break;
}
hh = mtod(m0, struct atw_frame *);
wh = &hh->atw_ihdr;
if (wh->i_fc[1] & IEEE80211_FC1_DIR_TODS) {
if (wh->i_fc[1] & IEEE80211_FC1_DIR_FROMDS)
panic("%s: illegal WDS frame",
device_xname(sc->sc_dev));
memcpy(hh->atw_dst, wh->i_addr3, IEEE80211_ADDR_LEN);
} else
memcpy(hh->atw_dst, wh->i_addr1, IEEE80211_ADDR_LEN);
*(uint16_t*)hh->atw_fc = *(uint16_t*)wh->i_fc;
memset(&hh->u, 0, sizeof(hh->u));
hh->atw_rate = rate * 5;
hh->atw_service = 0x00;
hh->atw_paylen = htole16(m0->m_pkthdr.len -
sizeof(struct atw_frame));
if (IEEE80211_IS_MULTICAST(hh->atw_dst))
hh->atw_fragthr = htole16(IEEE80211_FRAG_MAX);
else {
if ((ic->ic_flags & IEEE80211_F_SHPREAMBLE) &&
(ni->ni_capinfo & IEEE80211_CAPINFO_SHORT_PREAMBLE))
hdrctl |= htole16(ATW_HDRCTL_SHORT_PREAMBLE);
hh->atw_fragthr = htole16(ic->ic_fragthreshold);
}
hh->atw_rtylmt = 3;
#if 0
if (do_encrypt) {
hdrctl |= htole16(ATW_HDRCTL_WEP);
hh->atw_keyid = ic->ic_def_txkey;
}
#endif
hh->atw_head_plcplen = htole16(txs->txs_d0.d_plcp_len);
hh->atw_tail_plcplen = htole16(txs->txs_dn.d_plcp_len);
if (txs->txs_d0.d_residue)
hh->atw_head_plcplen |= htole16(0x8000);
if (txs->txs_dn.d_residue)
hh->atw_tail_plcplen |= htole16(0x8000);
hh->atw_head_dur = htole16(txs->txs_d0.d_rts_dur);
hh->atw_tail_dur = htole16(txs->txs_dn.d_rts_dur);
hh->atw_hdrctl = hdrctl;
hh->atw_fragnum = npkt << 4;
#ifdef ATW_DEBUG
if ((ifp->if_flags & IFF_DEBUG) != 0 && atw_debug > 2) {
printf("%s: dst = %s, rate = 0x%02x, "
"service = 0x%02x, paylen = 0x%04x\n",
device_xname(sc->sc_dev), ether_sprintf(hh->atw_dst),
hh->atw_rate, hh->atw_service, hh->atw_paylen);
printf("%s: fc[0] = 0x%02x, fc[1] = 0x%02x, "
"dur1 = 0x%04x, dur2 = 0x%04x, "
"dur3 = 0x%04x, rts_dur = 0x%04x\n",
device_xname(sc->sc_dev), hh->atw_fc[0], hh->atw_fc[1],
hh->atw_tail_plcplen, hh->atw_head_plcplen,
hh->atw_tail_dur, hh->atw_head_dur);
printf("%s: hdrctl = 0x%04x, fragthr = 0x%04x, "
"fragnum = 0x%02x, rtylmt = 0x%04x\n",
device_xname(sc->sc_dev), hh->atw_hdrctl,
hh->atw_fragthr, hh->atw_fragnum, hh->atw_rtylmt);
printf("%s: keyid = %d\n",
device_xname(sc->sc_dev), hh->atw_keyid);
atw_dump_pkt(ifp, m0);
}
#endif
dmamap = txs->txs_dmamap;
for (first = 1;
(error = bus_dmamap_load_mbuf(sc->sc_dmat, dmamap, m0,
BUS_DMA_WRITE | BUS_DMA_NOWAIT)) != 0 && first;
first = 0) {
MGETHDR(m, M_DONTWAIT, MT_DATA);
if (m == NULL) {
aprint_error_dev(sc->sc_dev, "unable to allocate Tx mbuf\n");
break;
}
if (m0->m_pkthdr.len > MHLEN) {
MCLGET(m, M_DONTWAIT);
if ((m->m_flags & M_EXT) == 0) {
aprint_error_dev(sc->sc_dev, "unable to allocate Tx "
"cluster\n");
m_freem(m);
break;
}
}
m_copydata(m0, 0, m0->m_pkthdr.len, mtod(m, void *));
m->m_pkthdr.len = m->m_len = m0->m_pkthdr.len;
m_freem(m0);
m0 = m;
m = NULL;
}
if (error != 0) {
aprint_error_dev(sc->sc_dev, "unable to load Tx buffer, "
"error = %d\n", error);
m_freem(m0);
break;
}
if (dmamap->dm_nsegs > sc->sc_txfree) {
bus_dmamap_unload(sc->sc_dmat, dmamap);
m_freem(m0);
break;
}
bus_dmamap_sync(sc->sc_dmat, dmamap, 0, dmamap->dm_mapsize,
BUS_DMASYNC_PREWRITE);
ctl = htole32(__SHIFTIN(8, ATW_TXCTL_TL_MASK));
DPRINTF2(sc, ("%s: TXDR <- max(10, %d)\n",
device_xname(sc->sc_dev), rate * 5));
ctl |= htole32(__SHIFTIN(MAX(10, rate * 5), ATW_TXCTL_TXDR_MASK));
for (nexttx = sc->sc_txnext, seg = 0;
seg < dmamap->dm_nsegs;
seg++, nexttx = ATW_NEXTTX(nexttx)) {
txd = &sc->sc_txdescs[nexttx];
txd->at_ctl = ctl |
((nexttx == firsttx) ? 0 : htole32(ATW_TXCTL_OWN));
txd->at_buf1 = htole32(dmamap->dm_segs[seg].ds_addr);
txd->at_flags =
htole32(__SHIFTIN(dmamap->dm_segs[seg].ds_len,
ATW_TXFLAG_TBS1_MASK)) |
((nexttx == (ATW_NTXDESC - 1))
? htole32(ATW_TXFLAG_TER) : 0);
lasttx = nexttx;
}
sc->sc_txdescs[sc->sc_txnext].at_flags |=
htole32(ATW_TXFLAG_FS);
sc->sc_txdescs[lasttx].at_flags |= htole32(ATW_TXFLAG_LS);
#ifdef ATW_DEBUG
if ((ifp->if_flags & IFF_DEBUG) != 0 && atw_debug > 2) {
printf(" txsoft %p transmit chain:\n", txs);
for (seg = sc->sc_txnext;; seg = ATW_NEXTTX(seg)) {
printf(" descriptor %d:\n", seg);
printf(" at_ctl: 0x%08x\n",
le32toh(sc->sc_txdescs[seg].at_ctl));
printf(" at_flags: 0x%08x\n",
le32toh(sc->sc_txdescs[seg].at_flags));
printf(" at_buf1: 0x%08x\n",
le32toh(sc->sc_txdescs[seg].at_buf1));
printf(" at_buf2: 0x%08x\n",
le32toh(sc->sc_txdescs[seg].at_buf2));
if (seg == lasttx)
break;
}
}
#endif
ATW_CDTXSYNC(sc, sc->sc_txnext, dmamap->dm_nsegs,
BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
txs->txs_mbuf = m0;
txs->txs_firstdesc = sc->sc_txnext;
txs->txs_lastdesc = lasttx;
txs->txs_ndescs = dmamap->dm_nsegs;
sc->sc_txfree -= dmamap->dm_nsegs;
sc->sc_txnext = nexttx;
SIMPLEQ_REMOVE_HEAD(&sc->sc_txfreeq, txs_q);
SIMPLEQ_INSERT_TAIL(&sc->sc_txdirtyq, txs, txs_q);
}
if (sc->sc_txfree != ofree) {
DPRINTF2(sc, ("%s: packets enqueued, IC on %d, OWN on %d\n",
device_xname(sc->sc_dev), lasttx, firsttx));
sc->sc_txdescs[lasttx].at_flags |= htole32(ATW_TXFLAG_IC);
ATW_CDTXSYNC(sc, lasttx, 1,
BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
sc->sc_txdescs[firsttx].at_ctl |= htole32(ATW_TXCTL_OWN);
ATW_CDTXSYNC(sc, firsttx, 1,
BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
ATW_WRITE(sc, ATW_TDR, 0x1);
if (txs == NULL || sc->sc_txfree == 0)
ifp->if_flags |= IFF_OACTIVE;
sc->sc_tx_timer = 5;
ifp->if_timer = 1;
}
}
int
atw_ioctl(struct ifnet *ifp, u_long cmd, void *data)
{
struct atw_softc *sc = ifp->if_softc;
struct ieee80211req *ireq;
int s, error = 0;
s = splnet();
switch (cmd) {
case SIOCSIFFLAGS:
if ((error = ifioctl_common(ifp, cmd, data)) != 0)
break;
switch (ifp->if_flags & (IFF_UP | IFF_RUNNING)) {
case IFF_UP | IFF_RUNNING:
if (device_activation(sc->sc_dev, DEVACT_LEVEL_DRIVER))
atw_filter_setup(sc);
break;
case IFF_UP:
error = atw_init(ifp);
break;
case IFF_RUNNING:
atw_stop(ifp, 1);
break;
case 0:
break;
}
break;
case SIOCADDMULTI:
case SIOCDELMULTI:
if ((error = ether_ioctl(ifp, cmd, data)) == ENETRESET) {
if (ifp->if_flags & IFF_RUNNING)
atw_filter_setup(sc);
error = 0;
}
break;
case SIOCS80211:
ireq = data;
if (ireq->i_type == IEEE80211_IOC_FRAGTHRESHOLD) {
if ((error = kauth_authorize_network(
kauth_cred_get(), KAUTH_NETWORK_INTERFACE,
KAUTH_REQ_NETWORK_INTERFACE_SETPRIV, ifp,
(void *)cmd, NULL)) != 0)
break;
if (!(IEEE80211_FRAG_MIN <= ireq->i_val &&
ireq->i_val <= IEEE80211_FRAG_MAX))
error = EINVAL;
else
sc->sc_ic.ic_fragthreshold = ireq->i_val;
break;
}
default:
error = ieee80211_ioctl(&sc->sc_ic, cmd, data);
if (error == ENETRESET || error == ERESTART) {
if (is_running(ifp))
error = atw_init(ifp);
else
error = 0;
}
break;
}
if (device_is_active(sc->sc_dev))
atw_start(ifp);
splx(s);
return (error);
}
static int
atw_media_change(struct ifnet *ifp)
{
int error;
error = ieee80211_media_change(ifp);
if (error == ENETRESET) {
if (is_running(ifp))
error = atw_init(ifp);
else
error = 0;
}
return error;
}