102ac6454SAndrew Thompson /* $NetBSD: if_udav.c,v 1.2 2003/09/04 15:17:38 tsutsui Exp $ */ 202ac6454SAndrew Thompson /* $nabe: if_udav.c,v 1.3 2003/08/21 16:57:19 nabe Exp $ */ 302ac6454SAndrew Thompson /* $FreeBSD$ */ 402ac6454SAndrew Thompson /*- 502ac6454SAndrew Thompson * Copyright (c) 2003 602ac6454SAndrew Thompson * Shingo WATANABE <nabe@nabechan.org>. All rights reserved. 702ac6454SAndrew Thompson * 802ac6454SAndrew Thompson * Redistribution and use in source and binary forms, with or without 902ac6454SAndrew Thompson * modification, are permitted provided that the following conditions 1002ac6454SAndrew Thompson * are met: 1102ac6454SAndrew Thompson * 1. Redistributions of source code must retain the above copyright 1202ac6454SAndrew Thompson * notice, this list of conditions and the following disclaimer. 1302ac6454SAndrew Thompson * 2. Redistributions in binary form must reproduce the above copyright 1402ac6454SAndrew Thompson * notice, this list of conditions and the following disclaimer in the 1502ac6454SAndrew Thompson * documentation and/or other materials provided with the distribution. 1602ac6454SAndrew Thompson * 3. Neither the name of the author nor the names of any co-contributors 1702ac6454SAndrew Thompson * may be used to endorse or promote products derived from this software 1802ac6454SAndrew Thompson * without specific prior written permission. 1902ac6454SAndrew Thompson * 2002ac6454SAndrew Thompson * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 2102ac6454SAndrew Thompson * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 2202ac6454SAndrew Thompson * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 2302ac6454SAndrew Thompson * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 2402ac6454SAndrew Thompson * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 2502ac6454SAndrew Thompson * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2602ac6454SAndrew Thompson * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2702ac6454SAndrew Thompson * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2802ac6454SAndrew Thompson * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2902ac6454SAndrew Thompson * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 3002ac6454SAndrew Thompson * SUCH DAMAGE. 3102ac6454SAndrew Thompson * 3202ac6454SAndrew Thompson */ 3302ac6454SAndrew Thompson 3402ac6454SAndrew Thompson /* 3502ac6454SAndrew Thompson * DM9601(DAVICOM USB to Ethernet MAC Controller with Integrated 10/100 PHY) 3602ac6454SAndrew Thompson * The spec can be found at the following url. 3702ac6454SAndrew Thompson * http://www.davicom.com.tw/big5/download/Data%20Sheet/DM9601-DS-P01-930914.pdf 3802ac6454SAndrew Thompson */ 3902ac6454SAndrew Thompson 4002ac6454SAndrew Thompson /* 4102ac6454SAndrew Thompson * TODO: 4202ac6454SAndrew Thompson * Interrupt Endpoint support 4302ac6454SAndrew Thompson * External PHYs 4402ac6454SAndrew Thompson */ 4502ac6454SAndrew Thompson 4602ac6454SAndrew Thompson #include <sys/cdefs.h> 4702ac6454SAndrew Thompson __FBSDID("$FreeBSD$"); 4802ac6454SAndrew Thompson 49ed6d949aSAndrew Thompson #include <sys/stdint.h> 50ed6d949aSAndrew Thompson #include <sys/stddef.h> 51ed6d949aSAndrew Thompson #include <sys/param.h> 52ed6d949aSAndrew Thompson #include <sys/queue.h> 53ed6d949aSAndrew Thompson #include <sys/types.h> 54ed6d949aSAndrew Thompson #include <sys/systm.h> 55ed6d949aSAndrew Thompson #include <sys/kernel.h> 56ed6d949aSAndrew Thompson #include <sys/bus.h> 57ed6d949aSAndrew Thompson #include <sys/module.h> 58ed6d949aSAndrew Thompson #include <sys/lock.h> 59ed6d949aSAndrew Thompson #include <sys/mutex.h> 60ed6d949aSAndrew Thompson #include <sys/condvar.h> 61ed6d949aSAndrew Thompson #include <sys/sysctl.h> 62ed6d949aSAndrew Thompson #include <sys/sx.h> 63ed6d949aSAndrew Thompson #include <sys/unistd.h> 64ed6d949aSAndrew Thompson #include <sys/callout.h> 65ed6d949aSAndrew Thompson #include <sys/malloc.h> 66ed6d949aSAndrew Thompson #include <sys/priv.h> 67ed6d949aSAndrew Thompson 6802ac6454SAndrew Thompson #include <dev/usb/usb.h> 69ed6d949aSAndrew Thompson #include <dev/usb/usbdi.h> 70ed6d949aSAndrew Thompson #include <dev/usb/usbdi_util.h> 71ed6d949aSAndrew Thompson #include "usbdevs.h" 7202ac6454SAndrew Thompson 7302ac6454SAndrew Thompson #define USB_DEBUG_VAR udav_debug 7402ac6454SAndrew Thompson #include <dev/usb/usb_debug.h> 75ed6d949aSAndrew Thompson #include <dev/usb/usb_process.h> 7602ac6454SAndrew Thompson 7702ac6454SAndrew Thompson #include <dev/usb/net/usb_ethernet.h> 7802ac6454SAndrew Thompson #include <dev/usb/net/if_udavreg.h> 7902ac6454SAndrew Thompson 8002ac6454SAndrew Thompson /* prototypes */ 8102ac6454SAndrew Thompson 8202ac6454SAndrew Thompson static device_probe_t udav_probe; 8302ac6454SAndrew Thompson static device_attach_t udav_attach; 8402ac6454SAndrew Thompson static device_detach_t udav_detach; 8502ac6454SAndrew Thompson 86e0a69b51SAndrew Thompson static usb_callback_t udav_bulk_write_callback; 87e0a69b51SAndrew Thompson static usb_callback_t udav_bulk_read_callback; 88e0a69b51SAndrew Thompson static usb_callback_t udav_intr_callback; 8902ac6454SAndrew Thompson 90e0a69b51SAndrew Thompson static uether_fn_t udav_attach_post; 91e0a69b51SAndrew Thompson static uether_fn_t udav_init; 92e0a69b51SAndrew Thompson static uether_fn_t udav_stop; 93e0a69b51SAndrew Thompson static uether_fn_t udav_start; 94e0a69b51SAndrew Thompson static uether_fn_t udav_tick; 95e0a69b51SAndrew Thompson static uether_fn_t udav_setmulti; 96e0a69b51SAndrew Thompson static uether_fn_t udav_setpromisc; 9702ac6454SAndrew Thompson 9802ac6454SAndrew Thompson static int udav_csr_read(struct udav_softc *, uint16_t, void *, int); 9902ac6454SAndrew Thompson static int udav_csr_write(struct udav_softc *, uint16_t, void *, int); 10002ac6454SAndrew Thompson static uint8_t udav_csr_read1(struct udav_softc *, uint16_t); 10102ac6454SAndrew Thompson static int udav_csr_write1(struct udav_softc *, uint16_t, uint8_t); 10202ac6454SAndrew Thompson static void udav_reset(struct udav_softc *); 10302ac6454SAndrew Thompson static int udav_ifmedia_upd(struct ifnet *); 10402ac6454SAndrew Thompson static void udav_ifmedia_status(struct ifnet *, struct ifmediareq *); 10502ac6454SAndrew Thompson 10602ac6454SAndrew Thompson static miibus_readreg_t udav_miibus_readreg; 10702ac6454SAndrew Thompson static miibus_writereg_t udav_miibus_writereg; 10802ac6454SAndrew Thompson static miibus_statchg_t udav_miibus_statchg; 10902ac6454SAndrew Thompson 110760bc48eSAndrew Thompson static const struct usb_config udav_config[UDAV_N_TRANSFER] = { 11102ac6454SAndrew Thompson 11202ac6454SAndrew Thompson [UDAV_BULK_DT_WR] = { 11302ac6454SAndrew Thompson .type = UE_BULK, 11402ac6454SAndrew Thompson .endpoint = UE_ADDR_ANY, 11502ac6454SAndrew Thompson .direction = UE_DIR_OUT, 1164eae601eSAndrew Thompson .bufsize = (MCLBYTES + 2), 1174eae601eSAndrew Thompson .flags = {.pipe_bof = 1,.force_short_xfer = 1,}, 1184eae601eSAndrew Thompson .callback = udav_bulk_write_callback, 1194eae601eSAndrew Thompson .timeout = 10000, /* 10 seconds */ 12002ac6454SAndrew Thompson }, 12102ac6454SAndrew Thompson 12202ac6454SAndrew Thompson [UDAV_BULK_DT_RD] = { 12302ac6454SAndrew Thompson .type = UE_BULK, 12402ac6454SAndrew Thompson .endpoint = UE_ADDR_ANY, 12502ac6454SAndrew Thompson .direction = UE_DIR_IN, 1264eae601eSAndrew Thompson .bufsize = (MCLBYTES + 3), 1274eae601eSAndrew Thompson .flags = {.pipe_bof = 1,.short_xfer_ok = 1,}, 1284eae601eSAndrew Thompson .callback = udav_bulk_read_callback, 1294eae601eSAndrew Thompson .timeout = 0, /* no timeout */ 13002ac6454SAndrew Thompson }, 13102ac6454SAndrew Thompson 13202ac6454SAndrew Thompson [UDAV_INTR_DT_RD] = { 13302ac6454SAndrew Thompson .type = UE_INTERRUPT, 13402ac6454SAndrew Thompson .endpoint = UE_ADDR_ANY, 13502ac6454SAndrew Thompson .direction = UE_DIR_IN, 1364eae601eSAndrew Thompson .flags = {.pipe_bof = 1,.short_xfer_ok = 1,}, 1374eae601eSAndrew Thompson .bufsize = 0, /* use wMaxPacketSize */ 1384eae601eSAndrew Thompson .callback = udav_intr_callback, 13902ac6454SAndrew Thompson }, 14002ac6454SAndrew Thompson }; 14102ac6454SAndrew Thompson 14202ac6454SAndrew Thompson static device_method_t udav_methods[] = { 14302ac6454SAndrew Thompson /* Device interface */ 14402ac6454SAndrew Thompson DEVMETHOD(device_probe, udav_probe), 14502ac6454SAndrew Thompson DEVMETHOD(device_attach, udav_attach), 14602ac6454SAndrew Thompson DEVMETHOD(device_detach, udav_detach), 14702ac6454SAndrew Thompson 14802ac6454SAndrew Thompson /* bus interface */ 14902ac6454SAndrew Thompson DEVMETHOD(bus_print_child, bus_generic_print_child), 15002ac6454SAndrew Thompson 15102ac6454SAndrew Thompson /* MII interface */ 15202ac6454SAndrew Thompson DEVMETHOD(miibus_readreg, udav_miibus_readreg), 15302ac6454SAndrew Thompson DEVMETHOD(miibus_writereg, udav_miibus_writereg), 15402ac6454SAndrew Thompson DEVMETHOD(miibus_statchg, udav_miibus_statchg), 15502ac6454SAndrew Thompson 15602ac6454SAndrew Thompson {0, 0} 15702ac6454SAndrew Thompson }; 15802ac6454SAndrew Thompson 15902ac6454SAndrew Thompson static driver_t udav_driver = { 16002ac6454SAndrew Thompson .name = "udav", 16102ac6454SAndrew Thompson .methods = udav_methods, 16202ac6454SAndrew Thompson .size = sizeof(struct udav_softc), 16302ac6454SAndrew Thompson }; 16402ac6454SAndrew Thompson 16502ac6454SAndrew Thompson static devclass_t udav_devclass; 16602ac6454SAndrew Thompson 1679aef556dSAndrew Thompson DRIVER_MODULE(udav, uhub, udav_driver, udav_devclass, NULL, 0); 16802ac6454SAndrew Thompson DRIVER_MODULE(miibus, udav, miibus_driver, miibus_devclass, 0, 0); 16902ac6454SAndrew Thompson MODULE_DEPEND(udav, uether, 1, 1, 1); 17002ac6454SAndrew Thompson MODULE_DEPEND(udav, usb, 1, 1, 1); 17102ac6454SAndrew Thompson MODULE_DEPEND(udav, ether, 1, 1, 1); 17202ac6454SAndrew Thompson MODULE_DEPEND(udav, miibus, 1, 1, 1); 173910cb8feSAndrew Thompson MODULE_VERSION(udav, 1); 17402ac6454SAndrew Thompson 175760bc48eSAndrew Thompson static const struct usb_ether_methods udav_ue_methods = { 17602ac6454SAndrew Thompson .ue_attach_post = udav_attach_post, 17702ac6454SAndrew Thompson .ue_start = udav_start, 17802ac6454SAndrew Thompson .ue_init = udav_init, 17902ac6454SAndrew Thompson .ue_stop = udav_stop, 18002ac6454SAndrew Thompson .ue_tick = udav_tick, 18102ac6454SAndrew Thompson .ue_setmulti = udav_setmulti, 18202ac6454SAndrew Thompson .ue_setpromisc = udav_setpromisc, 18302ac6454SAndrew Thompson .ue_mii_upd = udav_ifmedia_upd, 18402ac6454SAndrew Thompson .ue_mii_sts = udav_ifmedia_status, 18502ac6454SAndrew Thompson }; 18602ac6454SAndrew Thompson 187b850ecc1SAndrew Thompson #ifdef USB_DEBUG 18802ac6454SAndrew Thompson static int udav_debug = 0; 18902ac6454SAndrew Thompson 1909360ae40SAndrew Thompson SYSCTL_NODE(_hw_usb, OID_AUTO, udav, CTLFLAG_RW, 0, "USB udav"); 1919360ae40SAndrew Thompson SYSCTL_INT(_hw_usb_udav, OID_AUTO, debug, CTLFLAG_RW, &udav_debug, 0, 19202ac6454SAndrew Thompson "Debug level"); 19302ac6454SAndrew Thompson #endif 19402ac6454SAndrew Thompson 19502ac6454SAndrew Thompson #define UDAV_SETBIT(sc, reg, x) \ 19602ac6454SAndrew Thompson udav_csr_write1(sc, reg, udav_csr_read1(sc, reg) | (x)) 19702ac6454SAndrew Thompson 19802ac6454SAndrew Thompson #define UDAV_CLRBIT(sc, reg, x) \ 19902ac6454SAndrew Thompson udav_csr_write1(sc, reg, udav_csr_read1(sc, reg) & ~(x)) 20002ac6454SAndrew Thompson 201f1a16106SHans Petter Selasky static const STRUCT_USB_HOST_ID udav_devs[] = { 20202ac6454SAndrew Thompson /* ShanTou DM9601 USB NIC */ 20302ac6454SAndrew Thompson {USB_VPI(USB_VENDOR_SHANTOU, USB_PRODUCT_SHANTOU_DM9601, 0)}, 20402ac6454SAndrew Thompson /* ShanTou ST268 USB NIC */ 20502ac6454SAndrew Thompson {USB_VPI(USB_VENDOR_SHANTOU, USB_PRODUCT_SHANTOU_ST268, 0)}, 20602ac6454SAndrew Thompson /* Corega USB-TXC */ 20702ac6454SAndrew Thompson {USB_VPI(USB_VENDOR_COREGA, USB_PRODUCT_COREGA_FETHER_USB_TXC, 0)}, 208733b53dfSHans Petter Selasky /* ShanTou AMD8515 USB NIC */ 209733b53dfSHans Petter Selasky {USB_VPI(USB_VENDOR_SHANTOU, USB_PRODUCT_SHANTOU_ADM8515, 0)}, 210733b53dfSHans Petter Selasky /* Kontron AG USB Ethernet */ 211733b53dfSHans Petter Selasky {USB_VPI(USB_VENDOR_KONTRON, USB_PRODUCT_KONTRON_DM9601, 0)}, 212842014b1SHans Petter Selasky {USB_VPI(USB_VENDOR_KONTRON, USB_PRODUCT_KONTRON_JP1082, 0)}, 21302ac6454SAndrew Thompson }; 21402ac6454SAndrew Thompson 21502ac6454SAndrew Thompson static void 216760bc48eSAndrew Thompson udav_attach_post(struct usb_ether *ue) 21702ac6454SAndrew Thompson { 218a593f6b8SAndrew Thompson struct udav_softc *sc = uether_getsc(ue); 21902ac6454SAndrew Thompson 22002ac6454SAndrew Thompson /* reset the adapter */ 22102ac6454SAndrew Thompson udav_reset(sc); 22202ac6454SAndrew Thompson 22302ac6454SAndrew Thompson /* Get Ethernet Address */ 22402ac6454SAndrew Thompson udav_csr_read(sc, UDAV_PAR, ue->ue_eaddr, ETHER_ADDR_LEN); 22502ac6454SAndrew Thompson } 22602ac6454SAndrew Thompson 22702ac6454SAndrew Thompson static int 22802ac6454SAndrew Thompson udav_probe(device_t dev) 22902ac6454SAndrew Thompson { 230760bc48eSAndrew Thompson struct usb_attach_arg *uaa = device_get_ivars(dev); 23102ac6454SAndrew Thompson 232f29a0724SAndrew Thompson if (uaa->usb_mode != USB_MODE_HOST) 23302ac6454SAndrew Thompson return (ENXIO); 23402ac6454SAndrew Thompson if (uaa->info.bConfigIndex != UDAV_CONFIG_INDEX) 23502ac6454SAndrew Thompson return (ENXIO); 23602ac6454SAndrew Thompson if (uaa->info.bIfaceIndex != UDAV_IFACE_INDEX) 23702ac6454SAndrew Thompson return (ENXIO); 23802ac6454SAndrew Thompson 239a593f6b8SAndrew Thompson return (usbd_lookup_id_by_uaa(udav_devs, sizeof(udav_devs), uaa)); 24002ac6454SAndrew Thompson } 24102ac6454SAndrew Thompson 24202ac6454SAndrew Thompson static int 24302ac6454SAndrew Thompson udav_attach(device_t dev) 24402ac6454SAndrew Thompson { 245760bc48eSAndrew Thompson struct usb_attach_arg *uaa = device_get_ivars(dev); 24602ac6454SAndrew Thompson struct udav_softc *sc = device_get_softc(dev); 247760bc48eSAndrew Thompson struct usb_ether *ue = &sc->sc_ue; 24802ac6454SAndrew Thompson uint8_t iface_index; 24902ac6454SAndrew Thompson int error; 25002ac6454SAndrew Thompson 25102ac6454SAndrew Thompson sc->sc_flags = USB_GET_DRIVER_INFO(uaa); 25202ac6454SAndrew Thompson 253a593f6b8SAndrew Thompson device_set_usb_desc(dev); 25402ac6454SAndrew Thompson 25502ac6454SAndrew Thompson mtx_init(&sc->sc_mtx, device_get_nameunit(dev), NULL, MTX_DEF); 25602ac6454SAndrew Thompson 25702ac6454SAndrew Thompson iface_index = UDAV_IFACE_INDEX; 258a593f6b8SAndrew Thompson error = usbd_transfer_setup(uaa->device, &iface_index, 25902ac6454SAndrew Thompson sc->sc_xfer, udav_config, UDAV_N_TRANSFER, sc, &sc->sc_mtx); 26002ac6454SAndrew Thompson if (error) { 261767cb2e2SAndrew Thompson device_printf(dev, "allocating USB transfers failed\n"); 26202ac6454SAndrew Thompson goto detach; 26302ac6454SAndrew Thompson } 26402ac6454SAndrew Thompson 26502ac6454SAndrew Thompson ue->ue_sc = sc; 26602ac6454SAndrew Thompson ue->ue_dev = dev; 26702ac6454SAndrew Thompson ue->ue_udev = uaa->device; 26802ac6454SAndrew Thompson ue->ue_mtx = &sc->sc_mtx; 26902ac6454SAndrew Thompson ue->ue_methods = &udav_ue_methods; 27002ac6454SAndrew Thompson 271a593f6b8SAndrew Thompson error = uether_ifattach(ue); 27202ac6454SAndrew Thompson if (error) { 27302ac6454SAndrew Thompson device_printf(dev, "could not attach interface\n"); 27402ac6454SAndrew Thompson goto detach; 27502ac6454SAndrew Thompson } 27602ac6454SAndrew Thompson 27702ac6454SAndrew Thompson return (0); /* success */ 27802ac6454SAndrew Thompson 27902ac6454SAndrew Thompson detach: 28002ac6454SAndrew Thompson udav_detach(dev); 28102ac6454SAndrew Thompson return (ENXIO); /* failure */ 28202ac6454SAndrew Thompson } 28302ac6454SAndrew Thompson 28402ac6454SAndrew Thompson static int 28502ac6454SAndrew Thompson udav_detach(device_t dev) 28602ac6454SAndrew Thompson { 28702ac6454SAndrew Thompson struct udav_softc *sc = device_get_softc(dev); 288760bc48eSAndrew Thompson struct usb_ether *ue = &sc->sc_ue; 28902ac6454SAndrew Thompson 290a593f6b8SAndrew Thompson usbd_transfer_unsetup(sc->sc_xfer, UDAV_N_TRANSFER); 291a593f6b8SAndrew Thompson uether_ifdetach(ue); 29202ac6454SAndrew Thompson mtx_destroy(&sc->sc_mtx); 29302ac6454SAndrew Thompson 29402ac6454SAndrew Thompson return (0); 29502ac6454SAndrew Thompson } 29602ac6454SAndrew Thompson 29702ac6454SAndrew Thompson #if 0 29802ac6454SAndrew Thompson static int 29902ac6454SAndrew Thompson udav_mem_read(struct udav_softc *sc, uint16_t offset, void *buf, 30002ac6454SAndrew Thompson int len) 30102ac6454SAndrew Thompson { 302760bc48eSAndrew Thompson struct usb_device_request req; 30302ac6454SAndrew Thompson 30402ac6454SAndrew Thompson len &= 0xff; 30502ac6454SAndrew Thompson 30602ac6454SAndrew Thompson req.bmRequestType = UT_READ_VENDOR_DEVICE; 30702ac6454SAndrew Thompson req.bRequest = UDAV_REQ_MEM_READ; 30802ac6454SAndrew Thompson USETW(req.wValue, 0x0000); 30902ac6454SAndrew Thompson USETW(req.wIndex, offset); 31002ac6454SAndrew Thompson USETW(req.wLength, len); 31102ac6454SAndrew Thompson 312a593f6b8SAndrew Thompson return (uether_do_request(&sc->sc_ue, &req, buf, 1000)); 31302ac6454SAndrew Thompson } 31402ac6454SAndrew Thompson 31502ac6454SAndrew Thompson static int 31602ac6454SAndrew Thompson udav_mem_write(struct udav_softc *sc, uint16_t offset, void *buf, 31702ac6454SAndrew Thompson int len) 31802ac6454SAndrew Thompson { 319760bc48eSAndrew Thompson struct usb_device_request req; 32002ac6454SAndrew Thompson 32102ac6454SAndrew Thompson len &= 0xff; 32202ac6454SAndrew Thompson 32302ac6454SAndrew Thompson req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 32402ac6454SAndrew Thompson req.bRequest = UDAV_REQ_MEM_WRITE; 32502ac6454SAndrew Thompson USETW(req.wValue, 0x0000); 32602ac6454SAndrew Thompson USETW(req.wIndex, offset); 32702ac6454SAndrew Thompson USETW(req.wLength, len); 32802ac6454SAndrew Thompson 329a593f6b8SAndrew Thompson return (uether_do_request(&sc->sc_ue, &req, buf, 1000)); 33002ac6454SAndrew Thompson } 33102ac6454SAndrew Thompson 33202ac6454SAndrew Thompson static int 33302ac6454SAndrew Thompson udav_mem_write1(struct udav_softc *sc, uint16_t offset, 33402ac6454SAndrew Thompson uint8_t ch) 33502ac6454SAndrew Thompson { 336760bc48eSAndrew Thompson struct usb_device_request req; 33702ac6454SAndrew Thompson 33802ac6454SAndrew Thompson req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 33902ac6454SAndrew Thompson req.bRequest = UDAV_REQ_MEM_WRITE1; 34002ac6454SAndrew Thompson USETW(req.wValue, ch); 34102ac6454SAndrew Thompson USETW(req.wIndex, offset); 34202ac6454SAndrew Thompson USETW(req.wLength, 0x0000); 34302ac6454SAndrew Thompson 344a593f6b8SAndrew Thompson return (uether_do_request(&sc->sc_ue, &req, NULL, 1000)); 34502ac6454SAndrew Thompson } 34602ac6454SAndrew Thompson #endif 34702ac6454SAndrew Thompson 34802ac6454SAndrew Thompson static int 34902ac6454SAndrew Thompson udav_csr_read(struct udav_softc *sc, uint16_t offset, void *buf, int len) 35002ac6454SAndrew Thompson { 351760bc48eSAndrew Thompson struct usb_device_request req; 35202ac6454SAndrew Thompson 35302ac6454SAndrew Thompson len &= 0xff; 35402ac6454SAndrew Thompson 35502ac6454SAndrew Thompson req.bmRequestType = UT_READ_VENDOR_DEVICE; 35602ac6454SAndrew Thompson req.bRequest = UDAV_REQ_REG_READ; 35702ac6454SAndrew Thompson USETW(req.wValue, 0x0000); 35802ac6454SAndrew Thompson USETW(req.wIndex, offset); 35902ac6454SAndrew Thompson USETW(req.wLength, len); 36002ac6454SAndrew Thompson 361a593f6b8SAndrew Thompson return (uether_do_request(&sc->sc_ue, &req, buf, 1000)); 36202ac6454SAndrew Thompson } 36302ac6454SAndrew Thompson 36402ac6454SAndrew Thompson static int 36502ac6454SAndrew Thompson udav_csr_write(struct udav_softc *sc, uint16_t offset, void *buf, int len) 36602ac6454SAndrew Thompson { 367760bc48eSAndrew Thompson struct usb_device_request req; 36802ac6454SAndrew Thompson 36902ac6454SAndrew Thompson offset &= 0xff; 37002ac6454SAndrew Thompson len &= 0xff; 37102ac6454SAndrew Thompson 37202ac6454SAndrew Thompson req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 37302ac6454SAndrew Thompson req.bRequest = UDAV_REQ_REG_WRITE; 37402ac6454SAndrew Thompson USETW(req.wValue, 0x0000); 37502ac6454SAndrew Thompson USETW(req.wIndex, offset); 37602ac6454SAndrew Thompson USETW(req.wLength, len); 37702ac6454SAndrew Thompson 378a593f6b8SAndrew Thompson return (uether_do_request(&sc->sc_ue, &req, buf, 1000)); 37902ac6454SAndrew Thompson } 38002ac6454SAndrew Thompson 38102ac6454SAndrew Thompson static uint8_t 38202ac6454SAndrew Thompson udav_csr_read1(struct udav_softc *sc, uint16_t offset) 38302ac6454SAndrew Thompson { 38402ac6454SAndrew Thompson uint8_t val; 38502ac6454SAndrew Thompson 38602ac6454SAndrew Thompson udav_csr_read(sc, offset, &val, 1); 38702ac6454SAndrew Thompson return (val); 38802ac6454SAndrew Thompson } 38902ac6454SAndrew Thompson 39002ac6454SAndrew Thompson static int 39102ac6454SAndrew Thompson udav_csr_write1(struct udav_softc *sc, uint16_t offset, 39202ac6454SAndrew Thompson uint8_t ch) 39302ac6454SAndrew Thompson { 394760bc48eSAndrew Thompson struct usb_device_request req; 39502ac6454SAndrew Thompson 39602ac6454SAndrew Thompson offset &= 0xff; 39702ac6454SAndrew Thompson 39802ac6454SAndrew Thompson req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 39902ac6454SAndrew Thompson req.bRequest = UDAV_REQ_REG_WRITE1; 40002ac6454SAndrew Thompson USETW(req.wValue, ch); 40102ac6454SAndrew Thompson USETW(req.wIndex, offset); 40202ac6454SAndrew Thompson USETW(req.wLength, 0x0000); 40302ac6454SAndrew Thompson 404a593f6b8SAndrew Thompson return (uether_do_request(&sc->sc_ue, &req, NULL, 1000)); 40502ac6454SAndrew Thompson } 40602ac6454SAndrew Thompson 40702ac6454SAndrew Thompson static void 408760bc48eSAndrew Thompson udav_init(struct usb_ether *ue) 40902ac6454SAndrew Thompson { 41002ac6454SAndrew Thompson struct udav_softc *sc = ue->ue_sc; 411a593f6b8SAndrew Thompson struct ifnet *ifp = uether_getifp(&sc->sc_ue); 41202ac6454SAndrew Thompson 41302ac6454SAndrew Thompson UDAV_LOCK_ASSERT(sc, MA_OWNED); 41402ac6454SAndrew Thompson 41502ac6454SAndrew Thompson /* 41602ac6454SAndrew Thompson * Cancel pending I/O 41702ac6454SAndrew Thompson */ 41802ac6454SAndrew Thompson udav_stop(ue); 41902ac6454SAndrew Thompson 42002ac6454SAndrew Thompson /* set MAC address */ 42102ac6454SAndrew Thompson udav_csr_write(sc, UDAV_PAR, IF_LLADDR(ifp), ETHER_ADDR_LEN); 42202ac6454SAndrew Thompson 42302ac6454SAndrew Thompson /* initialize network control register */ 42402ac6454SAndrew Thompson 42502ac6454SAndrew Thompson /* disable loopback */ 42602ac6454SAndrew Thompson UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_LBK0 | UDAV_NCR_LBK1); 42702ac6454SAndrew Thompson 42802ac6454SAndrew Thompson /* Initialize RX control register */ 42902ac6454SAndrew Thompson UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_DIS_LONG | UDAV_RCR_DIS_CRC); 43002ac6454SAndrew Thompson 43102ac6454SAndrew Thompson /* load multicast filter and update promiscious mode bit */ 43202ac6454SAndrew Thompson udav_setpromisc(ue); 43302ac6454SAndrew Thompson 43402ac6454SAndrew Thompson /* enable RX */ 43502ac6454SAndrew Thompson UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_RXEN); 43602ac6454SAndrew Thompson 43702ac6454SAndrew Thompson /* clear POWER_DOWN state of internal PHY */ 43802ac6454SAndrew Thompson UDAV_SETBIT(sc, UDAV_GPCR, UDAV_GPCR_GEP_CNTL0); 43902ac6454SAndrew Thompson UDAV_CLRBIT(sc, UDAV_GPR, UDAV_GPR_GEPIO0); 44002ac6454SAndrew Thompson 441ed6d949aSAndrew Thompson usbd_xfer_set_stall(sc->sc_xfer[UDAV_BULK_DT_WR]); 44202ac6454SAndrew Thompson 44302ac6454SAndrew Thompson ifp->if_drv_flags |= IFF_DRV_RUNNING; 44402ac6454SAndrew Thompson udav_start(ue); 44502ac6454SAndrew Thompson } 44602ac6454SAndrew Thompson 44702ac6454SAndrew Thompson static void 44802ac6454SAndrew Thompson udav_reset(struct udav_softc *sc) 44902ac6454SAndrew Thompson { 45002ac6454SAndrew Thompson int i; 45102ac6454SAndrew Thompson 45202ac6454SAndrew Thompson /* Select PHY */ 45302ac6454SAndrew Thompson #if 1 45402ac6454SAndrew Thompson /* 45502ac6454SAndrew Thompson * XXX: force select internal phy. 45602ac6454SAndrew Thompson * external phy routines are not tested. 45702ac6454SAndrew Thompson */ 45802ac6454SAndrew Thompson UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY); 45902ac6454SAndrew Thompson #else 46002ac6454SAndrew Thompson if (sc->sc_flags & UDAV_EXT_PHY) 46102ac6454SAndrew Thompson UDAV_SETBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY); 46202ac6454SAndrew Thompson else 46302ac6454SAndrew Thompson UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY); 46402ac6454SAndrew Thompson #endif 46502ac6454SAndrew Thompson 46602ac6454SAndrew Thompson UDAV_SETBIT(sc, UDAV_NCR, UDAV_NCR_RST); 46702ac6454SAndrew Thompson 46802ac6454SAndrew Thompson for (i = 0; i < UDAV_TX_TIMEOUT; i++) { 46902ac6454SAndrew Thompson if (!(udav_csr_read1(sc, UDAV_NCR) & UDAV_NCR_RST)) 47002ac6454SAndrew Thompson break; 471a593f6b8SAndrew Thompson if (uether_pause(&sc->sc_ue, hz / 100)) 47202ac6454SAndrew Thompson break; 47302ac6454SAndrew Thompson } 47402ac6454SAndrew Thompson 475a593f6b8SAndrew Thompson uether_pause(&sc->sc_ue, hz / 100); 47602ac6454SAndrew Thompson } 47702ac6454SAndrew Thompson 47802ac6454SAndrew Thompson #define UDAV_BITS 6 47902ac6454SAndrew Thompson static void 480760bc48eSAndrew Thompson udav_setmulti(struct usb_ether *ue) 48102ac6454SAndrew Thompson { 48202ac6454SAndrew Thompson struct udav_softc *sc = ue->ue_sc; 483a593f6b8SAndrew Thompson struct ifnet *ifp = uether_getifp(&sc->sc_ue); 48402ac6454SAndrew Thompson struct ifmultiaddr *ifma; 48502ac6454SAndrew Thompson uint8_t hashtbl[8] = { 0, 0, 0, 0, 0, 0, 0, 0 }; 48602ac6454SAndrew Thompson int h = 0; 48702ac6454SAndrew Thompson 48802ac6454SAndrew Thompson UDAV_LOCK_ASSERT(sc, MA_OWNED); 48902ac6454SAndrew Thompson 49002ac6454SAndrew Thompson if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) { 49102ac6454SAndrew Thompson UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_ALL|UDAV_RCR_PRMSC); 49202ac6454SAndrew Thompson return; 49302ac6454SAndrew Thompson } 49402ac6454SAndrew Thompson 49502ac6454SAndrew Thompson /* first, zot all the existing hash bits */ 49602ac6454SAndrew Thompson memset(hashtbl, 0x00, sizeof(hashtbl)); 49702ac6454SAndrew Thompson hashtbl[7] |= 0x80; /* broadcast address */ 49802ac6454SAndrew Thompson udav_csr_write(sc, UDAV_MAR, hashtbl, sizeof(hashtbl)); 49902ac6454SAndrew Thompson 50002ac6454SAndrew Thompson /* now program new ones */ 501eb956cd0SRobert Watson if_maddr_rlock(ifp); 50202ac6454SAndrew Thompson TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) 50302ac6454SAndrew Thompson { 50402ac6454SAndrew Thompson if (ifma->ifma_addr->sa_family != AF_LINK) 50502ac6454SAndrew Thompson continue; 50602ac6454SAndrew Thompson h = ether_crc32_be(LLADDR((struct sockaddr_dl *) 50702ac6454SAndrew Thompson ifma->ifma_addr), ETHER_ADDR_LEN) >> 26; 50802ac6454SAndrew Thompson hashtbl[h / 8] |= 1 << (h % 8); 50902ac6454SAndrew Thompson } 510eb956cd0SRobert Watson if_maddr_runlock(ifp); 51102ac6454SAndrew Thompson 51202ac6454SAndrew Thompson /* disable all multicast */ 51302ac6454SAndrew Thompson UDAV_CLRBIT(sc, UDAV_RCR, UDAV_RCR_ALL); 51402ac6454SAndrew Thompson 51502ac6454SAndrew Thompson /* write hash value to the register */ 51602ac6454SAndrew Thompson udav_csr_write(sc, UDAV_MAR, hashtbl, sizeof(hashtbl)); 51702ac6454SAndrew Thompson } 51802ac6454SAndrew Thompson 51902ac6454SAndrew Thompson static void 520760bc48eSAndrew Thompson udav_setpromisc(struct usb_ether *ue) 52102ac6454SAndrew Thompson { 52202ac6454SAndrew Thompson struct udav_softc *sc = ue->ue_sc; 523a593f6b8SAndrew Thompson struct ifnet *ifp = uether_getifp(&sc->sc_ue); 52402ac6454SAndrew Thompson uint8_t rxmode; 52502ac6454SAndrew Thompson 52602ac6454SAndrew Thompson rxmode = udav_csr_read1(sc, UDAV_RCR); 52702ac6454SAndrew Thompson rxmode &= ~(UDAV_RCR_ALL | UDAV_RCR_PRMSC); 52802ac6454SAndrew Thompson 52902ac6454SAndrew Thompson if (ifp->if_flags & IFF_PROMISC) 53002ac6454SAndrew Thompson rxmode |= UDAV_RCR_ALL | UDAV_RCR_PRMSC; 53102ac6454SAndrew Thompson else if (ifp->if_flags & IFF_ALLMULTI) 53202ac6454SAndrew Thompson rxmode |= UDAV_RCR_ALL; 53302ac6454SAndrew Thompson 53402ac6454SAndrew Thompson /* write new mode bits */ 53502ac6454SAndrew Thompson udav_csr_write1(sc, UDAV_RCR, rxmode); 53602ac6454SAndrew Thompson } 53702ac6454SAndrew Thompson 53802ac6454SAndrew Thompson static void 539760bc48eSAndrew Thompson udav_start(struct usb_ether *ue) 54002ac6454SAndrew Thompson { 54102ac6454SAndrew Thompson struct udav_softc *sc = ue->ue_sc; 54202ac6454SAndrew Thompson 54302ac6454SAndrew Thompson /* 54402ac6454SAndrew Thompson * start the USB transfers, if not already started: 54502ac6454SAndrew Thompson */ 546a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[UDAV_INTR_DT_RD]); 547a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[UDAV_BULK_DT_RD]); 548a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[UDAV_BULK_DT_WR]); 54902ac6454SAndrew Thompson } 55002ac6454SAndrew Thompson 55102ac6454SAndrew Thompson static void 552ed6d949aSAndrew Thompson udav_bulk_write_callback(struct usb_xfer *xfer, usb_error_t error) 55302ac6454SAndrew Thompson { 554ed6d949aSAndrew Thompson struct udav_softc *sc = usbd_xfer_softc(xfer); 555a593f6b8SAndrew Thompson struct ifnet *ifp = uether_getifp(&sc->sc_ue); 556ed6d949aSAndrew Thompson struct usb_page_cache *pc; 55702ac6454SAndrew Thompson struct mbuf *m; 55802ac6454SAndrew Thompson int extra_len; 55902ac6454SAndrew Thompson int temp_len; 56002ac6454SAndrew Thompson uint8_t buf[2]; 56102ac6454SAndrew Thompson 56202ac6454SAndrew Thompson switch (USB_GET_STATE(xfer)) { 56302ac6454SAndrew Thompson case USB_ST_TRANSFERRED: 56402ac6454SAndrew Thompson DPRINTFN(11, "transfer complete\n"); 56502ac6454SAndrew Thompson ifp->if_opackets++; 56602ac6454SAndrew Thompson 56702ac6454SAndrew Thompson /* FALLTHROUGH */ 56802ac6454SAndrew Thompson case USB_ST_SETUP: 56902ac6454SAndrew Thompson tr_setup: 57002ac6454SAndrew Thompson if ((sc->sc_flags & UDAV_FLAG_LINK) == 0) { 57102ac6454SAndrew Thompson /* 57202ac6454SAndrew Thompson * don't send anything if there is no link ! 57302ac6454SAndrew Thompson */ 57402ac6454SAndrew Thompson return; 57502ac6454SAndrew Thompson } 57602ac6454SAndrew Thompson IFQ_DRV_DEQUEUE(&ifp->if_snd, m); 57702ac6454SAndrew Thompson 57802ac6454SAndrew Thompson if (m == NULL) 57902ac6454SAndrew Thompson return; 58002ac6454SAndrew Thompson if (m->m_pkthdr.len > MCLBYTES) 58102ac6454SAndrew Thompson m->m_pkthdr.len = MCLBYTES; 58202ac6454SAndrew Thompson if (m->m_pkthdr.len < UDAV_MIN_FRAME_LEN) { 58302ac6454SAndrew Thompson extra_len = UDAV_MIN_FRAME_LEN - m->m_pkthdr.len; 58402ac6454SAndrew Thompson } else { 58502ac6454SAndrew Thompson extra_len = 0; 58602ac6454SAndrew Thompson } 58702ac6454SAndrew Thompson 58802ac6454SAndrew Thompson temp_len = (m->m_pkthdr.len + extra_len); 58902ac6454SAndrew Thompson 59002ac6454SAndrew Thompson /* 59102ac6454SAndrew Thompson * the frame length is specified in the first 2 bytes of the 59202ac6454SAndrew Thompson * buffer 59302ac6454SAndrew Thompson */ 59402ac6454SAndrew Thompson buf[0] = (uint8_t)(temp_len); 59502ac6454SAndrew Thompson buf[1] = (uint8_t)(temp_len >> 8); 59602ac6454SAndrew Thompson 59702ac6454SAndrew Thompson temp_len += 2; 59802ac6454SAndrew Thompson 599ed6d949aSAndrew Thompson pc = usbd_xfer_get_frame(xfer, 0); 600ed6d949aSAndrew Thompson usbd_copy_in(pc, 0, buf, 2); 601ed6d949aSAndrew Thompson usbd_m_copy_in(pc, 2, m, 0, m->m_pkthdr.len); 60202ac6454SAndrew Thompson 603ed6d949aSAndrew Thompson if (extra_len) 604ed6d949aSAndrew Thompson usbd_frame_zero(pc, temp_len - extra_len, extra_len); 60502ac6454SAndrew Thompson /* 60602ac6454SAndrew Thompson * if there's a BPF listener, bounce a copy 60702ac6454SAndrew Thompson * of this frame to him: 60802ac6454SAndrew Thompson */ 60902ac6454SAndrew Thompson BPF_MTAP(ifp, m); 61002ac6454SAndrew Thompson 61102ac6454SAndrew Thompson m_freem(m); 61202ac6454SAndrew Thompson 613ed6d949aSAndrew Thompson usbd_xfer_set_frame_len(xfer, 0, temp_len); 614a593f6b8SAndrew Thompson usbd_transfer_submit(xfer); 61502ac6454SAndrew Thompson return; 61602ac6454SAndrew Thompson 61702ac6454SAndrew Thompson default: /* Error */ 61802ac6454SAndrew Thompson DPRINTFN(11, "transfer error, %s\n", 619ed6d949aSAndrew Thompson usbd_errstr(error)); 62002ac6454SAndrew Thompson 62102ac6454SAndrew Thompson ifp->if_oerrors++; 62202ac6454SAndrew Thompson 623ed6d949aSAndrew Thompson if (error != USB_ERR_CANCELLED) { 62402ac6454SAndrew Thompson /* try to clear stall first */ 625ed6d949aSAndrew Thompson usbd_xfer_set_stall(xfer); 62602ac6454SAndrew Thompson goto tr_setup; 62702ac6454SAndrew Thompson } 62802ac6454SAndrew Thompson return; 62902ac6454SAndrew Thompson } 63002ac6454SAndrew Thompson } 63102ac6454SAndrew Thompson 63202ac6454SAndrew Thompson static void 633ed6d949aSAndrew Thompson udav_bulk_read_callback(struct usb_xfer *xfer, usb_error_t error) 63402ac6454SAndrew Thompson { 635ed6d949aSAndrew Thompson struct udav_softc *sc = usbd_xfer_softc(xfer); 636760bc48eSAndrew Thompson struct usb_ether *ue = &sc->sc_ue; 637a593f6b8SAndrew Thompson struct ifnet *ifp = uether_getifp(ue); 638ed6d949aSAndrew Thompson struct usb_page_cache *pc; 63902ac6454SAndrew Thompson struct udav_rxpkt stat; 64002ac6454SAndrew Thompson int len; 641ed6d949aSAndrew Thompson int actlen; 642ed6d949aSAndrew Thompson 643ed6d949aSAndrew Thompson usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL); 64402ac6454SAndrew Thompson 64502ac6454SAndrew Thompson switch (USB_GET_STATE(xfer)) { 64602ac6454SAndrew Thompson case USB_ST_TRANSFERRED: 64702ac6454SAndrew Thompson 648ed6d949aSAndrew Thompson if (actlen < sizeof(stat) + ETHER_CRC_LEN) { 64902ac6454SAndrew Thompson ifp->if_ierrors++; 65002ac6454SAndrew Thompson goto tr_setup; 65102ac6454SAndrew Thompson } 652ed6d949aSAndrew Thompson pc = usbd_xfer_get_frame(xfer, 0); 653ed6d949aSAndrew Thompson usbd_copy_out(pc, 0, &stat, sizeof(stat)); 654ed6d949aSAndrew Thompson actlen -= sizeof(stat); 655ed6d949aSAndrew Thompson len = min(actlen, le16toh(stat.pktlen)); 65602ac6454SAndrew Thompson len -= ETHER_CRC_LEN; 65702ac6454SAndrew Thompson 65802ac6454SAndrew Thompson if (stat.rxstat & UDAV_RSR_LCS) { 65902ac6454SAndrew Thompson ifp->if_collisions++; 66002ac6454SAndrew Thompson goto tr_setup; 66102ac6454SAndrew Thompson } 66202ac6454SAndrew Thompson if (stat.rxstat & UDAV_RSR_ERR) { 66302ac6454SAndrew Thompson ifp->if_ierrors++; 66402ac6454SAndrew Thompson goto tr_setup; 66502ac6454SAndrew Thompson } 666ed6d949aSAndrew Thompson uether_rxbuf(ue, pc, sizeof(stat), len); 66702ac6454SAndrew Thompson /* FALLTHROUGH */ 66802ac6454SAndrew Thompson case USB_ST_SETUP: 66902ac6454SAndrew Thompson tr_setup: 670ed6d949aSAndrew Thompson usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer)); 671a593f6b8SAndrew Thompson usbd_transfer_submit(xfer); 672a593f6b8SAndrew Thompson uether_rxflush(ue); 67302ac6454SAndrew Thompson return; 67402ac6454SAndrew Thompson 67502ac6454SAndrew Thompson default: /* Error */ 67602ac6454SAndrew Thompson DPRINTF("bulk read error, %s\n", 677ed6d949aSAndrew Thompson usbd_errstr(error)); 67802ac6454SAndrew Thompson 679ed6d949aSAndrew Thompson if (error != USB_ERR_CANCELLED) { 68002ac6454SAndrew Thompson /* try to clear stall first */ 681ed6d949aSAndrew Thompson usbd_xfer_set_stall(xfer); 68202ac6454SAndrew Thompson goto tr_setup; 68302ac6454SAndrew Thompson } 68402ac6454SAndrew Thompson return; 68502ac6454SAndrew Thompson } 68602ac6454SAndrew Thompson } 68702ac6454SAndrew Thompson 68802ac6454SAndrew Thompson static void 689ed6d949aSAndrew Thompson udav_intr_callback(struct usb_xfer *xfer, usb_error_t error) 69002ac6454SAndrew Thompson { 69102ac6454SAndrew Thompson switch (USB_GET_STATE(xfer)) { 69202ac6454SAndrew Thompson case USB_ST_TRANSFERRED: 69302ac6454SAndrew Thompson case USB_ST_SETUP: 69402ac6454SAndrew Thompson tr_setup: 695ed6d949aSAndrew Thompson usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer)); 696a593f6b8SAndrew Thompson usbd_transfer_submit(xfer); 69702ac6454SAndrew Thompson return; 69802ac6454SAndrew Thompson 69902ac6454SAndrew Thompson default: /* Error */ 700ed6d949aSAndrew Thompson if (error != USB_ERR_CANCELLED) { 70102ac6454SAndrew Thompson /* try to clear stall first */ 702ed6d949aSAndrew Thompson usbd_xfer_set_stall(xfer); 70302ac6454SAndrew Thompson goto tr_setup; 70402ac6454SAndrew Thompson } 70502ac6454SAndrew Thompson return; 70602ac6454SAndrew Thompson } 70702ac6454SAndrew Thompson } 70802ac6454SAndrew Thompson 70902ac6454SAndrew Thompson static void 710760bc48eSAndrew Thompson udav_stop(struct usb_ether *ue) 71102ac6454SAndrew Thompson { 71202ac6454SAndrew Thompson struct udav_softc *sc = ue->ue_sc; 713a593f6b8SAndrew Thompson struct ifnet *ifp = uether_getifp(&sc->sc_ue); 71402ac6454SAndrew Thompson 71502ac6454SAndrew Thompson UDAV_LOCK_ASSERT(sc, MA_OWNED); 71602ac6454SAndrew Thompson 71702ac6454SAndrew Thompson ifp->if_drv_flags &= ~IFF_DRV_RUNNING; 71802ac6454SAndrew Thompson sc->sc_flags &= ~UDAV_FLAG_LINK; 71902ac6454SAndrew Thompson 72002ac6454SAndrew Thompson /* 72102ac6454SAndrew Thompson * stop all the transfers, if not already stopped: 72202ac6454SAndrew Thompson */ 723a593f6b8SAndrew Thompson usbd_transfer_stop(sc->sc_xfer[UDAV_BULK_DT_WR]); 724a593f6b8SAndrew Thompson usbd_transfer_stop(sc->sc_xfer[UDAV_BULK_DT_RD]); 725a593f6b8SAndrew Thompson usbd_transfer_stop(sc->sc_xfer[UDAV_INTR_DT_RD]); 72602ac6454SAndrew Thompson 72702ac6454SAndrew Thompson udav_reset(sc); 72802ac6454SAndrew Thompson } 72902ac6454SAndrew Thompson 73002ac6454SAndrew Thompson static int 73102ac6454SAndrew Thompson udav_ifmedia_upd(struct ifnet *ifp) 73202ac6454SAndrew Thompson { 73302ac6454SAndrew Thompson struct udav_softc *sc = ifp->if_softc; 73402ac6454SAndrew Thompson struct mii_data *mii = GET_MII(sc); 7353fcb7a53SMarius Strobl struct mii_softc *miisc; 73602ac6454SAndrew Thompson 73702ac6454SAndrew Thompson UDAV_LOCK_ASSERT(sc, MA_OWNED); 73802ac6454SAndrew Thompson 73902ac6454SAndrew Thompson sc->sc_flags &= ~UDAV_FLAG_LINK; 74002ac6454SAndrew Thompson LIST_FOREACH(miisc, &mii->mii_phys, mii_list) 7413fcb7a53SMarius Strobl PHY_RESET(miisc); 74202ac6454SAndrew Thompson mii_mediachg(mii); 74302ac6454SAndrew Thompson return (0); 74402ac6454SAndrew Thompson } 74502ac6454SAndrew Thompson 74602ac6454SAndrew Thompson static void 74702ac6454SAndrew Thompson udav_ifmedia_status(struct ifnet *ifp, struct ifmediareq *ifmr) 74802ac6454SAndrew Thompson { 74902ac6454SAndrew Thompson struct udav_softc *sc = ifp->if_softc; 75002ac6454SAndrew Thompson struct mii_data *mii = GET_MII(sc); 75102ac6454SAndrew Thompson 75202ac6454SAndrew Thompson UDAV_LOCK(sc); 75302ac6454SAndrew Thompson mii_pollstat(mii); 75402ac6454SAndrew Thompson ifmr->ifm_active = mii->mii_media_active; 75502ac6454SAndrew Thompson ifmr->ifm_status = mii->mii_media_status; 756*e9e549efSPyun YongHyeon UDAV_UNLOCK(sc); 75702ac6454SAndrew Thompson } 75802ac6454SAndrew Thompson 75902ac6454SAndrew Thompson static void 760760bc48eSAndrew Thompson udav_tick(struct usb_ether *ue) 76102ac6454SAndrew Thompson { 76202ac6454SAndrew Thompson struct udav_softc *sc = ue->ue_sc; 76302ac6454SAndrew Thompson struct mii_data *mii = GET_MII(sc); 76402ac6454SAndrew Thompson 76502ac6454SAndrew Thompson UDAV_LOCK_ASSERT(sc, MA_OWNED); 76602ac6454SAndrew Thompson 76702ac6454SAndrew Thompson mii_tick(mii); 76802ac6454SAndrew Thompson if ((sc->sc_flags & UDAV_FLAG_LINK) == 0 76902ac6454SAndrew Thompson && mii->mii_media_status & IFM_ACTIVE && 77002ac6454SAndrew Thompson IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) { 77102ac6454SAndrew Thompson sc->sc_flags |= UDAV_FLAG_LINK; 77202ac6454SAndrew Thompson udav_start(ue); 77302ac6454SAndrew Thompson } 77402ac6454SAndrew Thompson } 77502ac6454SAndrew Thompson 77602ac6454SAndrew Thompson static int 77702ac6454SAndrew Thompson udav_miibus_readreg(device_t dev, int phy, int reg) 77802ac6454SAndrew Thompson { 77902ac6454SAndrew Thompson struct udav_softc *sc = device_get_softc(dev); 78002ac6454SAndrew Thompson uint16_t data16; 78102ac6454SAndrew Thompson uint8_t val[2]; 78202ac6454SAndrew Thompson int locked; 78302ac6454SAndrew Thompson 78402ac6454SAndrew Thompson /* XXX: one PHY only for the internal PHY */ 78502ac6454SAndrew Thompson if (phy != 0) 78602ac6454SAndrew Thompson return (0); 78702ac6454SAndrew Thompson 78802ac6454SAndrew Thompson locked = mtx_owned(&sc->sc_mtx); 78902ac6454SAndrew Thompson if (!locked) 79002ac6454SAndrew Thompson UDAV_LOCK(sc); 79102ac6454SAndrew Thompson 79202ac6454SAndrew Thompson /* select internal PHY and set PHY register address */ 79302ac6454SAndrew Thompson udav_csr_write1(sc, UDAV_EPAR, 79402ac6454SAndrew Thompson UDAV_EPAR_PHY_ADR0 | (reg & UDAV_EPAR_EROA_MASK)); 79502ac6454SAndrew Thompson 79602ac6454SAndrew Thompson /* select PHY operation and start read command */ 79702ac6454SAndrew Thompson udav_csr_write1(sc, UDAV_EPCR, UDAV_EPCR_EPOS | UDAV_EPCR_ERPRR); 79802ac6454SAndrew Thompson 79902ac6454SAndrew Thompson /* XXX: should we wait? */ 80002ac6454SAndrew Thompson 80102ac6454SAndrew Thompson /* end read command */ 80202ac6454SAndrew Thompson UDAV_CLRBIT(sc, UDAV_EPCR, UDAV_EPCR_ERPRR); 80302ac6454SAndrew Thompson 80402ac6454SAndrew Thompson /* retrieve the result from data registers */ 80502ac6454SAndrew Thompson udav_csr_read(sc, UDAV_EPDRL, val, 2); 80602ac6454SAndrew Thompson 80702ac6454SAndrew Thompson data16 = (val[0] | (val[1] << 8)); 80802ac6454SAndrew Thompson 80902ac6454SAndrew Thompson DPRINTFN(11, "phy=%d reg=0x%04x => 0x%04x\n", 81002ac6454SAndrew Thompson phy, reg, data16); 81102ac6454SAndrew Thompson 81202ac6454SAndrew Thompson if (!locked) 81302ac6454SAndrew Thompson UDAV_UNLOCK(sc); 81402ac6454SAndrew Thompson return (data16); 81502ac6454SAndrew Thompson } 81602ac6454SAndrew Thompson 81702ac6454SAndrew Thompson static int 81802ac6454SAndrew Thompson udav_miibus_writereg(device_t dev, int phy, int reg, int data) 81902ac6454SAndrew Thompson { 82002ac6454SAndrew Thompson struct udav_softc *sc = device_get_softc(dev); 82102ac6454SAndrew Thompson uint8_t val[2]; 82202ac6454SAndrew Thompson int locked; 82302ac6454SAndrew Thompson 82402ac6454SAndrew Thompson /* XXX: one PHY only for the internal PHY */ 82502ac6454SAndrew Thompson if (phy != 0) 82602ac6454SAndrew Thompson return (0); 82702ac6454SAndrew Thompson 82802ac6454SAndrew Thompson locked = mtx_owned(&sc->sc_mtx); 82902ac6454SAndrew Thompson if (!locked) 83002ac6454SAndrew Thompson UDAV_LOCK(sc); 83102ac6454SAndrew Thompson 83202ac6454SAndrew Thompson /* select internal PHY and set PHY register address */ 83302ac6454SAndrew Thompson udav_csr_write1(sc, UDAV_EPAR, 83402ac6454SAndrew Thompson UDAV_EPAR_PHY_ADR0 | (reg & UDAV_EPAR_EROA_MASK)); 83502ac6454SAndrew Thompson 83602ac6454SAndrew Thompson /* put the value to the data registers */ 83702ac6454SAndrew Thompson val[0] = (data & 0xff); 83802ac6454SAndrew Thompson val[1] = (data >> 8) & 0xff; 83902ac6454SAndrew Thompson udav_csr_write(sc, UDAV_EPDRL, val, 2); 84002ac6454SAndrew Thompson 84102ac6454SAndrew Thompson /* select PHY operation and start write command */ 84202ac6454SAndrew Thompson udav_csr_write1(sc, UDAV_EPCR, UDAV_EPCR_EPOS | UDAV_EPCR_ERPRW); 84302ac6454SAndrew Thompson 84402ac6454SAndrew Thompson /* XXX: should we wait? */ 84502ac6454SAndrew Thompson 84602ac6454SAndrew Thompson /* end write command */ 84702ac6454SAndrew Thompson UDAV_CLRBIT(sc, UDAV_EPCR, UDAV_EPCR_ERPRW); 84802ac6454SAndrew Thompson 84902ac6454SAndrew Thompson if (!locked) 85002ac6454SAndrew Thompson UDAV_UNLOCK(sc); 85102ac6454SAndrew Thompson return (0); 85202ac6454SAndrew Thompson } 85302ac6454SAndrew Thompson 85402ac6454SAndrew Thompson static void 85502ac6454SAndrew Thompson udav_miibus_statchg(device_t dev) 85602ac6454SAndrew Thompson { 85702ac6454SAndrew Thompson /* nothing to do */ 85802ac6454SAndrew Thompson } 859