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/linker_set.h> 58ed6d949aSAndrew Thompson #include <sys/module.h> 59ed6d949aSAndrew Thompson #include <sys/lock.h> 60ed6d949aSAndrew Thompson #include <sys/mutex.h> 61ed6d949aSAndrew Thompson #include <sys/condvar.h> 62ed6d949aSAndrew Thompson #include <sys/sysctl.h> 63ed6d949aSAndrew Thompson #include <sys/sx.h> 64ed6d949aSAndrew Thompson #include <sys/unistd.h> 65ed6d949aSAndrew Thompson #include <sys/callout.h> 66ed6d949aSAndrew Thompson #include <sys/malloc.h> 67ed6d949aSAndrew Thompson #include <sys/priv.h> 68ed6d949aSAndrew Thompson 6902ac6454SAndrew Thompson #include <dev/usb/usb.h> 70ed6d949aSAndrew Thompson #include <dev/usb/usbdi.h> 71ed6d949aSAndrew Thompson #include <dev/usb/usbdi_util.h> 72ed6d949aSAndrew Thompson #include "usbdevs.h" 7302ac6454SAndrew Thompson 7402ac6454SAndrew Thompson #define USB_DEBUG_VAR udav_debug 7502ac6454SAndrew Thompson #include <dev/usb/usb_debug.h> 76ed6d949aSAndrew Thompson #include <dev/usb/usb_process.h> 7702ac6454SAndrew Thompson 7802ac6454SAndrew Thompson #include <dev/usb/net/usb_ethernet.h> 7902ac6454SAndrew Thompson #include <dev/usb/net/if_udavreg.h> 8002ac6454SAndrew Thompson 8102ac6454SAndrew Thompson /* prototypes */ 8202ac6454SAndrew Thompson 8302ac6454SAndrew Thompson static device_probe_t udav_probe; 8402ac6454SAndrew Thompson static device_attach_t udav_attach; 8502ac6454SAndrew Thompson static device_detach_t udav_detach; 8602ac6454SAndrew Thompson 87e0a69b51SAndrew Thompson static usb_callback_t udav_bulk_write_callback; 88e0a69b51SAndrew Thompson static usb_callback_t udav_bulk_read_callback; 89e0a69b51SAndrew Thompson static usb_callback_t udav_intr_callback; 9002ac6454SAndrew Thompson 91e0a69b51SAndrew Thompson static uether_fn_t udav_attach_post; 92e0a69b51SAndrew Thompson static uether_fn_t udav_init; 93e0a69b51SAndrew Thompson static uether_fn_t udav_stop; 94e0a69b51SAndrew Thompson static uether_fn_t udav_start; 95e0a69b51SAndrew Thompson static uether_fn_t udav_tick; 96e0a69b51SAndrew Thompson static uether_fn_t udav_setmulti; 97e0a69b51SAndrew Thompson static uether_fn_t udav_setpromisc; 9802ac6454SAndrew Thompson 9902ac6454SAndrew Thompson static int udav_csr_read(struct udav_softc *, uint16_t, void *, int); 10002ac6454SAndrew Thompson static int udav_csr_write(struct udav_softc *, uint16_t, void *, int); 10102ac6454SAndrew Thompson static uint8_t udav_csr_read1(struct udav_softc *, uint16_t); 10202ac6454SAndrew Thompson static int udav_csr_write1(struct udav_softc *, uint16_t, uint8_t); 10302ac6454SAndrew Thompson static void udav_reset(struct udav_softc *); 10402ac6454SAndrew Thompson static int udav_ifmedia_upd(struct ifnet *); 10502ac6454SAndrew Thompson static void udav_ifmedia_status(struct ifnet *, struct ifmediareq *); 10602ac6454SAndrew Thompson 10702ac6454SAndrew Thompson static miibus_readreg_t udav_miibus_readreg; 10802ac6454SAndrew Thompson static miibus_writereg_t udav_miibus_writereg; 10902ac6454SAndrew Thompson static miibus_statchg_t udav_miibus_statchg; 11002ac6454SAndrew Thompson 111760bc48eSAndrew Thompson static const struct usb_config udav_config[UDAV_N_TRANSFER] = { 11202ac6454SAndrew Thompson 11302ac6454SAndrew Thompson [UDAV_BULK_DT_WR] = { 11402ac6454SAndrew Thompson .type = UE_BULK, 11502ac6454SAndrew Thompson .endpoint = UE_ADDR_ANY, 11602ac6454SAndrew Thompson .direction = UE_DIR_OUT, 1174eae601eSAndrew Thompson .bufsize = (MCLBYTES + 2), 1184eae601eSAndrew Thompson .flags = {.pipe_bof = 1,.force_short_xfer = 1,}, 1194eae601eSAndrew Thompson .callback = udav_bulk_write_callback, 1204eae601eSAndrew Thompson .timeout = 10000, /* 10 seconds */ 12102ac6454SAndrew Thompson }, 12202ac6454SAndrew Thompson 12302ac6454SAndrew Thompson [UDAV_BULK_DT_RD] = { 12402ac6454SAndrew Thompson .type = UE_BULK, 12502ac6454SAndrew Thompson .endpoint = UE_ADDR_ANY, 12602ac6454SAndrew Thompson .direction = UE_DIR_IN, 1274eae601eSAndrew Thompson .bufsize = (MCLBYTES + 3), 1284eae601eSAndrew Thompson .flags = {.pipe_bof = 1,.short_xfer_ok = 1,}, 1294eae601eSAndrew Thompson .callback = udav_bulk_read_callback, 1304eae601eSAndrew Thompson .timeout = 0, /* no timeout */ 13102ac6454SAndrew Thompson }, 13202ac6454SAndrew Thompson 13302ac6454SAndrew Thompson [UDAV_INTR_DT_RD] = { 13402ac6454SAndrew Thompson .type = UE_INTERRUPT, 13502ac6454SAndrew Thompson .endpoint = UE_ADDR_ANY, 13602ac6454SAndrew Thompson .direction = UE_DIR_IN, 1374eae601eSAndrew Thompson .flags = {.pipe_bof = 1,.short_xfer_ok = 1,}, 1384eae601eSAndrew Thompson .bufsize = 0, /* use wMaxPacketSize */ 1394eae601eSAndrew Thompson .callback = udav_intr_callback, 14002ac6454SAndrew Thompson }, 14102ac6454SAndrew Thompson }; 14202ac6454SAndrew Thompson 14302ac6454SAndrew Thompson static device_method_t udav_methods[] = { 14402ac6454SAndrew Thompson /* Device interface */ 14502ac6454SAndrew Thompson DEVMETHOD(device_probe, udav_probe), 14602ac6454SAndrew Thompson DEVMETHOD(device_attach, udav_attach), 14702ac6454SAndrew Thompson DEVMETHOD(device_detach, udav_detach), 14802ac6454SAndrew Thompson 14902ac6454SAndrew Thompson /* bus interface */ 15002ac6454SAndrew Thompson DEVMETHOD(bus_print_child, bus_generic_print_child), 15102ac6454SAndrew Thompson DEVMETHOD(bus_driver_added, bus_generic_driver_added), 15202ac6454SAndrew Thompson 15302ac6454SAndrew Thompson /* MII interface */ 15402ac6454SAndrew Thompson DEVMETHOD(miibus_readreg, udav_miibus_readreg), 15502ac6454SAndrew Thompson DEVMETHOD(miibus_writereg, udav_miibus_writereg), 15602ac6454SAndrew Thompson DEVMETHOD(miibus_statchg, udav_miibus_statchg), 15702ac6454SAndrew Thompson 15802ac6454SAndrew Thompson {0, 0} 15902ac6454SAndrew Thompson }; 16002ac6454SAndrew Thompson 16102ac6454SAndrew Thompson static driver_t udav_driver = { 16202ac6454SAndrew Thompson .name = "udav", 16302ac6454SAndrew Thompson .methods = udav_methods, 16402ac6454SAndrew Thompson .size = sizeof(struct udav_softc), 16502ac6454SAndrew Thompson }; 16602ac6454SAndrew Thompson 16702ac6454SAndrew Thompson static devclass_t udav_devclass; 16802ac6454SAndrew Thompson 1699aef556dSAndrew Thompson DRIVER_MODULE(udav, uhub, udav_driver, udav_devclass, NULL, 0); 17002ac6454SAndrew Thompson DRIVER_MODULE(miibus, udav, miibus_driver, miibus_devclass, 0, 0); 17102ac6454SAndrew Thompson MODULE_DEPEND(udav, uether, 1, 1, 1); 17202ac6454SAndrew Thompson MODULE_DEPEND(udav, usb, 1, 1, 1); 17302ac6454SAndrew Thompson MODULE_DEPEND(udav, ether, 1, 1, 1); 17402ac6454SAndrew Thompson MODULE_DEPEND(udav, miibus, 1, 1, 1); 17502ac6454SAndrew Thompson 176760bc48eSAndrew Thompson static const struct usb_ether_methods udav_ue_methods = { 17702ac6454SAndrew Thompson .ue_attach_post = udav_attach_post, 17802ac6454SAndrew Thompson .ue_start = udav_start, 17902ac6454SAndrew Thompson .ue_init = udav_init, 18002ac6454SAndrew Thompson .ue_stop = udav_stop, 18102ac6454SAndrew Thompson .ue_tick = udav_tick, 18202ac6454SAndrew Thompson .ue_setmulti = udav_setmulti, 18302ac6454SAndrew Thompson .ue_setpromisc = udav_setpromisc, 18402ac6454SAndrew Thompson .ue_mii_upd = udav_ifmedia_upd, 18502ac6454SAndrew Thompson .ue_mii_sts = udav_ifmedia_status, 18602ac6454SAndrew Thompson }; 18702ac6454SAndrew Thompson 18802ac6454SAndrew Thompson #if USB_DEBUG 18902ac6454SAndrew Thompson static int udav_debug = 0; 19002ac6454SAndrew Thompson 1919360ae40SAndrew Thompson SYSCTL_NODE(_hw_usb, OID_AUTO, udav, CTLFLAG_RW, 0, "USB udav"); 1929360ae40SAndrew Thompson SYSCTL_INT(_hw_usb_udav, OID_AUTO, debug, CTLFLAG_RW, &udav_debug, 0, 19302ac6454SAndrew Thompson "Debug level"); 19402ac6454SAndrew Thompson #endif 19502ac6454SAndrew Thompson 19602ac6454SAndrew Thompson #define UDAV_SETBIT(sc, reg, x) \ 19702ac6454SAndrew Thompson udav_csr_write1(sc, reg, udav_csr_read1(sc, reg) | (x)) 19802ac6454SAndrew Thompson 19902ac6454SAndrew Thompson #define UDAV_CLRBIT(sc, reg, x) \ 20002ac6454SAndrew Thompson udav_csr_write1(sc, reg, udav_csr_read1(sc, reg) & ~(x)) 20102ac6454SAndrew Thompson 202760bc48eSAndrew Thompson static const struct usb_device_id udav_devs[] = { 20302ac6454SAndrew Thompson /* ShanTou DM9601 USB NIC */ 20402ac6454SAndrew Thompson {USB_VPI(USB_VENDOR_SHANTOU, USB_PRODUCT_SHANTOU_DM9601, 0)}, 20502ac6454SAndrew Thompson /* ShanTou ST268 USB NIC */ 20602ac6454SAndrew Thompson {USB_VPI(USB_VENDOR_SHANTOU, USB_PRODUCT_SHANTOU_ST268, 0)}, 20702ac6454SAndrew Thompson /* Corega USB-TXC */ 20802ac6454SAndrew Thompson {USB_VPI(USB_VENDOR_COREGA, USB_PRODUCT_COREGA_FETHER_USB_TXC, 0)}, 20902ac6454SAndrew Thompson }; 21002ac6454SAndrew Thompson 21102ac6454SAndrew Thompson static void 212760bc48eSAndrew Thompson udav_attach_post(struct usb_ether *ue) 21302ac6454SAndrew Thompson { 214a593f6b8SAndrew Thompson struct udav_softc *sc = uether_getsc(ue); 21502ac6454SAndrew Thompson 21602ac6454SAndrew Thompson /* reset the adapter */ 21702ac6454SAndrew Thompson udav_reset(sc); 21802ac6454SAndrew Thompson 21902ac6454SAndrew Thompson /* Get Ethernet Address */ 22002ac6454SAndrew Thompson udav_csr_read(sc, UDAV_PAR, ue->ue_eaddr, ETHER_ADDR_LEN); 22102ac6454SAndrew Thompson } 22202ac6454SAndrew Thompson 22302ac6454SAndrew Thompson static int 22402ac6454SAndrew Thompson udav_probe(device_t dev) 22502ac6454SAndrew Thompson { 226760bc48eSAndrew Thompson struct usb_attach_arg *uaa = device_get_ivars(dev); 22702ac6454SAndrew Thompson 228f29a0724SAndrew Thompson if (uaa->usb_mode != USB_MODE_HOST) 22902ac6454SAndrew Thompson return (ENXIO); 23002ac6454SAndrew Thompson if (uaa->info.bConfigIndex != UDAV_CONFIG_INDEX) 23102ac6454SAndrew Thompson return (ENXIO); 23202ac6454SAndrew Thompson if (uaa->info.bIfaceIndex != UDAV_IFACE_INDEX) 23302ac6454SAndrew Thompson return (ENXIO); 23402ac6454SAndrew Thompson 235a593f6b8SAndrew Thompson return (usbd_lookup_id_by_uaa(udav_devs, sizeof(udav_devs), uaa)); 23602ac6454SAndrew Thompson } 23702ac6454SAndrew Thompson 23802ac6454SAndrew Thompson static int 23902ac6454SAndrew Thompson udav_attach(device_t dev) 24002ac6454SAndrew Thompson { 241760bc48eSAndrew Thompson struct usb_attach_arg *uaa = device_get_ivars(dev); 24202ac6454SAndrew Thompson struct udav_softc *sc = device_get_softc(dev); 243760bc48eSAndrew Thompson struct usb_ether *ue = &sc->sc_ue; 24402ac6454SAndrew Thompson uint8_t iface_index; 24502ac6454SAndrew Thompson int error; 24602ac6454SAndrew Thompson 24702ac6454SAndrew Thompson sc->sc_flags = USB_GET_DRIVER_INFO(uaa); 24802ac6454SAndrew Thompson 249a593f6b8SAndrew Thompson device_set_usb_desc(dev); 25002ac6454SAndrew Thompson 25102ac6454SAndrew Thompson mtx_init(&sc->sc_mtx, device_get_nameunit(dev), NULL, MTX_DEF); 25202ac6454SAndrew Thompson 25302ac6454SAndrew Thompson iface_index = UDAV_IFACE_INDEX; 254a593f6b8SAndrew Thompson error = usbd_transfer_setup(uaa->device, &iface_index, 25502ac6454SAndrew Thompson sc->sc_xfer, udav_config, UDAV_N_TRANSFER, sc, &sc->sc_mtx); 25602ac6454SAndrew Thompson if (error) { 257767cb2e2SAndrew Thompson device_printf(dev, "allocating USB transfers failed\n"); 25802ac6454SAndrew Thompson goto detach; 25902ac6454SAndrew Thompson } 26002ac6454SAndrew Thompson 26102ac6454SAndrew Thompson ue->ue_sc = sc; 26202ac6454SAndrew Thompson ue->ue_dev = dev; 26302ac6454SAndrew Thompson ue->ue_udev = uaa->device; 26402ac6454SAndrew Thompson ue->ue_mtx = &sc->sc_mtx; 26502ac6454SAndrew Thompson ue->ue_methods = &udav_ue_methods; 26602ac6454SAndrew Thompson 267a593f6b8SAndrew Thompson error = uether_ifattach(ue); 26802ac6454SAndrew Thompson if (error) { 26902ac6454SAndrew Thompson device_printf(dev, "could not attach interface\n"); 27002ac6454SAndrew Thompson goto detach; 27102ac6454SAndrew Thompson } 27202ac6454SAndrew Thompson 27302ac6454SAndrew Thompson return (0); /* success */ 27402ac6454SAndrew Thompson 27502ac6454SAndrew Thompson detach: 27602ac6454SAndrew Thompson udav_detach(dev); 27702ac6454SAndrew Thompson return (ENXIO); /* failure */ 27802ac6454SAndrew Thompson } 27902ac6454SAndrew Thompson 28002ac6454SAndrew Thompson static int 28102ac6454SAndrew Thompson udav_detach(device_t dev) 28202ac6454SAndrew Thompson { 28302ac6454SAndrew Thompson struct udav_softc *sc = device_get_softc(dev); 284760bc48eSAndrew Thompson struct usb_ether *ue = &sc->sc_ue; 28502ac6454SAndrew Thompson 286a593f6b8SAndrew Thompson usbd_transfer_unsetup(sc->sc_xfer, UDAV_N_TRANSFER); 287a593f6b8SAndrew Thompson uether_ifdetach(ue); 28802ac6454SAndrew Thompson mtx_destroy(&sc->sc_mtx); 28902ac6454SAndrew Thompson 29002ac6454SAndrew Thompson return (0); 29102ac6454SAndrew Thompson } 29202ac6454SAndrew Thompson 29302ac6454SAndrew Thompson #if 0 29402ac6454SAndrew Thompson static int 29502ac6454SAndrew Thompson udav_mem_read(struct udav_softc *sc, uint16_t offset, void *buf, 29602ac6454SAndrew Thompson int len) 29702ac6454SAndrew Thompson { 298760bc48eSAndrew Thompson struct usb_device_request req; 29902ac6454SAndrew Thompson 30002ac6454SAndrew Thompson len &= 0xff; 30102ac6454SAndrew Thompson 30202ac6454SAndrew Thompson req.bmRequestType = UT_READ_VENDOR_DEVICE; 30302ac6454SAndrew Thompson req.bRequest = UDAV_REQ_MEM_READ; 30402ac6454SAndrew Thompson USETW(req.wValue, 0x0000); 30502ac6454SAndrew Thompson USETW(req.wIndex, offset); 30602ac6454SAndrew Thompson USETW(req.wLength, len); 30702ac6454SAndrew Thompson 308a593f6b8SAndrew Thompson return (uether_do_request(&sc->sc_ue, &req, buf, 1000)); 30902ac6454SAndrew Thompson } 31002ac6454SAndrew Thompson 31102ac6454SAndrew Thompson static int 31202ac6454SAndrew Thompson udav_mem_write(struct udav_softc *sc, uint16_t offset, void *buf, 31302ac6454SAndrew Thompson int len) 31402ac6454SAndrew Thompson { 315760bc48eSAndrew Thompson struct usb_device_request req; 31602ac6454SAndrew Thompson 31702ac6454SAndrew Thompson len &= 0xff; 31802ac6454SAndrew Thompson 31902ac6454SAndrew Thompson req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 32002ac6454SAndrew Thompson req.bRequest = UDAV_REQ_MEM_WRITE; 32102ac6454SAndrew Thompson USETW(req.wValue, 0x0000); 32202ac6454SAndrew Thompson USETW(req.wIndex, offset); 32302ac6454SAndrew Thompson USETW(req.wLength, len); 32402ac6454SAndrew Thompson 325a593f6b8SAndrew Thompson return (uether_do_request(&sc->sc_ue, &req, buf, 1000)); 32602ac6454SAndrew Thompson } 32702ac6454SAndrew Thompson 32802ac6454SAndrew Thompson static int 32902ac6454SAndrew Thompson udav_mem_write1(struct udav_softc *sc, uint16_t offset, 33002ac6454SAndrew Thompson uint8_t ch) 33102ac6454SAndrew Thompson { 332760bc48eSAndrew Thompson struct usb_device_request req; 33302ac6454SAndrew Thompson 33402ac6454SAndrew Thompson req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 33502ac6454SAndrew Thompson req.bRequest = UDAV_REQ_MEM_WRITE1; 33602ac6454SAndrew Thompson USETW(req.wValue, ch); 33702ac6454SAndrew Thompson USETW(req.wIndex, offset); 33802ac6454SAndrew Thompson USETW(req.wLength, 0x0000); 33902ac6454SAndrew Thompson 340a593f6b8SAndrew Thompson return (uether_do_request(&sc->sc_ue, &req, NULL, 1000)); 34102ac6454SAndrew Thompson } 34202ac6454SAndrew Thompson #endif 34302ac6454SAndrew Thompson 34402ac6454SAndrew Thompson static int 34502ac6454SAndrew Thompson udav_csr_read(struct udav_softc *sc, uint16_t offset, void *buf, int len) 34602ac6454SAndrew Thompson { 347760bc48eSAndrew Thompson struct usb_device_request req; 34802ac6454SAndrew Thompson 34902ac6454SAndrew Thompson len &= 0xff; 35002ac6454SAndrew Thompson 35102ac6454SAndrew Thompson req.bmRequestType = UT_READ_VENDOR_DEVICE; 35202ac6454SAndrew Thompson req.bRequest = UDAV_REQ_REG_READ; 35302ac6454SAndrew Thompson USETW(req.wValue, 0x0000); 35402ac6454SAndrew Thompson USETW(req.wIndex, offset); 35502ac6454SAndrew Thompson USETW(req.wLength, len); 35602ac6454SAndrew Thompson 357a593f6b8SAndrew Thompson return (uether_do_request(&sc->sc_ue, &req, buf, 1000)); 35802ac6454SAndrew Thompson } 35902ac6454SAndrew Thompson 36002ac6454SAndrew Thompson static int 36102ac6454SAndrew Thompson udav_csr_write(struct udav_softc *sc, uint16_t offset, void *buf, int len) 36202ac6454SAndrew Thompson { 363760bc48eSAndrew Thompson struct usb_device_request req; 36402ac6454SAndrew Thompson 36502ac6454SAndrew Thompson offset &= 0xff; 36602ac6454SAndrew Thompson len &= 0xff; 36702ac6454SAndrew Thompson 36802ac6454SAndrew Thompson req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 36902ac6454SAndrew Thompson req.bRequest = UDAV_REQ_REG_WRITE; 37002ac6454SAndrew Thompson USETW(req.wValue, 0x0000); 37102ac6454SAndrew Thompson USETW(req.wIndex, offset); 37202ac6454SAndrew Thompson USETW(req.wLength, len); 37302ac6454SAndrew Thompson 374a593f6b8SAndrew Thompson return (uether_do_request(&sc->sc_ue, &req, buf, 1000)); 37502ac6454SAndrew Thompson } 37602ac6454SAndrew Thompson 37702ac6454SAndrew Thompson static uint8_t 37802ac6454SAndrew Thompson udav_csr_read1(struct udav_softc *sc, uint16_t offset) 37902ac6454SAndrew Thompson { 38002ac6454SAndrew Thompson uint8_t val; 38102ac6454SAndrew Thompson 38202ac6454SAndrew Thompson udav_csr_read(sc, offset, &val, 1); 38302ac6454SAndrew Thompson return (val); 38402ac6454SAndrew Thompson } 38502ac6454SAndrew Thompson 38602ac6454SAndrew Thompson static int 38702ac6454SAndrew Thompson udav_csr_write1(struct udav_softc *sc, uint16_t offset, 38802ac6454SAndrew Thompson uint8_t ch) 38902ac6454SAndrew Thompson { 390760bc48eSAndrew Thompson struct usb_device_request req; 39102ac6454SAndrew Thompson 39202ac6454SAndrew Thompson offset &= 0xff; 39302ac6454SAndrew Thompson 39402ac6454SAndrew Thompson req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 39502ac6454SAndrew Thompson req.bRequest = UDAV_REQ_REG_WRITE1; 39602ac6454SAndrew Thompson USETW(req.wValue, ch); 39702ac6454SAndrew Thompson USETW(req.wIndex, offset); 39802ac6454SAndrew Thompson USETW(req.wLength, 0x0000); 39902ac6454SAndrew Thompson 400a593f6b8SAndrew Thompson return (uether_do_request(&sc->sc_ue, &req, NULL, 1000)); 40102ac6454SAndrew Thompson } 40202ac6454SAndrew Thompson 40302ac6454SAndrew Thompson static void 404760bc48eSAndrew Thompson udav_init(struct usb_ether *ue) 40502ac6454SAndrew Thompson { 40602ac6454SAndrew Thompson struct udav_softc *sc = ue->ue_sc; 407a593f6b8SAndrew Thompson struct ifnet *ifp = uether_getifp(&sc->sc_ue); 40802ac6454SAndrew Thompson 40902ac6454SAndrew Thompson UDAV_LOCK_ASSERT(sc, MA_OWNED); 41002ac6454SAndrew Thompson 41102ac6454SAndrew Thompson /* 41202ac6454SAndrew Thompson * Cancel pending I/O 41302ac6454SAndrew Thompson */ 41402ac6454SAndrew Thompson udav_stop(ue); 41502ac6454SAndrew Thompson 41602ac6454SAndrew Thompson /* set MAC address */ 41702ac6454SAndrew Thompson udav_csr_write(sc, UDAV_PAR, IF_LLADDR(ifp), ETHER_ADDR_LEN); 41802ac6454SAndrew Thompson 41902ac6454SAndrew Thompson /* initialize network control register */ 42002ac6454SAndrew Thompson 42102ac6454SAndrew Thompson /* disable loopback */ 42202ac6454SAndrew Thompson UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_LBK0 | UDAV_NCR_LBK1); 42302ac6454SAndrew Thompson 42402ac6454SAndrew Thompson /* Initialize RX control register */ 42502ac6454SAndrew Thompson UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_DIS_LONG | UDAV_RCR_DIS_CRC); 42602ac6454SAndrew Thompson 42702ac6454SAndrew Thompson /* load multicast filter and update promiscious mode bit */ 42802ac6454SAndrew Thompson udav_setpromisc(ue); 42902ac6454SAndrew Thompson 43002ac6454SAndrew Thompson /* enable RX */ 43102ac6454SAndrew Thompson UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_RXEN); 43202ac6454SAndrew Thompson 43302ac6454SAndrew Thompson /* clear POWER_DOWN state of internal PHY */ 43402ac6454SAndrew Thompson UDAV_SETBIT(sc, UDAV_GPCR, UDAV_GPCR_GEP_CNTL0); 43502ac6454SAndrew Thompson UDAV_CLRBIT(sc, UDAV_GPR, UDAV_GPR_GEPIO0); 43602ac6454SAndrew Thompson 437ed6d949aSAndrew Thompson usbd_xfer_set_stall(sc->sc_xfer[UDAV_BULK_DT_WR]); 43802ac6454SAndrew Thompson 43902ac6454SAndrew Thompson ifp->if_drv_flags |= IFF_DRV_RUNNING; 44002ac6454SAndrew Thompson udav_start(ue); 44102ac6454SAndrew Thompson } 44202ac6454SAndrew Thompson 44302ac6454SAndrew Thompson static void 44402ac6454SAndrew Thompson udav_reset(struct udav_softc *sc) 44502ac6454SAndrew Thompson { 44602ac6454SAndrew Thompson int i; 44702ac6454SAndrew Thompson 44802ac6454SAndrew Thompson /* Select PHY */ 44902ac6454SAndrew Thompson #if 1 45002ac6454SAndrew Thompson /* 45102ac6454SAndrew Thompson * XXX: force select internal phy. 45202ac6454SAndrew Thompson * external phy routines are not tested. 45302ac6454SAndrew Thompson */ 45402ac6454SAndrew Thompson UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY); 45502ac6454SAndrew Thompson #else 45602ac6454SAndrew Thompson if (sc->sc_flags & UDAV_EXT_PHY) 45702ac6454SAndrew Thompson UDAV_SETBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY); 45802ac6454SAndrew Thompson else 45902ac6454SAndrew Thompson UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY); 46002ac6454SAndrew Thompson #endif 46102ac6454SAndrew Thompson 46202ac6454SAndrew Thompson UDAV_SETBIT(sc, UDAV_NCR, UDAV_NCR_RST); 46302ac6454SAndrew Thompson 46402ac6454SAndrew Thompson for (i = 0; i < UDAV_TX_TIMEOUT; i++) { 46502ac6454SAndrew Thompson if (!(udav_csr_read1(sc, UDAV_NCR) & UDAV_NCR_RST)) 46602ac6454SAndrew Thompson break; 467a593f6b8SAndrew Thompson if (uether_pause(&sc->sc_ue, hz / 100)) 46802ac6454SAndrew Thompson break; 46902ac6454SAndrew Thompson } 47002ac6454SAndrew Thompson 471a593f6b8SAndrew Thompson uether_pause(&sc->sc_ue, hz / 100); 47202ac6454SAndrew Thompson } 47302ac6454SAndrew Thompson 47402ac6454SAndrew Thompson #define UDAV_BITS 6 47502ac6454SAndrew Thompson static void 476760bc48eSAndrew Thompson udav_setmulti(struct usb_ether *ue) 47702ac6454SAndrew Thompson { 47802ac6454SAndrew Thompson struct udav_softc *sc = ue->ue_sc; 479a593f6b8SAndrew Thompson struct ifnet *ifp = uether_getifp(&sc->sc_ue); 48002ac6454SAndrew Thompson struct ifmultiaddr *ifma; 48102ac6454SAndrew Thompson uint8_t hashtbl[8] = { 0, 0, 0, 0, 0, 0, 0, 0 }; 48202ac6454SAndrew Thompson int h = 0; 48302ac6454SAndrew Thompson 48402ac6454SAndrew Thompson UDAV_LOCK_ASSERT(sc, MA_OWNED); 48502ac6454SAndrew Thompson 48602ac6454SAndrew Thompson if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) { 48702ac6454SAndrew Thompson UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_ALL|UDAV_RCR_PRMSC); 48802ac6454SAndrew Thompson return; 48902ac6454SAndrew Thompson } 49002ac6454SAndrew Thompson 49102ac6454SAndrew Thompson /* first, zot all the existing hash bits */ 49202ac6454SAndrew Thompson memset(hashtbl, 0x00, sizeof(hashtbl)); 49302ac6454SAndrew Thompson hashtbl[7] |= 0x80; /* broadcast address */ 49402ac6454SAndrew Thompson udav_csr_write(sc, UDAV_MAR, hashtbl, sizeof(hashtbl)); 49502ac6454SAndrew Thompson 49602ac6454SAndrew Thompson /* now program new ones */ 497eb956cd0SRobert Watson if_maddr_rlock(ifp); 49802ac6454SAndrew Thompson TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) 49902ac6454SAndrew Thompson { 50002ac6454SAndrew Thompson if (ifma->ifma_addr->sa_family != AF_LINK) 50102ac6454SAndrew Thompson continue; 50202ac6454SAndrew Thompson h = ether_crc32_be(LLADDR((struct sockaddr_dl *) 50302ac6454SAndrew Thompson ifma->ifma_addr), ETHER_ADDR_LEN) >> 26; 50402ac6454SAndrew Thompson hashtbl[h / 8] |= 1 << (h % 8); 50502ac6454SAndrew Thompson } 506eb956cd0SRobert Watson if_maddr_runlock(ifp); 50702ac6454SAndrew Thompson 50802ac6454SAndrew Thompson /* disable all multicast */ 50902ac6454SAndrew Thompson UDAV_CLRBIT(sc, UDAV_RCR, UDAV_RCR_ALL); 51002ac6454SAndrew Thompson 51102ac6454SAndrew Thompson /* write hash value to the register */ 51202ac6454SAndrew Thompson udav_csr_write(sc, UDAV_MAR, hashtbl, sizeof(hashtbl)); 51302ac6454SAndrew Thompson } 51402ac6454SAndrew Thompson 51502ac6454SAndrew Thompson static void 516760bc48eSAndrew Thompson udav_setpromisc(struct usb_ether *ue) 51702ac6454SAndrew Thompson { 51802ac6454SAndrew Thompson struct udav_softc *sc = ue->ue_sc; 519a593f6b8SAndrew Thompson struct ifnet *ifp = uether_getifp(&sc->sc_ue); 52002ac6454SAndrew Thompson uint8_t rxmode; 52102ac6454SAndrew Thompson 52202ac6454SAndrew Thompson rxmode = udav_csr_read1(sc, UDAV_RCR); 52302ac6454SAndrew Thompson rxmode &= ~(UDAV_RCR_ALL | UDAV_RCR_PRMSC); 52402ac6454SAndrew Thompson 52502ac6454SAndrew Thompson if (ifp->if_flags & IFF_PROMISC) 52602ac6454SAndrew Thompson rxmode |= UDAV_RCR_ALL | UDAV_RCR_PRMSC; 52702ac6454SAndrew Thompson else if (ifp->if_flags & IFF_ALLMULTI) 52802ac6454SAndrew Thompson rxmode |= UDAV_RCR_ALL; 52902ac6454SAndrew Thompson 53002ac6454SAndrew Thompson /* write new mode bits */ 53102ac6454SAndrew Thompson udav_csr_write1(sc, UDAV_RCR, rxmode); 53202ac6454SAndrew Thompson } 53302ac6454SAndrew Thompson 53402ac6454SAndrew Thompson static void 535760bc48eSAndrew Thompson udav_start(struct usb_ether *ue) 53602ac6454SAndrew Thompson { 53702ac6454SAndrew Thompson struct udav_softc *sc = ue->ue_sc; 53802ac6454SAndrew Thompson 53902ac6454SAndrew Thompson /* 54002ac6454SAndrew Thompson * start the USB transfers, if not already started: 54102ac6454SAndrew Thompson */ 542a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[UDAV_INTR_DT_RD]); 543a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[UDAV_BULK_DT_RD]); 544a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[UDAV_BULK_DT_WR]); 54502ac6454SAndrew Thompson } 54602ac6454SAndrew Thompson 54702ac6454SAndrew Thompson static void 548ed6d949aSAndrew Thompson udav_bulk_write_callback(struct usb_xfer *xfer, usb_error_t error) 54902ac6454SAndrew Thompson { 550ed6d949aSAndrew Thompson struct udav_softc *sc = usbd_xfer_softc(xfer); 551a593f6b8SAndrew Thompson struct ifnet *ifp = uether_getifp(&sc->sc_ue); 552ed6d949aSAndrew Thompson struct usb_page_cache *pc; 55302ac6454SAndrew Thompson struct mbuf *m; 55402ac6454SAndrew Thompson int extra_len; 55502ac6454SAndrew Thompson int temp_len; 55602ac6454SAndrew Thompson uint8_t buf[2]; 55702ac6454SAndrew Thompson 55802ac6454SAndrew Thompson switch (USB_GET_STATE(xfer)) { 55902ac6454SAndrew Thompson case USB_ST_TRANSFERRED: 56002ac6454SAndrew Thompson DPRINTFN(11, "transfer complete\n"); 56102ac6454SAndrew Thompson ifp->if_opackets++; 56202ac6454SAndrew Thompson 56302ac6454SAndrew Thompson /* FALLTHROUGH */ 56402ac6454SAndrew Thompson case USB_ST_SETUP: 56502ac6454SAndrew Thompson tr_setup: 56602ac6454SAndrew Thompson if ((sc->sc_flags & UDAV_FLAG_LINK) == 0) { 56702ac6454SAndrew Thompson /* 56802ac6454SAndrew Thompson * don't send anything if there is no link ! 56902ac6454SAndrew Thompson */ 57002ac6454SAndrew Thompson return; 57102ac6454SAndrew Thompson } 57202ac6454SAndrew Thompson IFQ_DRV_DEQUEUE(&ifp->if_snd, m); 57302ac6454SAndrew Thompson 57402ac6454SAndrew Thompson if (m == NULL) 57502ac6454SAndrew Thompson return; 57602ac6454SAndrew Thompson if (m->m_pkthdr.len > MCLBYTES) 57702ac6454SAndrew Thompson m->m_pkthdr.len = MCLBYTES; 57802ac6454SAndrew Thompson if (m->m_pkthdr.len < UDAV_MIN_FRAME_LEN) { 57902ac6454SAndrew Thompson extra_len = UDAV_MIN_FRAME_LEN - m->m_pkthdr.len; 58002ac6454SAndrew Thompson } else { 58102ac6454SAndrew Thompson extra_len = 0; 58202ac6454SAndrew Thompson } 58302ac6454SAndrew Thompson 58402ac6454SAndrew Thompson temp_len = (m->m_pkthdr.len + extra_len); 58502ac6454SAndrew Thompson 58602ac6454SAndrew Thompson /* 58702ac6454SAndrew Thompson * the frame length is specified in the first 2 bytes of the 58802ac6454SAndrew Thompson * buffer 58902ac6454SAndrew Thompson */ 59002ac6454SAndrew Thompson buf[0] = (uint8_t)(temp_len); 59102ac6454SAndrew Thompson buf[1] = (uint8_t)(temp_len >> 8); 59202ac6454SAndrew Thompson 59302ac6454SAndrew Thompson temp_len += 2; 59402ac6454SAndrew Thompson 595ed6d949aSAndrew Thompson pc = usbd_xfer_get_frame(xfer, 0); 596ed6d949aSAndrew Thompson usbd_copy_in(pc, 0, buf, 2); 597ed6d949aSAndrew Thompson usbd_m_copy_in(pc, 2, m, 0, m->m_pkthdr.len); 59802ac6454SAndrew Thompson 599ed6d949aSAndrew Thompson if (extra_len) 600ed6d949aSAndrew Thompson usbd_frame_zero(pc, temp_len - extra_len, extra_len); 60102ac6454SAndrew Thompson /* 60202ac6454SAndrew Thompson * if there's a BPF listener, bounce a copy 60302ac6454SAndrew Thompson * of this frame to him: 60402ac6454SAndrew Thompson */ 60502ac6454SAndrew Thompson BPF_MTAP(ifp, m); 60602ac6454SAndrew Thompson 60702ac6454SAndrew Thompson m_freem(m); 60802ac6454SAndrew Thompson 609ed6d949aSAndrew Thompson usbd_xfer_set_frame_len(xfer, 0, temp_len); 610a593f6b8SAndrew Thompson usbd_transfer_submit(xfer); 61102ac6454SAndrew Thompson return; 61202ac6454SAndrew Thompson 61302ac6454SAndrew Thompson default: /* Error */ 61402ac6454SAndrew Thompson DPRINTFN(11, "transfer error, %s\n", 615ed6d949aSAndrew Thompson usbd_errstr(error)); 61602ac6454SAndrew Thompson 61702ac6454SAndrew Thompson ifp->if_oerrors++; 61802ac6454SAndrew Thompson 619ed6d949aSAndrew Thompson if (error != USB_ERR_CANCELLED) { 62002ac6454SAndrew Thompson /* try to clear stall first */ 621ed6d949aSAndrew Thompson usbd_xfer_set_stall(xfer); 62202ac6454SAndrew Thompson goto tr_setup; 62302ac6454SAndrew Thompson } 62402ac6454SAndrew Thompson return; 62502ac6454SAndrew Thompson } 62602ac6454SAndrew Thompson } 62702ac6454SAndrew Thompson 62802ac6454SAndrew Thompson static void 629ed6d949aSAndrew Thompson udav_bulk_read_callback(struct usb_xfer *xfer, usb_error_t error) 63002ac6454SAndrew Thompson { 631ed6d949aSAndrew Thompson struct udav_softc *sc = usbd_xfer_softc(xfer); 632760bc48eSAndrew Thompson struct usb_ether *ue = &sc->sc_ue; 633a593f6b8SAndrew Thompson struct ifnet *ifp = uether_getifp(ue); 634ed6d949aSAndrew Thompson struct usb_page_cache *pc; 63502ac6454SAndrew Thompson struct udav_rxpkt stat; 63602ac6454SAndrew Thompson int len; 637ed6d949aSAndrew Thompson int actlen; 638ed6d949aSAndrew Thompson 639ed6d949aSAndrew Thompson usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL); 64002ac6454SAndrew Thompson 64102ac6454SAndrew Thompson switch (USB_GET_STATE(xfer)) { 64202ac6454SAndrew Thompson case USB_ST_TRANSFERRED: 64302ac6454SAndrew Thompson 644ed6d949aSAndrew Thompson if (actlen < sizeof(stat) + ETHER_CRC_LEN) { 64502ac6454SAndrew Thompson ifp->if_ierrors++; 64602ac6454SAndrew Thompson goto tr_setup; 64702ac6454SAndrew Thompson } 648ed6d949aSAndrew Thompson pc = usbd_xfer_get_frame(xfer, 0); 649ed6d949aSAndrew Thompson usbd_copy_out(pc, 0, &stat, sizeof(stat)); 650ed6d949aSAndrew Thompson actlen -= sizeof(stat); 651ed6d949aSAndrew Thompson len = min(actlen, le16toh(stat.pktlen)); 65202ac6454SAndrew Thompson len -= ETHER_CRC_LEN; 65302ac6454SAndrew Thompson 65402ac6454SAndrew Thompson if (stat.rxstat & UDAV_RSR_LCS) { 65502ac6454SAndrew Thompson ifp->if_collisions++; 65602ac6454SAndrew Thompson goto tr_setup; 65702ac6454SAndrew Thompson } 65802ac6454SAndrew Thompson if (stat.rxstat & UDAV_RSR_ERR) { 65902ac6454SAndrew Thompson ifp->if_ierrors++; 66002ac6454SAndrew Thompson goto tr_setup; 66102ac6454SAndrew Thompson } 662ed6d949aSAndrew Thompson uether_rxbuf(ue, pc, sizeof(stat), len); 66302ac6454SAndrew Thompson /* FALLTHROUGH */ 66402ac6454SAndrew Thompson case USB_ST_SETUP: 66502ac6454SAndrew Thompson tr_setup: 666ed6d949aSAndrew Thompson usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer)); 667a593f6b8SAndrew Thompson usbd_transfer_submit(xfer); 668a593f6b8SAndrew Thompson uether_rxflush(ue); 66902ac6454SAndrew Thompson return; 67002ac6454SAndrew Thompson 67102ac6454SAndrew Thompson default: /* Error */ 67202ac6454SAndrew Thompson DPRINTF("bulk read error, %s\n", 673ed6d949aSAndrew Thompson usbd_errstr(error)); 67402ac6454SAndrew Thompson 675ed6d949aSAndrew Thompson if (error != USB_ERR_CANCELLED) { 67602ac6454SAndrew Thompson /* try to clear stall first */ 677ed6d949aSAndrew Thompson usbd_xfer_set_stall(xfer); 67802ac6454SAndrew Thompson goto tr_setup; 67902ac6454SAndrew Thompson } 68002ac6454SAndrew Thompson return; 68102ac6454SAndrew Thompson } 68202ac6454SAndrew Thompson } 68302ac6454SAndrew Thompson 68402ac6454SAndrew Thompson static void 685ed6d949aSAndrew Thompson udav_intr_callback(struct usb_xfer *xfer, usb_error_t error) 68602ac6454SAndrew Thompson { 68702ac6454SAndrew Thompson switch (USB_GET_STATE(xfer)) { 68802ac6454SAndrew Thompson case USB_ST_TRANSFERRED: 68902ac6454SAndrew Thompson case USB_ST_SETUP: 69002ac6454SAndrew Thompson tr_setup: 691ed6d949aSAndrew Thompson usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer)); 692a593f6b8SAndrew Thompson usbd_transfer_submit(xfer); 69302ac6454SAndrew Thompson return; 69402ac6454SAndrew Thompson 69502ac6454SAndrew Thompson default: /* Error */ 696ed6d949aSAndrew Thompson if (error != USB_ERR_CANCELLED) { 69702ac6454SAndrew Thompson /* try to clear stall first */ 698ed6d949aSAndrew Thompson usbd_xfer_set_stall(xfer); 69902ac6454SAndrew Thompson goto tr_setup; 70002ac6454SAndrew Thompson } 70102ac6454SAndrew Thompson return; 70202ac6454SAndrew Thompson } 70302ac6454SAndrew Thompson } 70402ac6454SAndrew Thompson 70502ac6454SAndrew Thompson static void 706760bc48eSAndrew Thompson udav_stop(struct usb_ether *ue) 70702ac6454SAndrew Thompson { 70802ac6454SAndrew Thompson struct udav_softc *sc = ue->ue_sc; 709a593f6b8SAndrew Thompson struct ifnet *ifp = uether_getifp(&sc->sc_ue); 71002ac6454SAndrew Thompson 71102ac6454SAndrew Thompson UDAV_LOCK_ASSERT(sc, MA_OWNED); 71202ac6454SAndrew Thompson 71302ac6454SAndrew Thompson ifp->if_drv_flags &= ~IFF_DRV_RUNNING; 71402ac6454SAndrew Thompson sc->sc_flags &= ~UDAV_FLAG_LINK; 71502ac6454SAndrew Thompson 71602ac6454SAndrew Thompson /* 71702ac6454SAndrew Thompson * stop all the transfers, if not already stopped: 71802ac6454SAndrew Thompson */ 719a593f6b8SAndrew Thompson usbd_transfer_stop(sc->sc_xfer[UDAV_BULK_DT_WR]); 720a593f6b8SAndrew Thompson usbd_transfer_stop(sc->sc_xfer[UDAV_BULK_DT_RD]); 721a593f6b8SAndrew Thompson usbd_transfer_stop(sc->sc_xfer[UDAV_INTR_DT_RD]); 72202ac6454SAndrew Thompson 72302ac6454SAndrew Thompson udav_reset(sc); 72402ac6454SAndrew Thompson } 72502ac6454SAndrew Thompson 72602ac6454SAndrew Thompson static int 72702ac6454SAndrew Thompson udav_ifmedia_upd(struct ifnet *ifp) 72802ac6454SAndrew Thompson { 72902ac6454SAndrew Thompson struct udav_softc *sc = ifp->if_softc; 73002ac6454SAndrew Thompson struct mii_data *mii = GET_MII(sc); 73102ac6454SAndrew Thompson 73202ac6454SAndrew Thompson UDAV_LOCK_ASSERT(sc, MA_OWNED); 73302ac6454SAndrew Thompson 73402ac6454SAndrew Thompson sc->sc_flags &= ~UDAV_FLAG_LINK; 73502ac6454SAndrew Thompson if (mii->mii_instance) { 73602ac6454SAndrew Thompson struct mii_softc *miisc; 73702ac6454SAndrew Thompson 73802ac6454SAndrew Thompson LIST_FOREACH(miisc, &mii->mii_phys, mii_list) 73902ac6454SAndrew Thompson mii_phy_reset(miisc); 74002ac6454SAndrew Thompson } 74102ac6454SAndrew Thompson mii_mediachg(mii); 74202ac6454SAndrew Thompson return (0); 74302ac6454SAndrew Thompson } 74402ac6454SAndrew Thompson 74502ac6454SAndrew Thompson static void 74602ac6454SAndrew Thompson udav_ifmedia_status(struct ifnet *ifp, struct ifmediareq *ifmr) 74702ac6454SAndrew Thompson { 74802ac6454SAndrew Thompson struct udav_softc *sc = ifp->if_softc; 74902ac6454SAndrew Thompson struct mii_data *mii = GET_MII(sc); 75002ac6454SAndrew Thompson 75102ac6454SAndrew Thompson UDAV_LOCK(sc); 75202ac6454SAndrew Thompson mii_pollstat(mii); 75302ac6454SAndrew Thompson UDAV_UNLOCK(sc); 75402ac6454SAndrew Thompson ifmr->ifm_active = mii->mii_media_active; 75502ac6454SAndrew Thompson ifmr->ifm_status = mii->mii_media_status; 75602ac6454SAndrew Thompson } 75702ac6454SAndrew Thompson 75802ac6454SAndrew Thompson static void 759760bc48eSAndrew Thompson udav_tick(struct usb_ether *ue) 76002ac6454SAndrew Thompson { 76102ac6454SAndrew Thompson struct udav_softc *sc = ue->ue_sc; 76202ac6454SAndrew Thompson struct mii_data *mii = GET_MII(sc); 76302ac6454SAndrew Thompson 76402ac6454SAndrew Thompson UDAV_LOCK_ASSERT(sc, MA_OWNED); 76502ac6454SAndrew Thompson 76602ac6454SAndrew Thompson mii_tick(mii); 76702ac6454SAndrew Thompson if ((sc->sc_flags & UDAV_FLAG_LINK) == 0 76802ac6454SAndrew Thompson && mii->mii_media_status & IFM_ACTIVE && 76902ac6454SAndrew Thompson IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) { 77002ac6454SAndrew Thompson sc->sc_flags |= UDAV_FLAG_LINK; 77102ac6454SAndrew Thompson udav_start(ue); 77202ac6454SAndrew Thompson } 77302ac6454SAndrew Thompson } 77402ac6454SAndrew Thompson 77502ac6454SAndrew Thompson static int 77602ac6454SAndrew Thompson udav_miibus_readreg(device_t dev, int phy, int reg) 77702ac6454SAndrew Thompson { 77802ac6454SAndrew Thompson struct udav_softc *sc = device_get_softc(dev); 77902ac6454SAndrew Thompson uint16_t data16; 78002ac6454SAndrew Thompson uint8_t val[2]; 78102ac6454SAndrew Thompson int locked; 78202ac6454SAndrew Thompson 78302ac6454SAndrew Thompson /* XXX: one PHY only for the internal PHY */ 78402ac6454SAndrew Thompson if (phy != 0) 78502ac6454SAndrew Thompson return (0); 78602ac6454SAndrew Thompson 78702ac6454SAndrew Thompson locked = mtx_owned(&sc->sc_mtx); 78802ac6454SAndrew Thompson if (!locked) 78902ac6454SAndrew Thompson UDAV_LOCK(sc); 79002ac6454SAndrew Thompson 79102ac6454SAndrew Thompson /* select internal PHY and set PHY register address */ 79202ac6454SAndrew Thompson udav_csr_write1(sc, UDAV_EPAR, 79302ac6454SAndrew Thompson UDAV_EPAR_PHY_ADR0 | (reg & UDAV_EPAR_EROA_MASK)); 79402ac6454SAndrew Thompson 79502ac6454SAndrew Thompson /* select PHY operation and start read command */ 79602ac6454SAndrew Thompson udav_csr_write1(sc, UDAV_EPCR, UDAV_EPCR_EPOS | UDAV_EPCR_ERPRR); 79702ac6454SAndrew Thompson 79802ac6454SAndrew Thompson /* XXX: should we wait? */ 79902ac6454SAndrew Thompson 80002ac6454SAndrew Thompson /* end read command */ 80102ac6454SAndrew Thompson UDAV_CLRBIT(sc, UDAV_EPCR, UDAV_EPCR_ERPRR); 80202ac6454SAndrew Thompson 80302ac6454SAndrew Thompson /* retrieve the result from data registers */ 80402ac6454SAndrew Thompson udav_csr_read(sc, UDAV_EPDRL, val, 2); 80502ac6454SAndrew Thompson 80602ac6454SAndrew Thompson data16 = (val[0] | (val[1] << 8)); 80702ac6454SAndrew Thompson 80802ac6454SAndrew Thompson DPRINTFN(11, "phy=%d reg=0x%04x => 0x%04x\n", 80902ac6454SAndrew Thompson phy, reg, data16); 81002ac6454SAndrew Thompson 81102ac6454SAndrew Thompson if (!locked) 81202ac6454SAndrew Thompson UDAV_UNLOCK(sc); 81302ac6454SAndrew Thompson return (data16); 81402ac6454SAndrew Thompson } 81502ac6454SAndrew Thompson 81602ac6454SAndrew Thompson static int 81702ac6454SAndrew Thompson udav_miibus_writereg(device_t dev, int phy, int reg, int data) 81802ac6454SAndrew Thompson { 81902ac6454SAndrew Thompson struct udav_softc *sc = device_get_softc(dev); 82002ac6454SAndrew Thompson uint8_t val[2]; 82102ac6454SAndrew Thompson int locked; 82202ac6454SAndrew Thompson 82302ac6454SAndrew Thompson /* XXX: one PHY only for the internal PHY */ 82402ac6454SAndrew Thompson if (phy != 0) 82502ac6454SAndrew Thompson return (0); 82602ac6454SAndrew Thompson 82702ac6454SAndrew Thompson locked = mtx_owned(&sc->sc_mtx); 82802ac6454SAndrew Thompson if (!locked) 82902ac6454SAndrew Thompson UDAV_LOCK(sc); 83002ac6454SAndrew Thompson 83102ac6454SAndrew Thompson /* select internal PHY and set PHY register address */ 83202ac6454SAndrew Thompson udav_csr_write1(sc, UDAV_EPAR, 83302ac6454SAndrew Thompson UDAV_EPAR_PHY_ADR0 | (reg & UDAV_EPAR_EROA_MASK)); 83402ac6454SAndrew Thompson 83502ac6454SAndrew Thompson /* put the value to the data registers */ 83602ac6454SAndrew Thompson val[0] = (data & 0xff); 83702ac6454SAndrew Thompson val[1] = (data >> 8) & 0xff; 83802ac6454SAndrew Thompson udav_csr_write(sc, UDAV_EPDRL, val, 2); 83902ac6454SAndrew Thompson 84002ac6454SAndrew Thompson /* select PHY operation and start write command */ 84102ac6454SAndrew Thompson udav_csr_write1(sc, UDAV_EPCR, UDAV_EPCR_EPOS | UDAV_EPCR_ERPRW); 84202ac6454SAndrew Thompson 84302ac6454SAndrew Thompson /* XXX: should we wait? */ 84402ac6454SAndrew Thompson 84502ac6454SAndrew Thompson /* end write command */ 84602ac6454SAndrew Thompson UDAV_CLRBIT(sc, UDAV_EPCR, UDAV_EPCR_ERPRW); 84702ac6454SAndrew Thompson 84802ac6454SAndrew Thompson if (!locked) 84902ac6454SAndrew Thompson UDAV_UNLOCK(sc); 85002ac6454SAndrew Thompson return (0); 85102ac6454SAndrew Thompson } 85202ac6454SAndrew Thompson 85302ac6454SAndrew Thompson static void 85402ac6454SAndrew Thompson udav_miibus_statchg(device_t dev) 85502ac6454SAndrew Thompson { 85602ac6454SAndrew Thompson /* nothing to do */ 85702ac6454SAndrew Thompson } 858