1b2dce55fSHans Petter Selasky /*- 2b2dce55fSHans Petter Selasky * Copyright (c) 2011 Rick van der Zwet <info@rickvanderzwet.nl> 3b2dce55fSHans Petter Selasky * 4b2dce55fSHans Petter Selasky * Permission to use, copy, modify, and distribute this software for any 5b2dce55fSHans Petter Selasky * purpose with or without fee is hereby granted, provided that the above 6b2dce55fSHans Petter Selasky * copyright notice and this permission notice appear in all copies. 7b2dce55fSHans Petter Selasky * 8b2dce55fSHans Petter Selasky * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 9b2dce55fSHans Petter Selasky * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 10b2dce55fSHans Petter Selasky * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 11b2dce55fSHans Petter Selasky * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 12b2dce55fSHans Petter Selasky * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 13b2dce55fSHans Petter Selasky * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 14b2dce55fSHans Petter Selasky * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 15b2dce55fSHans Petter Selasky */ 16b2dce55fSHans Petter Selasky 17b2dce55fSHans Petter Selasky /*- 18b2dce55fSHans Petter Selasky * Copyright (c) 2008 Johann Christian Rode <jcrode@gmx.net> 19b2dce55fSHans Petter Selasky * 20b2dce55fSHans Petter Selasky * Permission to use, copy, modify, and distribute this software for any 21b2dce55fSHans Petter Selasky * purpose with or without fee is hereby granted, provided that the above 22b2dce55fSHans Petter Selasky * copyright notice and this permission notice appear in all copies. 23b2dce55fSHans Petter Selasky * 24b2dce55fSHans Petter Selasky * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 25b2dce55fSHans Petter Selasky * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 26b2dce55fSHans Petter Selasky * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 27b2dce55fSHans Petter Selasky * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 28b2dce55fSHans Petter Selasky * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 29b2dce55fSHans Petter Selasky * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 30b2dce55fSHans Petter Selasky * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 31b2dce55fSHans Petter Selasky */ 32b2dce55fSHans Petter Selasky 33b2dce55fSHans Petter Selasky /*- 34b2dce55fSHans Petter Selasky * Copyright (c) 2005, 2006, 2007 Jonathan Gray <jsg@openbsd.org> 35b2dce55fSHans Petter Selasky * 36b2dce55fSHans Petter Selasky * Permission to use, copy, modify, and distribute this software for any 37b2dce55fSHans Petter Selasky * purpose with or without fee is hereby granted, provided that the above 38b2dce55fSHans Petter Selasky * copyright notice and this permission notice appear in all copies. 39b2dce55fSHans Petter Selasky * 40b2dce55fSHans Petter Selasky * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 41b2dce55fSHans Petter Selasky * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 42b2dce55fSHans Petter Selasky * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 43b2dce55fSHans Petter Selasky * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 44b2dce55fSHans Petter Selasky * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 45b2dce55fSHans Petter Selasky * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 46b2dce55fSHans Petter Selasky * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 47b2dce55fSHans Petter Selasky */ 48b2dce55fSHans Petter Selasky 49b2dce55fSHans Petter Selasky /*- 50b2dce55fSHans Petter Selasky * Copyright (c) 1997, 1998, 1999, 2000-2003 51b2dce55fSHans Petter Selasky * Bill Paul <wpaul@windriver.com>. All rights reserved. 52b2dce55fSHans Petter Selasky * 53b2dce55fSHans Petter Selasky * Redistribution and use in source and binary forms, with or without 54b2dce55fSHans Petter Selasky * modification, are permitted provided that the following conditions 55b2dce55fSHans Petter Selasky * are met: 56b2dce55fSHans Petter Selasky * 1. Redistributions of source code must retain the above copyright 57b2dce55fSHans Petter Selasky * notice, this list of conditions and the following disclaimer. 58b2dce55fSHans Petter Selasky * 2. Redistributions in binary form must reproduce the above copyright 59b2dce55fSHans Petter Selasky * notice, this list of conditions and the following disclaimer in the 60b2dce55fSHans Petter Selasky * documentation and/or other materials provided with the distribution. 61b2dce55fSHans Petter Selasky * 3. All advertising materials mentioning features or use of this software 62b2dce55fSHans Petter Selasky * must display the following acknowledgement: 63b2dce55fSHans Petter Selasky * This product includes software developed by Bill Paul. 64b2dce55fSHans Petter Selasky * 4. Neither the name of the author nor the names of any co-contributors 65b2dce55fSHans Petter Selasky * may be used to endorse or promote products derived from this software 66b2dce55fSHans Petter Selasky * without specific prior written permission. 67b2dce55fSHans Petter Selasky * 68b2dce55fSHans Petter Selasky * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND 69b2dce55fSHans Petter Selasky * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 70b2dce55fSHans Petter Selasky * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 71b2dce55fSHans Petter Selasky * ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD 72b2dce55fSHans Petter Selasky * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 73b2dce55fSHans Petter Selasky * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 74b2dce55fSHans Petter Selasky * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 75b2dce55fSHans Petter Selasky * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 76b2dce55fSHans Petter Selasky * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 77b2dce55fSHans Petter Selasky * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF 78b2dce55fSHans Petter Selasky * THE POSSIBILITY OF SUCH DAMAGE. 79b2dce55fSHans Petter Selasky */ 80b2dce55fSHans Petter Selasky 81b2dce55fSHans Petter Selasky #include <sys/cdefs.h> 82b2dce55fSHans Petter Selasky __FBSDID("$FreeBSD$"); 83b2dce55fSHans Petter Selasky 84b2dce55fSHans Petter Selasky /* 85d4d6dcc5SKevin Lo * Moschip MCS7730/MCS7830/MCS7832 USB to Ethernet controller 86b2dce55fSHans Petter Selasky * The datasheet is available at the following URL: 87b2dce55fSHans Petter Selasky * http://www.moschip.com/data/products/MCS7830/Data%20Sheet_7830.pdf 88b2dce55fSHans Petter Selasky */ 89b2dce55fSHans Petter Selasky 90b2dce55fSHans Petter Selasky /* 91b2dce55fSHans Petter Selasky * The FreeBSD if_mos.c driver is based on various different sources: 92b2dce55fSHans Petter Selasky * The vendor provided driver at the following URL: 93b2dce55fSHans Petter Selasky * http://www.moschip.com/data/products/MCS7830/Driver_FreeBSD_7830.tar.gz 94b2dce55fSHans Petter Selasky * 95b2dce55fSHans Petter Selasky * Mixed together with the OpenBSD if_mos.c driver for validation and checking 96b2dce55fSHans Petter Selasky * and the FreeBSD if_reu.c as reference for the USB Ethernet framework. 97b2dce55fSHans Petter Selasky */ 98b2dce55fSHans Petter Selasky 99b2dce55fSHans Petter Selasky #include <sys/stdint.h> 100b2dce55fSHans Petter Selasky #include <sys/stddef.h> 101b2dce55fSHans Petter Selasky #include <sys/param.h> 102b2dce55fSHans Petter Selasky #include <sys/queue.h> 103b2dce55fSHans Petter Selasky #include <sys/types.h> 104b2dce55fSHans Petter Selasky #include <sys/systm.h> 10576039bc8SGleb Smirnoff #include <sys/socket.h> 106b2dce55fSHans Petter Selasky #include <sys/kernel.h> 107b2dce55fSHans Petter Selasky #include <sys/bus.h> 108b2dce55fSHans Petter Selasky #include <sys/module.h> 109b2dce55fSHans Petter Selasky #include <sys/lock.h> 110b2dce55fSHans Petter Selasky #include <sys/mutex.h> 111b2dce55fSHans Petter Selasky #include <sys/condvar.h> 112b2dce55fSHans Petter Selasky #include <sys/sysctl.h> 113b2dce55fSHans Petter Selasky #include <sys/sx.h> 114b2dce55fSHans Petter Selasky #include <sys/unistd.h> 115b2dce55fSHans Petter Selasky #include <sys/callout.h> 116b2dce55fSHans Petter Selasky #include <sys/malloc.h> 117b2dce55fSHans Petter Selasky #include <sys/priv.h> 118b2dce55fSHans Petter Selasky 11976039bc8SGleb Smirnoff #include <net/if.h> 12076039bc8SGleb Smirnoff #include <net/if_var.h> 12176039bc8SGleb Smirnoff 122b2dce55fSHans Petter Selasky #include <dev/usb/usb.h> 123b2dce55fSHans Petter Selasky #include <dev/usb/usbdi.h> 124b2dce55fSHans Petter Selasky #include <dev/usb/usbdi_util.h> 125b2dce55fSHans Petter Selasky #include "usbdevs.h" 126b2dce55fSHans Petter Selasky 127b2dce55fSHans Petter Selasky #define USB_DEBUG_VAR mos_debug 128b2dce55fSHans Petter Selasky #include <dev/usb/usb_debug.h> 129b2dce55fSHans Petter Selasky #include <dev/usb/usb_process.h> 130b2dce55fSHans Petter Selasky 131b2dce55fSHans Petter Selasky #include <dev/usb/net/usb_ethernet.h> 132b2dce55fSHans Petter Selasky 133b2dce55fSHans Petter Selasky //#include <dev/usb/net/if_mosreg.h> 134b2dce55fSHans Petter Selasky #include "if_mosreg.h" 135b2dce55fSHans Petter Selasky 136b2dce55fSHans Petter Selasky #ifdef USB_DEBUG 137b2dce55fSHans Petter Selasky static int mos_debug = 0; 138b2dce55fSHans Petter Selasky 1396472ac3dSEd Schouten static SYSCTL_NODE(_hw_usb, OID_AUTO, mos, CTLFLAG_RW, 0, "USB mos"); 140ece4b0bdSHans Petter Selasky SYSCTL_INT(_hw_usb_mos, OID_AUTO, debug, CTLFLAG_RWTUN, &mos_debug, 0, 141b2dce55fSHans Petter Selasky "Debug level"); 142b2dce55fSHans Petter Selasky #endif 143b2dce55fSHans Petter Selasky 144b2dce55fSHans Petter Selasky #define MOS_DPRINTFN(fmt,...) \ 145b2dce55fSHans Petter Selasky DPRINTF("mos: %s: " fmt "\n",__FUNCTION__,## __VA_ARGS__) 146b2dce55fSHans Petter Selasky 147b2dce55fSHans Petter Selasky #define USB_PRODUCT_MOSCHIP_MCS7730 0x7730 148b2dce55fSHans Petter Selasky #define USB_PRODUCT_SITECOMEU_LN030 0x0021 149b2dce55fSHans Petter Selasky 150b2dce55fSHans Petter Selasky 151b2dce55fSHans Petter Selasky 152b2dce55fSHans Petter Selasky /* Various supported device vendors/products. */ 153f1a16106SHans Petter Selasky static const STRUCT_USB_HOST_ID mos_devs[] = { 154b2dce55fSHans Petter Selasky {USB_VPI(USB_VENDOR_MOSCHIP, USB_PRODUCT_MOSCHIP_MCS7730, MCS7730)}, 155b2dce55fSHans Petter Selasky {USB_VPI(USB_VENDOR_MOSCHIP, USB_PRODUCT_MOSCHIP_MCS7830, MCS7830)}, 156d4d6dcc5SKevin Lo {USB_VPI(USB_VENDOR_MOSCHIP, USB_PRODUCT_MOSCHIP_MCS7832, MCS7832)}, 157b2dce55fSHans Petter Selasky {USB_VPI(USB_VENDOR_SITECOMEU, USB_PRODUCT_SITECOMEU_LN030, MCS7830)}, 158b2dce55fSHans Petter Selasky }; 159b2dce55fSHans Petter Selasky 160b2dce55fSHans Petter Selasky static int mos_probe(device_t dev); 161b2dce55fSHans Petter Selasky static int mos_attach(device_t dev); 162b2dce55fSHans Petter Selasky static void mos_attach_post(struct usb_ether *ue); 163b2dce55fSHans Petter Selasky static int mos_detach(device_t dev); 164b2dce55fSHans Petter Selasky 165b2dce55fSHans Petter Selasky static void mos_bulk_read_callback(struct usb_xfer *xfer, usb_error_t error); 166b2dce55fSHans Petter Selasky static void mos_bulk_write_callback(struct usb_xfer *xfer, usb_error_t error); 167b2dce55fSHans Petter Selasky static void mos_intr_callback(struct usb_xfer *xfer, usb_error_t error); 168b2dce55fSHans Petter Selasky static void mos_tick(struct usb_ether *); 169b2dce55fSHans Petter Selasky static void mos_start(struct usb_ether *); 170b2dce55fSHans Petter Selasky static void mos_init(struct usb_ether *); 171b2dce55fSHans Petter Selasky static void mos_chip_init(struct mos_softc *); 172b2dce55fSHans Petter Selasky static void mos_stop(struct usb_ether *); 173b2dce55fSHans Petter Selasky static int mos_miibus_readreg(device_t, int, int); 174b2dce55fSHans Petter Selasky static int mos_miibus_writereg(device_t, int, int, int); 175b2dce55fSHans Petter Selasky static void mos_miibus_statchg(device_t); 176b2dce55fSHans Petter Selasky static int mos_ifmedia_upd(struct ifnet *); 177b2dce55fSHans Petter Selasky static void mos_ifmedia_sts(struct ifnet *, struct ifmediareq *); 178b2dce55fSHans Petter Selasky static void mos_reset(struct mos_softc *sc); 179b2dce55fSHans Petter Selasky 180b2dce55fSHans Petter Selasky static int mos_reg_read_1(struct mos_softc *, int); 181b2dce55fSHans Petter Selasky static int mos_reg_read_2(struct mos_softc *, int); 182b2dce55fSHans Petter Selasky static int mos_reg_write_1(struct mos_softc *, int, int); 183b2dce55fSHans Petter Selasky static int mos_reg_write_2(struct mos_softc *, int, int); 184b2dce55fSHans Petter Selasky static int mos_readmac(struct mos_softc *, uint8_t *); 185b2dce55fSHans Petter Selasky static int mos_writemac(struct mos_softc *, uint8_t *); 186b2dce55fSHans Petter Selasky static int mos_write_mcast(struct mos_softc *, u_char *); 187b2dce55fSHans Petter Selasky 188b2dce55fSHans Petter Selasky static void mos_setmulti(struct usb_ether *); 189b2dce55fSHans Petter Selasky static void mos_setpromisc(struct usb_ether *); 190b2dce55fSHans Petter Selasky 191b2dce55fSHans Petter Selasky static const struct usb_config mos_config[MOS_ENDPT_MAX] = { 192b2dce55fSHans Petter Selasky 193b2dce55fSHans Petter Selasky [MOS_ENDPT_TX] = { 194b2dce55fSHans Petter Selasky .type = UE_BULK, 195b2dce55fSHans Petter Selasky .endpoint = UE_ADDR_ANY, 196b2dce55fSHans Petter Selasky .direction = UE_DIR_OUT, 197b2dce55fSHans Petter Selasky .bufsize = (MCLBYTES + 2), 198b2dce55fSHans Petter Selasky .flags = {.pipe_bof = 1,.force_short_xfer = 1,}, 199b2dce55fSHans Petter Selasky .callback = mos_bulk_write_callback, 200b2dce55fSHans Petter Selasky .timeout = 10000, 201b2dce55fSHans Petter Selasky }, 202b2dce55fSHans Petter Selasky 203b2dce55fSHans Petter Selasky [MOS_ENDPT_RX] = { 204b2dce55fSHans Petter Selasky .type = UE_BULK, 205b2dce55fSHans Petter Selasky .endpoint = UE_ADDR_ANY, 206b2dce55fSHans Petter Selasky .direction = UE_DIR_IN, 207b2dce55fSHans Petter Selasky .bufsize = (MCLBYTES + 4 + ETHER_CRC_LEN), 208b2dce55fSHans Petter Selasky .flags = {.pipe_bof = 1,.short_xfer_ok = 1,}, 209b2dce55fSHans Petter Selasky .callback = mos_bulk_read_callback, 210b2dce55fSHans Petter Selasky }, 211b2dce55fSHans Petter Selasky 212b2dce55fSHans Petter Selasky [MOS_ENDPT_INTR] = { 213b2dce55fSHans Petter Selasky .type = UE_INTERRUPT, 214b2dce55fSHans Petter Selasky .endpoint = UE_ADDR_ANY, 215b2dce55fSHans Petter Selasky .direction = UE_DIR_IN, 216b2dce55fSHans Petter Selasky .flags = {.pipe_bof = 1,.short_xfer_ok = 1,}, 217b2dce55fSHans Petter Selasky .bufsize = 0, 218b2dce55fSHans Petter Selasky .callback = mos_intr_callback, 219b2dce55fSHans Petter Selasky }, 220b2dce55fSHans Petter Selasky }; 221b2dce55fSHans Petter Selasky 222b2dce55fSHans Petter Selasky static device_method_t mos_methods[] = { 223b2dce55fSHans Petter Selasky /* Device interface */ 224b2dce55fSHans Petter Selasky DEVMETHOD(device_probe, mos_probe), 225b2dce55fSHans Petter Selasky DEVMETHOD(device_attach, mos_attach), 226b2dce55fSHans Petter Selasky DEVMETHOD(device_detach, mos_detach), 227b2dce55fSHans Petter Selasky 228b2dce55fSHans Petter Selasky /* MII interface */ 229b2dce55fSHans Petter Selasky DEVMETHOD(miibus_readreg, mos_miibus_readreg), 230b2dce55fSHans Petter Selasky DEVMETHOD(miibus_writereg, mos_miibus_writereg), 231b2dce55fSHans Petter Selasky DEVMETHOD(miibus_statchg, mos_miibus_statchg), 232b2dce55fSHans Petter Selasky 2334b7ec270SMarius Strobl DEVMETHOD_END 234b2dce55fSHans Petter Selasky }; 235b2dce55fSHans Petter Selasky 236b2dce55fSHans Petter Selasky static driver_t mos_driver = { 237b2dce55fSHans Petter Selasky .name = "mos", 238b2dce55fSHans Petter Selasky .methods = mos_methods, 239b2dce55fSHans Petter Selasky .size = sizeof(struct mos_softc) 240b2dce55fSHans Petter Selasky }; 241b2dce55fSHans Petter Selasky 242b2dce55fSHans Petter Selasky static devclass_t mos_devclass; 243b2dce55fSHans Petter Selasky 244b2dce55fSHans Petter Selasky DRIVER_MODULE(mos, uhub, mos_driver, mos_devclass, NULL, 0); 245b2dce55fSHans Petter Selasky DRIVER_MODULE(miibus, mos, miibus_driver, miibus_devclass, 0, 0); 246b2dce55fSHans Petter Selasky MODULE_DEPEND(mos, uether, 1, 1, 1); 247b2dce55fSHans Petter Selasky MODULE_DEPEND(mos, usb, 1, 1, 1); 248b2dce55fSHans Petter Selasky MODULE_DEPEND(mos, ether, 1, 1, 1); 249b2dce55fSHans Petter Selasky MODULE_DEPEND(mos, miibus, 1, 1, 1); 250*f809f280SWarner Losh USB_PNP_HOST_INFO(mos_devs); 251b2dce55fSHans Petter Selasky 252b2dce55fSHans Petter Selasky static const struct usb_ether_methods mos_ue_methods = { 253b2dce55fSHans Petter Selasky .ue_attach_post = mos_attach_post, 254b2dce55fSHans Petter Selasky .ue_start = mos_start, 255b2dce55fSHans Petter Selasky .ue_init = mos_init, 256b2dce55fSHans Petter Selasky .ue_stop = mos_stop, 257b2dce55fSHans Petter Selasky .ue_tick = mos_tick, 258b2dce55fSHans Petter Selasky .ue_setmulti = mos_setmulti, 259b2dce55fSHans Petter Selasky .ue_setpromisc = mos_setpromisc, 260b2dce55fSHans Petter Selasky .ue_mii_upd = mos_ifmedia_upd, 261b2dce55fSHans Petter Selasky .ue_mii_sts = mos_ifmedia_sts, 262b2dce55fSHans Petter Selasky }; 263b2dce55fSHans Petter Selasky 264b2dce55fSHans Petter Selasky 265b2dce55fSHans Petter Selasky static int 266b2dce55fSHans Petter Selasky mos_reg_read_1(struct mos_softc *sc, int reg) 267b2dce55fSHans Petter Selasky { 268b2dce55fSHans Petter Selasky struct usb_device_request req; 269b2dce55fSHans Petter Selasky usb_error_t err; 270b2dce55fSHans Petter Selasky uByte val = 0; 271b2dce55fSHans Petter Selasky 272b2dce55fSHans Petter Selasky req.bmRequestType = UT_READ_VENDOR_DEVICE; 273b2dce55fSHans Petter Selasky req.bRequest = MOS_UR_READREG; 274b2dce55fSHans Petter Selasky USETW(req.wValue, 0); 275b2dce55fSHans Petter Selasky USETW(req.wIndex, reg); 276b2dce55fSHans Petter Selasky USETW(req.wLength, 1); 277b2dce55fSHans Petter Selasky 278b2dce55fSHans Petter Selasky err = uether_do_request(&sc->sc_ue, &req, &val, 1000); 279b2dce55fSHans Petter Selasky 280b2dce55fSHans Petter Selasky if (err) { 281b2dce55fSHans Petter Selasky MOS_DPRINTFN("mos_reg_read_1 error, reg: %d\n", reg); 282b2dce55fSHans Petter Selasky return (-1); 283b2dce55fSHans Petter Selasky } 284b2dce55fSHans Petter Selasky return (val); 285b2dce55fSHans Petter Selasky } 286b2dce55fSHans Petter Selasky 287b2dce55fSHans Petter Selasky static int 288b2dce55fSHans Petter Selasky mos_reg_read_2(struct mos_softc *sc, int reg) 289b2dce55fSHans Petter Selasky { 290b2dce55fSHans Petter Selasky struct usb_device_request req; 291b2dce55fSHans Petter Selasky usb_error_t err; 292b2dce55fSHans Petter Selasky uWord val; 293b2dce55fSHans Petter Selasky 294b2dce55fSHans Petter Selasky USETW(val, 0); 295b2dce55fSHans Petter Selasky 296b2dce55fSHans Petter Selasky req.bmRequestType = UT_READ_VENDOR_DEVICE; 297b2dce55fSHans Petter Selasky req.bRequest = MOS_UR_READREG; 298b2dce55fSHans Petter Selasky USETW(req.wValue, 0); 299b2dce55fSHans Petter Selasky USETW(req.wIndex, reg); 300b2dce55fSHans Petter Selasky USETW(req.wLength, 2); 301b2dce55fSHans Petter Selasky 302b2dce55fSHans Petter Selasky err = uether_do_request(&sc->sc_ue, &req, &val, 1000); 303b2dce55fSHans Petter Selasky 304b2dce55fSHans Petter Selasky if (err) { 305b2dce55fSHans Petter Selasky MOS_DPRINTFN("mos_reg_read_2 error, reg: %d", reg); 306b2dce55fSHans Petter Selasky return (-1); 307b2dce55fSHans Petter Selasky } 308b2dce55fSHans Petter Selasky return (UGETW(val)); 309b2dce55fSHans Petter Selasky } 310b2dce55fSHans Petter Selasky 311b2dce55fSHans Petter Selasky static int 312b2dce55fSHans Petter Selasky mos_reg_write_1(struct mos_softc *sc, int reg, int aval) 313b2dce55fSHans Petter Selasky { 314b2dce55fSHans Petter Selasky struct usb_device_request req; 315b2dce55fSHans Petter Selasky usb_error_t err; 316b2dce55fSHans Petter Selasky uByte val; 317b2dce55fSHans Petter Selasky val = aval; 318b2dce55fSHans Petter Selasky 319b2dce55fSHans Petter Selasky req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 320b2dce55fSHans Petter Selasky req.bRequest = MOS_UR_WRITEREG; 321b2dce55fSHans Petter Selasky USETW(req.wValue, 0); 322b2dce55fSHans Petter Selasky USETW(req.wIndex, reg); 323b2dce55fSHans Petter Selasky USETW(req.wLength, 1); 324b2dce55fSHans Petter Selasky 325b2dce55fSHans Petter Selasky err = uether_do_request(&sc->sc_ue, &req, &val, 1000); 326b2dce55fSHans Petter Selasky 327b2dce55fSHans Petter Selasky if (err) { 328b2dce55fSHans Petter Selasky MOS_DPRINTFN("mos_reg_write_1 error, reg: %d", reg); 329b2dce55fSHans Petter Selasky return (-1); 330b2dce55fSHans Petter Selasky } 331b2dce55fSHans Petter Selasky return (0); 332b2dce55fSHans Petter Selasky } 333b2dce55fSHans Petter Selasky 334b2dce55fSHans Petter Selasky static int 335b2dce55fSHans Petter Selasky mos_reg_write_2(struct mos_softc *sc, int reg, int aval) 336b2dce55fSHans Petter Selasky { 337b2dce55fSHans Petter Selasky struct usb_device_request req; 338b2dce55fSHans Petter Selasky usb_error_t err; 339b2dce55fSHans Petter Selasky uWord val; 340b2dce55fSHans Petter Selasky 341b2dce55fSHans Petter Selasky USETW(val, aval); 342b2dce55fSHans Petter Selasky 343b2dce55fSHans Petter Selasky req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 344b2dce55fSHans Petter Selasky req.bRequest = MOS_UR_WRITEREG; 345b2dce55fSHans Petter Selasky USETW(req.wValue, 0); 346b2dce55fSHans Petter Selasky USETW(req.wIndex, reg); 347b2dce55fSHans Petter Selasky USETW(req.wLength, 2); 348b2dce55fSHans Petter Selasky 349b2dce55fSHans Petter Selasky err = uether_do_request(&sc->sc_ue, &req, &val, 1000); 350b2dce55fSHans Petter Selasky 351b2dce55fSHans Petter Selasky if (err) { 352b2dce55fSHans Petter Selasky MOS_DPRINTFN("mos_reg_write_2 error, reg: %d", reg); 353b2dce55fSHans Petter Selasky return (-1); 354b2dce55fSHans Petter Selasky } 355b2dce55fSHans Petter Selasky return (0); 356b2dce55fSHans Petter Selasky } 357b2dce55fSHans Petter Selasky 358b2dce55fSHans Petter Selasky static int 359b2dce55fSHans Petter Selasky mos_readmac(struct mos_softc *sc, u_char *mac) 360b2dce55fSHans Petter Selasky { 361b2dce55fSHans Petter Selasky struct usb_device_request req; 362b2dce55fSHans Petter Selasky usb_error_t err; 363b2dce55fSHans Petter Selasky 364b2dce55fSHans Petter Selasky req.bmRequestType = UT_READ_VENDOR_DEVICE; 365b2dce55fSHans Petter Selasky req.bRequest = MOS_UR_READREG; 366b2dce55fSHans Petter Selasky USETW(req.wValue, 0); 367b2dce55fSHans Petter Selasky USETW(req.wIndex, MOS_MAC); 368b2dce55fSHans Petter Selasky USETW(req.wLength, ETHER_ADDR_LEN); 369b2dce55fSHans Petter Selasky 370b2dce55fSHans Petter Selasky err = uether_do_request(&sc->sc_ue, &req, mac, 1000); 371b2dce55fSHans Petter Selasky 372b2dce55fSHans Petter Selasky if (err) { 373b2dce55fSHans Petter Selasky return (-1); 374b2dce55fSHans Petter Selasky } 375b2dce55fSHans Petter Selasky return (0); 376b2dce55fSHans Petter Selasky } 377b2dce55fSHans Petter Selasky 378b2dce55fSHans Petter Selasky static int 379b2dce55fSHans Petter Selasky mos_writemac(struct mos_softc *sc, uint8_t *mac) 380b2dce55fSHans Petter Selasky { 381b2dce55fSHans Petter Selasky struct usb_device_request req; 382b2dce55fSHans Petter Selasky usb_error_t err; 383b2dce55fSHans Petter Selasky 384b2dce55fSHans Petter Selasky req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 385b2dce55fSHans Petter Selasky req.bRequest = MOS_UR_WRITEREG; 386b2dce55fSHans Petter Selasky USETW(req.wValue, 0); 387b2dce55fSHans Petter Selasky USETW(req.wIndex, MOS_MAC); 388b2dce55fSHans Petter Selasky USETW(req.wLength, ETHER_ADDR_LEN); 389b2dce55fSHans Petter Selasky 390b2dce55fSHans Petter Selasky err = uether_do_request(&sc->sc_ue, &req, mac, 1000); 391b2dce55fSHans Petter Selasky 392b2dce55fSHans Petter Selasky if (err) { 393b2dce55fSHans Petter Selasky MOS_DPRINTFN("mos_writemac error"); 394b2dce55fSHans Petter Selasky return (-1); 395b2dce55fSHans Petter Selasky } 396b2dce55fSHans Petter Selasky return (0); 397b2dce55fSHans Petter Selasky } 398b2dce55fSHans Petter Selasky 399b2dce55fSHans Petter Selasky static int 400b2dce55fSHans Petter Selasky mos_write_mcast(struct mos_softc *sc, u_char *hashtbl) 401b2dce55fSHans Petter Selasky { 402b2dce55fSHans Petter Selasky struct usb_device_request req; 403b2dce55fSHans Petter Selasky usb_error_t err; 404b2dce55fSHans Petter Selasky 405b2dce55fSHans Petter Selasky req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 406b2dce55fSHans Petter Selasky req.bRequest = MOS_UR_WRITEREG; 407b2dce55fSHans Petter Selasky USETW(req.wValue, 0); 408b2dce55fSHans Petter Selasky USETW(req.wIndex, MOS_MCAST_TABLE); 409b2dce55fSHans Petter Selasky USETW(req.wLength, 8); 410b2dce55fSHans Petter Selasky 411b2dce55fSHans Petter Selasky err = uether_do_request(&sc->sc_ue, &req, hashtbl, 1000); 412b2dce55fSHans Petter Selasky 413b2dce55fSHans Petter Selasky if (err) { 414b2dce55fSHans Petter Selasky MOS_DPRINTFN("mos_reg_mcast error"); 415b2dce55fSHans Petter Selasky return (-1); 416b2dce55fSHans Petter Selasky } 417b2dce55fSHans Petter Selasky return (0); 418b2dce55fSHans Petter Selasky } 419b2dce55fSHans Petter Selasky 420b2dce55fSHans Petter Selasky static int 421b2dce55fSHans Petter Selasky mos_miibus_readreg(struct device *dev, int phy, int reg) 422b2dce55fSHans Petter Selasky { 423b2dce55fSHans Petter Selasky struct mos_softc *sc = device_get_softc(dev); 424b2dce55fSHans Petter Selasky uWord val; 425b2dce55fSHans Petter Selasky int i, res, locked; 426b2dce55fSHans Petter Selasky 427b2dce55fSHans Petter Selasky USETW(val, 0); 428b2dce55fSHans Petter Selasky 429b2dce55fSHans Petter Selasky locked = mtx_owned(&sc->sc_mtx); 430b2dce55fSHans Petter Selasky if (!locked) 431b2dce55fSHans Petter Selasky MOS_LOCK(sc); 432b2dce55fSHans Petter Selasky 433b2dce55fSHans Petter Selasky mos_reg_write_2(sc, MOS_PHY_DATA, 0); 434b2dce55fSHans Petter Selasky mos_reg_write_1(sc, MOS_PHY_CTL, (phy & MOS_PHYCTL_PHYADDR) | 435b2dce55fSHans Petter Selasky MOS_PHYCTL_READ); 436b2dce55fSHans Petter Selasky mos_reg_write_1(sc, MOS_PHY_STS, (reg & MOS_PHYSTS_PHYREG) | 437b2dce55fSHans Petter Selasky MOS_PHYSTS_PENDING); 438b2dce55fSHans Petter Selasky 439b2dce55fSHans Petter Selasky for (i = 0; i < MOS_TIMEOUT; i++) { 440b2dce55fSHans Petter Selasky if (mos_reg_read_1(sc, MOS_PHY_STS) & MOS_PHYSTS_READY) 441b2dce55fSHans Petter Selasky break; 442b2dce55fSHans Petter Selasky } 443b2dce55fSHans Petter Selasky if (i == MOS_TIMEOUT) { 444b2dce55fSHans Petter Selasky MOS_DPRINTFN("MII read timeout"); 445b2dce55fSHans Petter Selasky } 446b2dce55fSHans Petter Selasky res = mos_reg_read_2(sc, MOS_PHY_DATA); 447b2dce55fSHans Petter Selasky 448b2dce55fSHans Petter Selasky if (!locked) 449b2dce55fSHans Petter Selasky MOS_UNLOCK(sc); 450b2dce55fSHans Petter Selasky return (res); 451b2dce55fSHans Petter Selasky } 452b2dce55fSHans Petter Selasky 453b2dce55fSHans Petter Selasky static int 454b2dce55fSHans Petter Selasky mos_miibus_writereg(device_t dev, int phy, int reg, int val) 455b2dce55fSHans Petter Selasky { 456b2dce55fSHans Petter Selasky struct mos_softc *sc = device_get_softc(dev); 457b2dce55fSHans Petter Selasky int i, locked; 458b2dce55fSHans Petter Selasky 459b2dce55fSHans Petter Selasky locked = mtx_owned(&sc->sc_mtx); 460b2dce55fSHans Petter Selasky if (!locked) 461b2dce55fSHans Petter Selasky MOS_LOCK(sc); 462b2dce55fSHans Petter Selasky 463b2dce55fSHans Petter Selasky mos_reg_write_2(sc, MOS_PHY_DATA, val); 464b2dce55fSHans Petter Selasky mos_reg_write_1(sc, MOS_PHY_CTL, (phy & MOS_PHYCTL_PHYADDR) | 465b2dce55fSHans Petter Selasky MOS_PHYCTL_WRITE); 466b2dce55fSHans Petter Selasky mos_reg_write_1(sc, MOS_PHY_STS, (reg & MOS_PHYSTS_PHYREG) | 467b2dce55fSHans Petter Selasky MOS_PHYSTS_PENDING); 468b2dce55fSHans Petter Selasky 469b2dce55fSHans Petter Selasky for (i = 0; i < MOS_TIMEOUT; i++) { 470b2dce55fSHans Petter Selasky if (mos_reg_read_1(sc, MOS_PHY_STS) & MOS_PHYSTS_READY) 471b2dce55fSHans Petter Selasky break; 472b2dce55fSHans Petter Selasky } 473b2dce55fSHans Petter Selasky if (i == MOS_TIMEOUT) 474b2dce55fSHans Petter Selasky MOS_DPRINTFN("MII write timeout"); 475b2dce55fSHans Petter Selasky 476b2dce55fSHans Petter Selasky if (!locked) 477b2dce55fSHans Petter Selasky MOS_UNLOCK(sc); 478b2dce55fSHans Petter Selasky return 0; 479b2dce55fSHans Petter Selasky } 480b2dce55fSHans Petter Selasky 481b2dce55fSHans Petter Selasky static void 482b2dce55fSHans Petter Selasky mos_miibus_statchg(device_t dev) 483b2dce55fSHans Petter Selasky { 484b2dce55fSHans Petter Selasky struct mos_softc *sc = device_get_softc(dev); 485b2dce55fSHans Petter Selasky struct mii_data *mii = GET_MII(sc); 486b2dce55fSHans Petter Selasky int val, err, locked; 487b2dce55fSHans Petter Selasky 488b2dce55fSHans Petter Selasky locked = mtx_owned(&sc->sc_mtx); 489b2dce55fSHans Petter Selasky if (!locked) 490b2dce55fSHans Petter Selasky MOS_LOCK(sc); 491b2dce55fSHans Petter Selasky 492b2dce55fSHans Petter Selasky /* disable RX, TX prior to changing FDX, SPEEDSEL */ 493b2dce55fSHans Petter Selasky val = mos_reg_read_1(sc, MOS_CTL); 494b2dce55fSHans Petter Selasky val &= ~(MOS_CTL_TX_ENB | MOS_CTL_RX_ENB); 495b2dce55fSHans Petter Selasky mos_reg_write_1(sc, MOS_CTL, val); 496b2dce55fSHans Petter Selasky 497b2dce55fSHans Petter Selasky /* reset register which counts dropped frames */ 498b2dce55fSHans Petter Selasky mos_reg_write_1(sc, MOS_FRAME_DROP_CNT, 0); 499b2dce55fSHans Petter Selasky 500b2dce55fSHans Petter Selasky if ((mii->mii_media_active & IFM_GMASK) == IFM_FDX) 501b2dce55fSHans Petter Selasky val |= MOS_CTL_FDX_ENB; 502b2dce55fSHans Petter Selasky else 503b2dce55fSHans Petter Selasky val &= ~(MOS_CTL_FDX_ENB); 504b2dce55fSHans Petter Selasky 505b2dce55fSHans Petter Selasky switch (IFM_SUBTYPE(mii->mii_media_active)) { 506b2dce55fSHans Petter Selasky case IFM_100_TX: 507b2dce55fSHans Petter Selasky val |= MOS_CTL_SPEEDSEL; 508b2dce55fSHans Petter Selasky break; 509b2dce55fSHans Petter Selasky case IFM_10_T: 510b2dce55fSHans Petter Selasky val &= ~(MOS_CTL_SPEEDSEL); 511b2dce55fSHans Petter Selasky break; 512b2dce55fSHans Petter Selasky } 513b2dce55fSHans Petter Selasky 514b2dce55fSHans Petter Selasky /* re-enable TX, RX */ 515b2dce55fSHans Petter Selasky val |= (MOS_CTL_TX_ENB | MOS_CTL_RX_ENB); 516b2dce55fSHans Petter Selasky err = mos_reg_write_1(sc, MOS_CTL, val); 517b2dce55fSHans Petter Selasky 518b2dce55fSHans Petter Selasky if (err) 519b2dce55fSHans Petter Selasky MOS_DPRINTFN("media change failed"); 520b2dce55fSHans Petter Selasky 521b2dce55fSHans Petter Selasky if (!locked) 522b2dce55fSHans Petter Selasky MOS_UNLOCK(sc); 523b2dce55fSHans Petter Selasky } 524b2dce55fSHans Petter Selasky 525b2dce55fSHans Petter Selasky /* 526b2dce55fSHans Petter Selasky * Set media options. 527b2dce55fSHans Petter Selasky */ 528b2dce55fSHans Petter Selasky static int 529b2dce55fSHans Petter Selasky mos_ifmedia_upd(struct ifnet *ifp) 530b2dce55fSHans Petter Selasky { 531b2dce55fSHans Petter Selasky struct mos_softc *sc = ifp->if_softc; 532b2dce55fSHans Petter Selasky struct mii_data *mii = GET_MII(sc); 533b2dce55fSHans Petter Selasky struct mii_softc *miisc; 534ebe01023SKevin Lo int error; 535b2dce55fSHans Petter Selasky 536b2dce55fSHans Petter Selasky MOS_LOCK_ASSERT(sc, MA_OWNED); 537b2dce55fSHans Petter Selasky 538b2dce55fSHans Petter Selasky sc->mos_link = 0; 539b2dce55fSHans Petter Selasky LIST_FOREACH(miisc, &mii->mii_phys, mii_list) 540ebe01023SKevin Lo PHY_RESET(miisc); 541ebe01023SKevin Lo error = mii_mediachg(mii); 542ebe01023SKevin Lo return (error); 543b2dce55fSHans Petter Selasky } 544b2dce55fSHans Petter Selasky 545b2dce55fSHans Petter Selasky /* 546b2dce55fSHans Petter Selasky * Report current media status. 547b2dce55fSHans Petter Selasky */ 548b2dce55fSHans Petter Selasky static void 549b2dce55fSHans Petter Selasky mos_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr) 550b2dce55fSHans Petter Selasky { 551b2dce55fSHans Petter Selasky struct mos_softc *sc = ifp->if_softc; 552b2dce55fSHans Petter Selasky struct mii_data *mii = GET_MII(sc); 553b2dce55fSHans Petter Selasky 554b2dce55fSHans Petter Selasky MOS_LOCK(sc); 555b2dce55fSHans Petter Selasky mii_pollstat(mii); 556b2dce55fSHans Petter Selasky 557b2dce55fSHans Petter Selasky ifmr->ifm_active = mii->mii_media_active; 558b2dce55fSHans Petter Selasky ifmr->ifm_status = mii->mii_media_status; 559e9e549efSPyun YongHyeon MOS_UNLOCK(sc); 560b2dce55fSHans Petter Selasky } 561b2dce55fSHans Petter Selasky 562b2dce55fSHans Petter Selasky static void 563b2dce55fSHans Petter Selasky mos_setpromisc(struct usb_ether *ue) 564b2dce55fSHans Petter Selasky { 565b2dce55fSHans Petter Selasky struct mos_softc *sc = uether_getsc(ue); 566b2dce55fSHans Petter Selasky struct ifnet *ifp = uether_getifp(ue); 567b2dce55fSHans Petter Selasky 568b2dce55fSHans Petter Selasky uint8_t rxmode; 569b2dce55fSHans Petter Selasky 570b2dce55fSHans Petter Selasky MOS_LOCK_ASSERT(sc, MA_OWNED); 571b2dce55fSHans Petter Selasky 572b2dce55fSHans Petter Selasky rxmode = mos_reg_read_1(sc, MOS_CTL); 573b2dce55fSHans Petter Selasky 574b2dce55fSHans Petter Selasky /* If we want promiscuous mode, set the allframes bit. */ 575b2dce55fSHans Petter Selasky if (ifp->if_flags & IFF_PROMISC) { 576b2dce55fSHans Petter Selasky rxmode |= MOS_CTL_RX_PROMISC; 577b2dce55fSHans Petter Selasky } else { 578b2dce55fSHans Petter Selasky rxmode &= ~MOS_CTL_RX_PROMISC; 579b2dce55fSHans Petter Selasky } 580b2dce55fSHans Petter Selasky 581b2dce55fSHans Petter Selasky mos_reg_write_1(sc, MOS_CTL, rxmode); 582b2dce55fSHans Petter Selasky } 583b2dce55fSHans Petter Selasky 584b2dce55fSHans Petter Selasky 585b2dce55fSHans Petter Selasky 586b2dce55fSHans Petter Selasky static void 587b2dce55fSHans Petter Selasky mos_setmulti(struct usb_ether *ue) 588b2dce55fSHans Petter Selasky { 589b2dce55fSHans Petter Selasky struct mos_softc *sc = uether_getsc(ue); 590b2dce55fSHans Petter Selasky struct ifnet *ifp = uether_getifp(ue); 591b2dce55fSHans Petter Selasky struct ifmultiaddr *ifma; 592b2dce55fSHans Petter Selasky 593b2dce55fSHans Petter Selasky uint32_t h = 0; 594b2dce55fSHans Petter Selasky uint8_t rxmode; 595b2dce55fSHans Petter Selasky uint8_t hashtbl[8] = {0, 0, 0, 0, 0, 0, 0, 0}; 596b2dce55fSHans Petter Selasky int allmulti = 0; 597b2dce55fSHans Petter Selasky 598b2dce55fSHans Petter Selasky MOS_LOCK_ASSERT(sc, MA_OWNED); 599b2dce55fSHans Petter Selasky 600b2dce55fSHans Petter Selasky rxmode = mos_reg_read_1(sc, MOS_CTL); 601b2dce55fSHans Petter Selasky 602b2dce55fSHans Petter Selasky if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) 603b2dce55fSHans Petter Selasky allmulti = 1; 604b2dce55fSHans Petter Selasky 605b2dce55fSHans Petter Selasky /* get all new ones */ 606b2dce55fSHans Petter Selasky if_maddr_rlock(ifp); 607b2dce55fSHans Petter Selasky TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) { 608b2dce55fSHans Petter Selasky if (ifma->ifma_addr->sa_family != AF_LINK) { 609b2dce55fSHans Petter Selasky allmulti = 1; 610b2dce55fSHans Petter Selasky continue; 611b2dce55fSHans Petter Selasky }; 612b2dce55fSHans Petter Selasky h = ether_crc32_be(LLADDR((struct sockaddr_dl *) 613b2dce55fSHans Petter Selasky ifma->ifma_addr), ETHER_ADDR_LEN) >> 26; 614b2dce55fSHans Petter Selasky hashtbl[h / 8] |= 1 << (h % 8); 615b2dce55fSHans Petter Selasky } 616b2dce55fSHans Petter Selasky if_maddr_runlock(ifp); 617b2dce55fSHans Petter Selasky 618b2dce55fSHans Petter Selasky /* now program new ones */ 619b2dce55fSHans Petter Selasky if (allmulti == 1) { 620b2dce55fSHans Petter Selasky rxmode |= MOS_CTL_ALLMULTI; 621b2dce55fSHans Petter Selasky mos_reg_write_1(sc, MOS_CTL, rxmode); 622b2dce55fSHans Petter Selasky } else { 623b2dce55fSHans Petter Selasky rxmode &= ~MOS_CTL_ALLMULTI; 624b2dce55fSHans Petter Selasky mos_write_mcast(sc, (void *)&hashtbl); 625b2dce55fSHans Petter Selasky mos_reg_write_1(sc, MOS_CTL, rxmode); 626b2dce55fSHans Petter Selasky } 627b2dce55fSHans Petter Selasky } 628b2dce55fSHans Petter Selasky 629b2dce55fSHans Petter Selasky static void 630b2dce55fSHans Petter Selasky mos_reset(struct mos_softc *sc) 631b2dce55fSHans Petter Selasky { 632b2dce55fSHans Petter Selasky uint8_t ctl; 633b2dce55fSHans Petter Selasky 634b2dce55fSHans Petter Selasky ctl = mos_reg_read_1(sc, MOS_CTL); 635b2dce55fSHans Petter Selasky ctl &= ~(MOS_CTL_RX_PROMISC | MOS_CTL_ALLMULTI | MOS_CTL_TX_ENB | 636b2dce55fSHans Petter Selasky MOS_CTL_RX_ENB); 637b2dce55fSHans Petter Selasky /* Disable RX, TX, promiscuous and allmulticast mode */ 638b2dce55fSHans Petter Selasky mos_reg_write_1(sc, MOS_CTL, ctl); 639b2dce55fSHans Petter Selasky 640b2dce55fSHans Petter Selasky /* Reset frame drop counter register to zero */ 641b2dce55fSHans Petter Selasky mos_reg_write_1(sc, MOS_FRAME_DROP_CNT, 0); 642b2dce55fSHans Petter Selasky 643b2dce55fSHans Petter Selasky /* Wait a little while for the chip to get its brains in order. */ 644b2dce55fSHans Petter Selasky usb_pause_mtx(&sc->sc_mtx, hz / 128); 645b2dce55fSHans Petter Selasky return; 646b2dce55fSHans Petter Selasky } 647b2dce55fSHans Petter Selasky 648b2dce55fSHans Petter Selasky static void 649b2dce55fSHans Petter Selasky mos_chip_init(struct mos_softc *sc) 650b2dce55fSHans Petter Selasky { 651b2dce55fSHans Petter Selasky int i; 652b2dce55fSHans Petter Selasky 653b2dce55fSHans Petter Selasky /* 654b2dce55fSHans Petter Selasky * Rev.C devices have a pause threshold register which needs to be set 655b2dce55fSHans Petter Selasky * at startup. 656b2dce55fSHans Petter Selasky */ 657b2dce55fSHans Petter Selasky if (mos_reg_read_1(sc, MOS_PAUSE_TRHD) != -1) { 658b2dce55fSHans Petter Selasky for (i = 0; i < MOS_PAUSE_REWRITES; i++) 659b2dce55fSHans Petter Selasky mos_reg_write_1(sc, MOS_PAUSE_TRHD, 0); 660b2dce55fSHans Petter Selasky } 661b2dce55fSHans Petter Selasky sc->mos_phyaddrs[0] = 1; 662b2dce55fSHans Petter Selasky sc->mos_phyaddrs[1] = 0xFF; 663b2dce55fSHans Petter Selasky } 664b2dce55fSHans Petter Selasky 665b2dce55fSHans Petter Selasky /* 666b2dce55fSHans Petter Selasky * Probe for a MCS7x30 chip. 667b2dce55fSHans Petter Selasky */ 668b2dce55fSHans Petter Selasky static int 669b2dce55fSHans Petter Selasky mos_probe(device_t dev) 670b2dce55fSHans Petter Selasky { 671b2dce55fSHans Petter Selasky struct usb_attach_arg *uaa = device_get_ivars(dev); 672b2dce55fSHans Petter Selasky int retval; 673b2dce55fSHans Petter Selasky 674b2dce55fSHans Petter Selasky if (uaa->usb_mode != USB_MODE_HOST) 675b2dce55fSHans Petter Selasky return (ENXIO); 676b2dce55fSHans Petter Selasky if (uaa->info.bConfigIndex != MOS_CONFIG_IDX) 677b2dce55fSHans Petter Selasky return (ENXIO); 678b2dce55fSHans Petter Selasky if (uaa->info.bIfaceIndex != MOS_IFACE_IDX) 679b2dce55fSHans Petter Selasky return (ENXIO); 680b2dce55fSHans Petter Selasky 681b2dce55fSHans Petter Selasky retval = usbd_lookup_id_by_uaa(mos_devs, sizeof(mos_devs), uaa); 682b2dce55fSHans Petter Selasky return (retval); 683b2dce55fSHans Petter Selasky } 684b2dce55fSHans Petter Selasky 685b2dce55fSHans Petter Selasky /* 686b2dce55fSHans Petter Selasky * Attach the interface. Allocate softc structures, do ifmedia 687b2dce55fSHans Petter Selasky * setup and ethernet/BPF attach. 688b2dce55fSHans Petter Selasky */ 689b2dce55fSHans Petter Selasky static int 690b2dce55fSHans Petter Selasky mos_attach(device_t dev) 691b2dce55fSHans Petter Selasky { 692b2dce55fSHans Petter Selasky struct usb_attach_arg *uaa = device_get_ivars(dev); 693b2dce55fSHans Petter Selasky struct mos_softc *sc = device_get_softc(dev); 694b2dce55fSHans Petter Selasky struct usb_ether *ue = &sc->sc_ue; 695b2dce55fSHans Petter Selasky uint8_t iface_index; 696b2dce55fSHans Petter Selasky int error; 697b2dce55fSHans Petter Selasky 698b2dce55fSHans Petter Selasky sc->mos_flags = USB_GET_DRIVER_INFO(uaa); 699b2dce55fSHans Petter Selasky 700b2dce55fSHans Petter Selasky device_set_usb_desc(dev); 701b2dce55fSHans Petter Selasky mtx_init(&sc->sc_mtx, device_get_nameunit(dev), NULL, MTX_DEF); 702b2dce55fSHans Petter Selasky 703b2dce55fSHans Petter Selasky iface_index = MOS_IFACE_IDX; 704b2dce55fSHans Petter Selasky error = usbd_transfer_setup(uaa->device, &iface_index, 705b2dce55fSHans Petter Selasky sc->sc_xfer, mos_config, MOS_ENDPT_MAX, 706b2dce55fSHans Petter Selasky sc, &sc->sc_mtx); 707b2dce55fSHans Petter Selasky 708b2dce55fSHans Petter Selasky if (error) { 709b2dce55fSHans Petter Selasky device_printf(dev, "allocating USB transfers failed\n"); 710b2dce55fSHans Petter Selasky goto detach; 711b2dce55fSHans Petter Selasky } 712b2dce55fSHans Petter Selasky ue->ue_sc = sc; 713b2dce55fSHans Petter Selasky ue->ue_dev = dev; 714b2dce55fSHans Petter Selasky ue->ue_udev = uaa->device; 715b2dce55fSHans Petter Selasky ue->ue_mtx = &sc->sc_mtx; 716b2dce55fSHans Petter Selasky ue->ue_methods = &mos_ue_methods; 717b2dce55fSHans Petter Selasky 718b2dce55fSHans Petter Selasky 719b2dce55fSHans Petter Selasky if (sc->mos_flags & MCS7730) { 720b2dce55fSHans Petter Selasky MOS_DPRINTFN("model: MCS7730"); 721b2dce55fSHans Petter Selasky } else if (sc->mos_flags & MCS7830) { 722b2dce55fSHans Petter Selasky MOS_DPRINTFN("model: MCS7830"); 723d4d6dcc5SKevin Lo } else if (sc->mos_flags & MCS7832) { 724d4d6dcc5SKevin Lo MOS_DPRINTFN("model: MCS7832"); 725b2dce55fSHans Petter Selasky } 726b2dce55fSHans Petter Selasky error = uether_ifattach(ue); 727b2dce55fSHans Petter Selasky if (error) { 728b2dce55fSHans Petter Selasky device_printf(dev, "could not attach interface\n"); 729b2dce55fSHans Petter Selasky goto detach; 730b2dce55fSHans Petter Selasky } 731b2dce55fSHans Petter Selasky return (0); 732b2dce55fSHans Petter Selasky 733b2dce55fSHans Petter Selasky 734b2dce55fSHans Petter Selasky detach: 735b2dce55fSHans Petter Selasky mos_detach(dev); 736b2dce55fSHans Petter Selasky return (ENXIO); 737b2dce55fSHans Petter Selasky } 738b2dce55fSHans Petter Selasky 739b2dce55fSHans Petter Selasky 740b2dce55fSHans Petter Selasky static void 741b2dce55fSHans Petter Selasky mos_attach_post(struct usb_ether *ue) 742b2dce55fSHans Petter Selasky { 743b2dce55fSHans Petter Selasky struct mos_softc *sc = uether_getsc(ue); 744b2dce55fSHans Petter Selasky int err; 745b2dce55fSHans Petter Selasky 746b2dce55fSHans Petter Selasky /* Read MAC address, inform the world. */ 747b2dce55fSHans Petter Selasky err = mos_readmac(sc, ue->ue_eaddr); 748b2dce55fSHans Petter Selasky 749b2dce55fSHans Petter Selasky if (err) 750b2dce55fSHans Petter Selasky MOS_DPRINTFN("couldn't get MAC address"); 751b2dce55fSHans Petter Selasky 752b2dce55fSHans Petter Selasky MOS_DPRINTFN("address: %s", ether_sprintf(ue->ue_eaddr)); 753b2dce55fSHans Petter Selasky 754b2dce55fSHans Petter Selasky mos_chip_init(sc); 755b2dce55fSHans Petter Selasky } 756b2dce55fSHans Petter Selasky 757b2dce55fSHans Petter Selasky static int 758b2dce55fSHans Petter Selasky mos_detach(device_t dev) 759b2dce55fSHans Petter Selasky { 760b2dce55fSHans Petter Selasky struct mos_softc *sc = device_get_softc(dev); 761b2dce55fSHans Petter Selasky struct usb_ether *ue = &sc->sc_ue; 762b2dce55fSHans Petter Selasky 763b2dce55fSHans Petter Selasky usbd_transfer_unsetup(sc->sc_xfer, MOS_ENDPT_MAX); 764b2dce55fSHans Petter Selasky uether_ifdetach(ue); 765b2dce55fSHans Petter Selasky mtx_destroy(&sc->sc_mtx); 766b2dce55fSHans Petter Selasky 767b2dce55fSHans Petter Selasky return (0); 768b2dce55fSHans Petter Selasky } 769b2dce55fSHans Petter Selasky 770b2dce55fSHans Petter Selasky 771b2dce55fSHans Petter Selasky 772b2dce55fSHans Petter Selasky 773b2dce55fSHans Petter Selasky /* 774b2dce55fSHans Petter Selasky * A frame has been uploaded: pass the resulting mbuf chain up to 775b2dce55fSHans Petter Selasky * the higher level protocols. 776b2dce55fSHans Petter Selasky */ 777b2dce55fSHans Petter Selasky static void 778b2dce55fSHans Petter Selasky mos_bulk_read_callback(struct usb_xfer *xfer, usb_error_t error) 779b2dce55fSHans Petter Selasky { 780b2dce55fSHans Petter Selasky struct mos_softc *sc = usbd_xfer_softc(xfer); 781b2dce55fSHans Petter Selasky struct usb_ether *ue = &sc->sc_ue; 782b2dce55fSHans Petter Selasky struct ifnet *ifp = uether_getifp(ue); 783b2dce55fSHans Petter Selasky 784b2dce55fSHans Petter Selasky uint8_t rxstat = 0; 785b2dce55fSHans Petter Selasky uint32_t actlen; 786b2dce55fSHans Petter Selasky uint16_t pktlen = 0; 787b2dce55fSHans Petter Selasky struct usb_page_cache *pc; 788b2dce55fSHans Petter Selasky 789b2dce55fSHans Petter Selasky usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL); 790b2dce55fSHans Petter Selasky pc = usbd_xfer_get_frame(xfer, 0); 791b2dce55fSHans Petter Selasky 792b2dce55fSHans Petter Selasky switch (USB_GET_STATE(xfer)) { 793b2dce55fSHans Petter Selasky case USB_ST_TRANSFERRED: 794b2dce55fSHans Petter Selasky MOS_DPRINTFN("actlen : %d", actlen); 795b2dce55fSHans Petter Selasky if (actlen <= 1) { 796ecc70d3fSGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); 797b2dce55fSHans Petter Selasky goto tr_setup; 798b2dce55fSHans Petter Selasky } 799b2dce55fSHans Petter Selasky /* evaluate status byte at the end */ 800b2dce55fSHans Petter Selasky usbd_copy_out(pc, actlen - sizeof(rxstat), &rxstat, 801b2dce55fSHans Petter Selasky sizeof(rxstat)); 802b2dce55fSHans Petter Selasky 803b2dce55fSHans Petter Selasky if (rxstat != MOS_RXSTS_VALID) { 804b2dce55fSHans Petter Selasky MOS_DPRINTFN("erroneous frame received"); 805b2dce55fSHans Petter Selasky if (rxstat & MOS_RXSTS_SHORT_FRAME) 806b2dce55fSHans Petter Selasky MOS_DPRINTFN("frame size less than 64 bytes"); 80726fdf1e8SHans Petter Selasky if (rxstat & MOS_RXSTS_LARGE_FRAME) { 80826fdf1e8SHans Petter Selasky MOS_DPRINTFN("frame size larger than " 80926fdf1e8SHans Petter Selasky "1532 bytes"); 81026fdf1e8SHans Petter Selasky } 811b2dce55fSHans Petter Selasky if (rxstat & MOS_RXSTS_CRC_ERROR) 812b2dce55fSHans Petter Selasky MOS_DPRINTFN("CRC error"); 813b2dce55fSHans Petter Selasky if (rxstat & MOS_RXSTS_ALIGN_ERROR) 814b2dce55fSHans Petter Selasky MOS_DPRINTFN("alignment error"); 815ecc70d3fSGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); 816b2dce55fSHans Petter Selasky goto tr_setup; 817b2dce55fSHans Petter Selasky } 818b2dce55fSHans Petter Selasky /* Remember the last byte was used for the status fields */ 819b2dce55fSHans Petter Selasky pktlen = actlen - 1; 820b2dce55fSHans Petter Selasky if (pktlen < sizeof(struct ether_header)) { 82126fdf1e8SHans Petter Selasky MOS_DPRINTFN("error: pktlen %d is smaller " 82226fdf1e8SHans Petter Selasky "than ether_header %zd", pktlen, 82326fdf1e8SHans Petter Selasky sizeof(struct ether_header)); 824ecc70d3fSGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); 825b2dce55fSHans Petter Selasky goto tr_setup; 826b2dce55fSHans Petter Selasky } 827b2dce55fSHans Petter Selasky uether_rxbuf(ue, pc, 0, actlen); 828b2dce55fSHans Petter Selasky /* FALLTHROUGH */ 829b2dce55fSHans Petter Selasky case USB_ST_SETUP: 830b2dce55fSHans Petter Selasky tr_setup: 831b2dce55fSHans Petter Selasky usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer)); 832b2dce55fSHans Petter Selasky usbd_transfer_submit(xfer); 833b2dce55fSHans Petter Selasky uether_rxflush(ue); 834b2dce55fSHans Petter Selasky return; 835b2dce55fSHans Petter Selasky default: 836b2dce55fSHans Petter Selasky MOS_DPRINTFN("bulk read error, %s", usbd_errstr(error)); 837b2dce55fSHans Petter Selasky if (error != USB_ERR_CANCELLED) { 838b2dce55fSHans Petter Selasky usbd_xfer_set_stall(xfer); 839b2dce55fSHans Petter Selasky goto tr_setup; 840b2dce55fSHans Petter Selasky } 841b2dce55fSHans Petter Selasky MOS_DPRINTFN("start rx %i", usbd_xfer_max_len(xfer)); 842b2dce55fSHans Petter Selasky return; 843b2dce55fSHans Petter Selasky } 844b2dce55fSHans Petter Selasky } 845b2dce55fSHans Petter Selasky 846b2dce55fSHans Petter Selasky /* 847b2dce55fSHans Petter Selasky * A frame was downloaded to the chip. It's safe for us to clean up 848b2dce55fSHans Petter Selasky * the list buffers. 849b2dce55fSHans Petter Selasky */ 850b2dce55fSHans Petter Selasky static void 851b2dce55fSHans Petter Selasky mos_bulk_write_callback(struct usb_xfer *xfer, usb_error_t error) 852b2dce55fSHans Petter Selasky { 853b2dce55fSHans Petter Selasky struct mos_softc *sc = usbd_xfer_softc(xfer); 854b2dce55fSHans Petter Selasky struct ifnet *ifp = uether_getifp(&sc->sc_ue); 855b2dce55fSHans Petter Selasky struct usb_page_cache *pc; 856b2dce55fSHans Petter Selasky struct mbuf *m; 857b2dce55fSHans Petter Selasky 858b2dce55fSHans Petter Selasky 859b2dce55fSHans Petter Selasky 860b2dce55fSHans Petter Selasky switch (USB_GET_STATE(xfer)) { 861b2dce55fSHans Petter Selasky case USB_ST_TRANSFERRED: 862b2dce55fSHans Petter Selasky MOS_DPRINTFN("transfer of complete"); 863ecc70d3fSGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1); 864b2dce55fSHans Petter Selasky /* FALLTHROUGH */ 865b2dce55fSHans Petter Selasky case USB_ST_SETUP: 866b2dce55fSHans Petter Selasky tr_setup: 867b2dce55fSHans Petter Selasky /* 868b2dce55fSHans Petter Selasky * XXX: don't send anything if there is no link? 869b2dce55fSHans Petter Selasky */ 870b2dce55fSHans Petter Selasky IFQ_DRV_DEQUEUE(&ifp->if_snd, m); 871b2dce55fSHans Petter Selasky if (m == NULL) 872b2dce55fSHans Petter Selasky return; 873b2dce55fSHans Petter Selasky 874b2dce55fSHans Petter Selasky pc = usbd_xfer_get_frame(xfer, 0); 875b2dce55fSHans Petter Selasky usbd_m_copy_in(pc, 0, m, 0, m->m_pkthdr.len); 876b2dce55fSHans Petter Selasky 877b2dce55fSHans Petter Selasky usbd_xfer_set_frame_len(xfer, 0, m->m_pkthdr.len); 878b2dce55fSHans Petter Selasky 879b2dce55fSHans Petter Selasky 880b2dce55fSHans Petter Selasky /* 881b2dce55fSHans Petter Selasky * if there's a BPF listener, bounce a copy 882b2dce55fSHans Petter Selasky * of this frame to him: 883b2dce55fSHans Petter Selasky */ 884b2dce55fSHans Petter Selasky BPF_MTAP(ifp, m); 885b2dce55fSHans Petter Selasky 886b2dce55fSHans Petter Selasky m_freem(m); 887b2dce55fSHans Petter Selasky 888b2dce55fSHans Petter Selasky usbd_transfer_submit(xfer); 889b2dce55fSHans Petter Selasky 890ecc70d3fSGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1); 891b2dce55fSHans Petter Selasky return; 892b2dce55fSHans Petter Selasky default: 893b2dce55fSHans Petter Selasky MOS_DPRINTFN("usb error on tx: %s\n", usbd_errstr(error)); 894ecc70d3fSGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); 895b2dce55fSHans Petter Selasky if (error != USB_ERR_CANCELLED) { 896b2dce55fSHans Petter Selasky usbd_xfer_set_stall(xfer); 897b2dce55fSHans Petter Selasky goto tr_setup; 898b2dce55fSHans Petter Selasky } 899b2dce55fSHans Petter Selasky return; 900b2dce55fSHans Petter Selasky } 901b2dce55fSHans Petter Selasky } 902b2dce55fSHans Petter Selasky 903b2dce55fSHans Petter Selasky static void 904b2dce55fSHans Petter Selasky mos_tick(struct usb_ether *ue) 905b2dce55fSHans Petter Selasky { 906b2dce55fSHans Petter Selasky struct mos_softc *sc = uether_getsc(ue); 907b2dce55fSHans Petter Selasky struct mii_data *mii = GET_MII(sc); 908b2dce55fSHans Petter Selasky 909b2dce55fSHans Petter Selasky MOS_LOCK_ASSERT(sc, MA_OWNED); 910b2dce55fSHans Petter Selasky 911b2dce55fSHans Petter Selasky mii_tick(mii); 912b2dce55fSHans Petter Selasky if (!sc->mos_link && mii->mii_media_status & IFM_ACTIVE && 913b2dce55fSHans Petter Selasky IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) { 914b2dce55fSHans Petter Selasky MOS_DPRINTFN("got link"); 915b2dce55fSHans Petter Selasky sc->mos_link++; 916b2dce55fSHans Petter Selasky mos_start(ue); 917b2dce55fSHans Petter Selasky } 918b2dce55fSHans Petter Selasky } 919b2dce55fSHans Petter Selasky 920b2dce55fSHans Petter Selasky 921b2dce55fSHans Petter Selasky static void 922b2dce55fSHans Petter Selasky mos_start(struct usb_ether *ue) 923b2dce55fSHans Petter Selasky { 924b2dce55fSHans Petter Selasky struct mos_softc *sc = uether_getsc(ue); 925b2dce55fSHans Petter Selasky 926b2dce55fSHans Petter Selasky /* 927b2dce55fSHans Petter Selasky * start the USB transfers, if not already started: 928b2dce55fSHans Petter Selasky */ 929b2dce55fSHans Petter Selasky usbd_transfer_start(sc->sc_xfer[MOS_ENDPT_TX]); 930b2dce55fSHans Petter Selasky usbd_transfer_start(sc->sc_xfer[MOS_ENDPT_RX]); 931b2dce55fSHans Petter Selasky usbd_transfer_start(sc->sc_xfer[MOS_ENDPT_INTR]); 932b2dce55fSHans Petter Selasky } 933b2dce55fSHans Petter Selasky 934b2dce55fSHans Petter Selasky static void 935b2dce55fSHans Petter Selasky mos_init(struct usb_ether *ue) 936b2dce55fSHans Petter Selasky { 937b2dce55fSHans Petter Selasky struct mos_softc *sc = uether_getsc(ue); 938b2dce55fSHans Petter Selasky struct ifnet *ifp = uether_getifp(ue); 939b2dce55fSHans Petter Selasky uint8_t rxmode; 940b2dce55fSHans Petter Selasky 941b2dce55fSHans Petter Selasky MOS_LOCK_ASSERT(sc, MA_OWNED); 942b2dce55fSHans Petter Selasky 943b2dce55fSHans Petter Selasky /* Cancel pending I/O and free all RX/TX buffers. */ 944b2dce55fSHans Petter Selasky mos_reset(sc); 945b2dce55fSHans Petter Selasky 946b2dce55fSHans Petter Selasky /* Write MAC address */ 947b2dce55fSHans Petter Selasky mos_writemac(sc, IF_LLADDR(ifp)); 948b2dce55fSHans Petter Selasky 949b2dce55fSHans Petter Selasky /* Read and set transmitter IPG values */ 950b2dce55fSHans Petter Selasky sc->mos_ipgs[0] = mos_reg_read_1(sc, MOS_IPG0); 951b2dce55fSHans Petter Selasky sc->mos_ipgs[1] = mos_reg_read_1(sc, MOS_IPG1); 952b2dce55fSHans Petter Selasky mos_reg_write_1(sc, MOS_IPG0, sc->mos_ipgs[0]); 953b2dce55fSHans Petter Selasky mos_reg_write_1(sc, MOS_IPG1, sc->mos_ipgs[1]); 954b2dce55fSHans Petter Selasky 955b2dce55fSHans Petter Selasky /* 956b2dce55fSHans Petter Selasky * Enable receiver and transmitter, bridge controls speed/duplex 957b2dce55fSHans Petter Selasky * mode 958b2dce55fSHans Petter Selasky */ 959b2dce55fSHans Petter Selasky rxmode = mos_reg_read_1(sc, MOS_CTL); 960b2dce55fSHans Petter Selasky rxmode |= MOS_CTL_RX_ENB | MOS_CTL_TX_ENB | MOS_CTL_BS_ENB; 961b2dce55fSHans Petter Selasky rxmode &= ~(MOS_CTL_SLEEP); 962b2dce55fSHans Petter Selasky 963b2dce55fSHans Petter Selasky mos_setpromisc(ue); 964b2dce55fSHans Petter Selasky 965b2dce55fSHans Petter Selasky /* XXX: broadcast mode? */ 966b2dce55fSHans Petter Selasky mos_reg_write_1(sc, MOS_CTL, rxmode); 967b2dce55fSHans Petter Selasky 968b2dce55fSHans Petter Selasky /* Load the multicast filter. */ 969b2dce55fSHans Petter Selasky mos_setmulti(ue); 970b2dce55fSHans Petter Selasky 971b2dce55fSHans Petter Selasky ifp->if_drv_flags |= IFF_DRV_RUNNING; 972b2dce55fSHans Petter Selasky mos_start(ue); 973b2dce55fSHans Petter Selasky } 974b2dce55fSHans Petter Selasky 975b2dce55fSHans Petter Selasky 976b2dce55fSHans Petter Selasky static void 977b2dce55fSHans Petter Selasky mos_intr_callback(struct usb_xfer *xfer, usb_error_t error) 978b2dce55fSHans Petter Selasky { 979b2dce55fSHans Petter Selasky struct mos_softc *sc = usbd_xfer_softc(xfer); 980b2dce55fSHans Petter Selasky struct ifnet *ifp = uether_getifp(&sc->sc_ue); 981b2dce55fSHans Petter Selasky struct usb_page_cache *pc; 982b2dce55fSHans Petter Selasky uint32_t pkt; 983b2dce55fSHans Petter Selasky int actlen; 984b2dce55fSHans Petter Selasky 985ecc70d3fSGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); 986b2dce55fSHans Petter Selasky 987b2dce55fSHans Petter Selasky usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL); 988b2dce55fSHans Petter Selasky MOS_DPRINTFN("actlen %i", actlen); 989b2dce55fSHans Petter Selasky 990b2dce55fSHans Petter Selasky switch (USB_GET_STATE(xfer)) { 991b2dce55fSHans Petter Selasky case USB_ST_TRANSFERRED: 992b2dce55fSHans Petter Selasky 993b2dce55fSHans Petter Selasky pc = usbd_xfer_get_frame(xfer, 0); 994b2dce55fSHans Petter Selasky usbd_copy_out(pc, 0, &pkt, sizeof(pkt)); 995b2dce55fSHans Petter Selasky /* FALLTHROUGH */ 996b2dce55fSHans Petter Selasky case USB_ST_SETUP: 997b2dce55fSHans Petter Selasky tr_setup: 998b2dce55fSHans Petter Selasky return; 999b2dce55fSHans Petter Selasky default: 1000b2dce55fSHans Petter Selasky if (error != USB_ERR_CANCELLED) { 1001b2dce55fSHans Petter Selasky usbd_xfer_set_stall(xfer); 1002b2dce55fSHans Petter Selasky goto tr_setup; 1003b2dce55fSHans Petter Selasky } 1004b2dce55fSHans Petter Selasky return; 1005b2dce55fSHans Petter Selasky } 1006b2dce55fSHans Petter Selasky } 1007b2dce55fSHans Petter Selasky 1008b2dce55fSHans Petter Selasky 1009b2dce55fSHans Petter Selasky /* 1010b2dce55fSHans Petter Selasky * Stop the adapter and free any mbufs allocated to the 1011b2dce55fSHans Petter Selasky * RX and TX lists. 1012b2dce55fSHans Petter Selasky */ 1013b2dce55fSHans Petter Selasky static void 1014b2dce55fSHans Petter Selasky mos_stop(struct usb_ether *ue) 1015b2dce55fSHans Petter Selasky { 1016b2dce55fSHans Petter Selasky struct mos_softc *sc = uether_getsc(ue); 1017b2dce55fSHans Petter Selasky struct ifnet *ifp = uether_getifp(ue); 1018b2dce55fSHans Petter Selasky 1019b2dce55fSHans Petter Selasky mos_reset(sc); 1020b2dce55fSHans Petter Selasky 1021b2dce55fSHans Petter Selasky MOS_LOCK_ASSERT(sc, MA_OWNED); 1022b2dce55fSHans Petter Selasky ifp->if_drv_flags &= ~IFF_DRV_RUNNING; 1023b2dce55fSHans Petter Selasky 1024b2dce55fSHans Petter Selasky /* stop all the transfers, if not already stopped */ 1025b2dce55fSHans Petter Selasky usbd_transfer_stop(sc->sc_xfer[MOS_ENDPT_TX]); 1026b2dce55fSHans Petter Selasky usbd_transfer_stop(sc->sc_xfer[MOS_ENDPT_RX]); 1027b2dce55fSHans Petter Selasky usbd_transfer_stop(sc->sc_xfer[MOS_ENDPT_INTR]); 1028b2dce55fSHans Petter Selasky 1029b2dce55fSHans Petter Selasky sc->mos_link = 0; 1030b2dce55fSHans Petter Selasky } 1031