/*- * Copyright (c) 2012 Adrian Chadd * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer, * without modification. * 2. Redistributions in binary form must reproduce at minimum a disclaimer * similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any * redistribution must be conditioned upon including a substantially * similar Disclaimer requirement for further binary redistribution. * * NO WARRANTY * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF * THE POSSIBILITY OF SUCH DAMAGES. * * $FreeBSD$ */ #include "opt_ah.h" #include "opt_ath.h" #include #include #include #include #include #include #include #include #include #include #include #include #include #include #ifdef ATH_DEBUG_ALQ static struct ale * if_ath_alq_get(struct if_ath_alq *alq, int len) { struct ale *ale; if (alq->sc_alq_isactive == 0) return (NULL); ale = alq_getn(alq->sc_alq_alq, len, ALQ_NOWAIT); if (! ale) alq->sc_alq_numlost++; return (ale); } void if_ath_alq_init(struct if_ath_alq *alq, const char *devname) { bzero(alq, sizeof(*alq)); strncpy(alq->sc_alq_devname, devname, ATH_ALQ_DEVNAME_LEN); printf("%s (%s): attached\n", __func__, alq->sc_alq_devname); snprintf(alq->sc_alq_filename, ATH_ALQ_FILENAME_LEN, "/tmp/ath_%s_alq.log", alq->sc_alq_devname); /* XXX too conservative, right? */ alq->sc_alq_qsize = (64*1024); } void if_ath_alq_setcfg(struct if_ath_alq *alq, uint32_t macVer, uint32_t macRev, uint32_t phyRev, uint32_t halMagic) { /* Store these in network order */ alq->sc_alq_cfg.sc_mac_version = htobe32(macVer); alq->sc_alq_cfg.sc_mac_revision = htobe32(macRev); alq->sc_alq_cfg.sc_phy_rev = htobe32(phyRev); alq->sc_alq_cfg.sc_hal_magic = htobe32(halMagic); } void if_ath_alq_tidyup(struct if_ath_alq *alq) { if_ath_alq_stop(alq); printf("%s (%s): detached\n", __func__, alq->sc_alq_devname); bzero(alq, sizeof(*alq)); } int if_ath_alq_start(struct if_ath_alq *alq) { int error; if (alq->sc_alq_isactive) return (0); /* * Create a variable-length ALQ. */ error = alq_open(&alq->sc_alq_alq, alq->sc_alq_filename, curthread->td_ucred, ALQ_DEFAULT_CMODE, alq->sc_alq_qsize, 0); if (error != 0) { printf("%s (%s): failed, err=%d\n", __func__, alq->sc_alq_devname, error); } else { printf("%s (%s): opened\n", __func__, alq->sc_alq_devname); alq->sc_alq_isactive = 1; if_ath_alq_post(alq, ATH_ALQ_INIT_STATE, sizeof (struct if_ath_alq_init_state), (char *) &alq->sc_alq_cfg); } return (error); } int if_ath_alq_stop(struct if_ath_alq *alq) { if (alq->sc_alq_isactive == 0) return (0); printf("%s (%s): closed\n", __func__, alq->sc_alq_devname); alq->sc_alq_isactive = 0; alq_close(alq->sc_alq_alq); alq->sc_alq_alq = NULL; return (0); } /* * Post a debug message to the ALQ. * * "len" is the size of the buf payload in bytes. */ void if_ath_alq_post(struct if_ath_alq *alq, uint16_t op, uint16_t len, const char *buf) { struct if_ath_alq_hdr *ap; struct ale *ale; if (! if_ath_alq_checkdebug(alq, op)) return; /* * Enforce some semblence of sanity on 'len'. * Although strictly speaking, any length is possible - * just be conservative so things don't get out of hand. */ if (len > ATH_ALQ_PAYLOAD_LEN) len = ATH_ALQ_PAYLOAD_LEN; ale = if_ath_alq_get(alq, len + sizeof(struct if_ath_alq_hdr)); if (ale == NULL) return; ap = (struct if_ath_alq_hdr *) ale->ae_data; ap->threadid = htobe64((uint64_t) curthread->td_tid); ap->tstamp = htobe32((uint32_t) ticks); ap->op = htobe16(op); ap->len = htobe16(len); /* * Copy the payload _after_ the header field. */ memcpy(((char *) ap) + sizeof(struct if_ath_alq_hdr), buf, len); alq_post(alq->sc_alq_alq, ale); } #endif /* ATH_DEBUG */