if_udav.c revision 1.3.2.2
1 1.3.2.2 skrll /* $NetBSD: if_udav.c,v 1.3.2.2 2004/08/03 10:51:33 skrll Exp $ */ 2 1.3.2.2 skrll /* $nabe: if_udav.c,v 1.3 2003/08/21 16:57:19 nabe Exp $ */ 3 1.3.2.2 skrll /* 4 1.3.2.2 skrll * Copyright (c) 2003 5 1.3.2.2 skrll * Shingo WATANABE <nabe (at) nabechan.org>. All rights reserved. 6 1.3.2.2 skrll * 7 1.3.2.2 skrll * Redistribution and use in source and binary forms, with or without 8 1.3.2.2 skrll * modification, are permitted provided that the following conditions 9 1.3.2.2 skrll * are met: 10 1.3.2.2 skrll * 1. Redistributions of source code must retain the above copyright 11 1.3.2.2 skrll * notice, this list of conditions and the following disclaimer. 12 1.3.2.2 skrll * 2. Redistributions in binary form must reproduce the above copyright 13 1.3.2.2 skrll * notice, this list of conditions and the following disclaimer in the 14 1.3.2.2 skrll * documentation and/or other materials provided with the distribution. 15 1.3.2.2 skrll * 3. Neither the name of the author nor the names of any co-contributors 16 1.3.2.2 skrll * may be used to endorse or promote products derived from this software 17 1.3.2.2 skrll * without specific prior written permission. 18 1.3.2.2 skrll * 19 1.3.2.2 skrll * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 20 1.3.2.2 skrll * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 21 1.3.2.2 skrll * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 22 1.3.2.2 skrll * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 23 1.3.2.2 skrll * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 24 1.3.2.2 skrll * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 25 1.3.2.2 skrll * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 26 1.3.2.2 skrll * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 27 1.3.2.2 skrll * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 28 1.3.2.2 skrll * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 29 1.3.2.2 skrll * SUCH DAMAGE. 30 1.3.2.2 skrll * 31 1.3.2.2 skrll */ 32 1.3.2.2 skrll 33 1.3.2.2 skrll /* 34 1.3.2.2 skrll * DM9601(DAVICOM USB to Ethernet MAC Controller with Integrated 10/100 PHY) 35 1.3.2.2 skrll * The spec can be found at the following url. 36 1.3.2.2 skrll * http://www.davicom.com.tw/big5/download/Data%20Sheet/DM9601-DS-F01-062202s.pdf 37 1.3.2.2 skrll */ 38 1.3.2.2 skrll 39 1.3.2.2 skrll /* 40 1.3.2.2 skrll * TODO: 41 1.3.2.2 skrll * Interrupt Endpoint support 42 1.3.2.2 skrll * External PHYs 43 1.3.2.2 skrll * powerhook() support? 44 1.3.2.2 skrll */ 45 1.3.2.2 skrll 46 1.3.2.2 skrll #include <sys/cdefs.h> 47 1.3.2.2 skrll __KERNEL_RCSID(0, "$NetBSD: if_udav.c,v 1.3.2.2 2004/08/03 10:51:33 skrll Exp $"); 48 1.3.2.2 skrll 49 1.3.2.2 skrll #include "opt_inet.h" 50 1.3.2.2 skrll #include "opt_ns.h" 51 1.3.2.2 skrll #include "bpfilter.h" 52 1.3.2.2 skrll #include "rnd.h" 53 1.3.2.2 skrll 54 1.3.2.2 skrll #include <sys/param.h> 55 1.3.2.2 skrll #include <sys/systm.h> 56 1.3.2.2 skrll #include <sys/lock.h> 57 1.3.2.2 skrll #include <sys/mbuf.h> 58 1.3.2.2 skrll #include <sys/kernel.h> 59 1.3.2.2 skrll #include <sys/socket.h> 60 1.3.2.2 skrll 61 1.3.2.2 skrll #include <sys/device.h> 62 1.3.2.2 skrll #if NRND > 0 63 1.3.2.2 skrll #include <sys/rnd.h> 64 1.3.2.2 skrll #endif 65 1.3.2.2 skrll 66 1.3.2.2 skrll #include <net/if.h> 67 1.3.2.2 skrll #include <net/if_arp.h> 68 1.3.2.2 skrll #include <net/if_dl.h> 69 1.3.2.2 skrll #include <net/if_media.h> 70 1.3.2.2 skrll 71 1.3.2.2 skrll #if NBPFILTER > 0 72 1.3.2.2 skrll #include <net/bpf.h> 73 1.3.2.2 skrll #endif 74 1.3.2.2 skrll #define BPF_MTAP(ifp, m) bpf_mtap((ifp)->if_bpf, (m)) 75 1.3.2.2 skrll 76 1.3.2.2 skrll #include <net/if_ether.h> 77 1.3.2.2 skrll #ifdef INET 78 1.3.2.2 skrll #include <netinet/in.h> 79 1.3.2.2 skrll #include <netinet/if_inarp.h> 80 1.3.2.2 skrll #endif 81 1.3.2.2 skrll #ifdef NS 82 1.3.2.2 skrll #include <netns/ns.h> 83 1.3.2.2 skrll #include <netns/ns_if.h> 84 1.3.2.2 skrll #endif 85 1.3.2.2 skrll 86 1.3.2.2 skrll #include <dev/mii/mii.h> 87 1.3.2.2 skrll #include <dev/mii/miivar.h> 88 1.3.2.2 skrll 89 1.3.2.2 skrll #include <dev/usb/usb.h> 90 1.3.2.2 skrll #include <dev/usb/usbdi.h> 91 1.3.2.2 skrll #include <dev/usb/usbdi_util.h> 92 1.3.2.2 skrll #include <dev/usb/usbdevs.h> 93 1.3.2.2 skrll 94 1.3.2.2 skrll #include <dev/usb/if_udavreg.h> 95 1.3.2.2 skrll 96 1.3.2.2 skrll 97 1.3.2.2 skrll /* Function declarations */ 98 1.3.2.2 skrll USB_DECLARE_DRIVER(udav); 99 1.3.2.2 skrll 100 1.3.2.2 skrll Static int udav_openpipes(struct udav_softc *); 101 1.3.2.2 skrll Static int udav_rx_list_init(struct udav_softc *); 102 1.3.2.2 skrll Static int udav_tx_list_init(struct udav_softc *); 103 1.3.2.2 skrll Static int udav_newbuf(struct udav_softc *, struct udav_chain *, struct mbuf *); 104 1.3.2.2 skrll Static void udav_start(struct ifnet *); 105 1.3.2.2 skrll Static int udav_send(struct udav_softc *, struct mbuf *, int); 106 1.3.2.2 skrll Static void udav_txeof(usbd_xfer_handle, usbd_private_handle, usbd_status); 107 1.3.2.2 skrll Static void udav_rxeof(usbd_xfer_handle, usbd_private_handle, usbd_status); 108 1.3.2.2 skrll Static void udav_tick(void *); 109 1.3.2.2 skrll Static void udav_tick_task(void *); 110 1.3.2.2 skrll Static int udav_ioctl(struct ifnet *, u_long, caddr_t); 111 1.3.2.2 skrll Static void udav_stop_task(struct udav_softc *); 112 1.3.2.2 skrll Static void udav_stop(struct ifnet *, int); 113 1.3.2.2 skrll Static void udav_watchdog(struct ifnet *); 114 1.3.2.2 skrll Static int udav_ifmedia_change(struct ifnet *); 115 1.3.2.2 skrll Static void udav_ifmedia_status(struct ifnet *, struct ifmediareq *); 116 1.3.2.2 skrll Static void udav_lock_mii(struct udav_softc *); 117 1.3.2.2 skrll Static void udav_unlock_mii(struct udav_softc *); 118 1.3.2.2 skrll Static int udav_miibus_readreg(device_ptr_t, int, int); 119 1.3.2.2 skrll Static void udav_miibus_writereg(device_ptr_t, int, int, int); 120 1.3.2.2 skrll Static void udav_miibus_statchg(device_ptr_t); 121 1.3.2.2 skrll Static int udav_init(struct ifnet *); 122 1.3.2.2 skrll Static void udav_setmulti(struct udav_softc *); 123 1.3.2.2 skrll Static void udav_reset(struct udav_softc *); 124 1.3.2.2 skrll 125 1.3.2.2 skrll Static int udav_csr_read(struct udav_softc *, int, void *, int); 126 1.3.2.2 skrll Static int udav_csr_write(struct udav_softc *, int, void *, int); 127 1.3.2.2 skrll Static int udav_csr_read1(struct udav_softc *, int); 128 1.3.2.2 skrll Static int udav_csr_write1(struct udav_softc *, int, unsigned char); 129 1.3.2.2 skrll 130 1.3.2.2 skrll #if 0 131 1.3.2.2 skrll Static int udav_mem_read(struct udav_softc *, int, void *, int); 132 1.3.2.2 skrll Static int udav_mem_write(struct udav_softc *, int, void *, int); 133 1.3.2.2 skrll Static int udav_mem_write1(struct udav_softc *, int, unsigned char); 134 1.3.2.2 skrll #endif 135 1.3.2.2 skrll 136 1.3.2.2 skrll /* Macros */ 137 1.3.2.2 skrll #ifdef UDAV_DEBUG 138 1.3.2.2 skrll #define DPRINTF(x) if (udavdebug) logprintf x 139 1.3.2.2 skrll #define DPRINTFN(n,x) if (udavdebug >= (n)) logprintf x 140 1.3.2.2 skrll int udavdebug = 0; 141 1.3.2.2 skrll #else 142 1.3.2.2 skrll #define DPRINTF(x) 143 1.3.2.2 skrll #define DPRINTFN(n,x) 144 1.3.2.2 skrll #endif 145 1.3.2.2 skrll 146 1.3.2.2 skrll #define UDAV_SETBIT(sc, reg, x) \ 147 1.3.2.2 skrll udav_csr_write1(sc, reg, udav_csr_read1(sc, reg) | (x)) 148 1.3.2.2 skrll 149 1.3.2.2 skrll #define UDAV_CLRBIT(sc, reg, x) \ 150 1.3.2.2 skrll udav_csr_write1(sc, reg, udav_csr_read1(sc, reg) & ~(x)) 151 1.3.2.2 skrll 152 1.3.2.2 skrll static const struct udav_type { 153 1.3.2.2 skrll struct usb_devno udav_dev; 154 1.3.2.2 skrll u_int16_t udav_flags; 155 1.3.2.2 skrll #define UDAV_EXT_PHY 0x0001 156 1.3.2.2 skrll } udav_devs [] = { 157 1.3.2.2 skrll /* Corega USB-TXC */ 158 1.3.2.2 skrll {{ USB_VENDOR_COREGA, USB_PRODUCT_COREGA_FETHER_USB_TXC }, 0}, 159 1.3.2.2 skrll #if 0 160 1.3.2.2 skrll /* DAVICOM DM9601 Generic? */ 161 1.3.2.2 skrll /* XXX: The following ids was obtained from the data sheet. */ 162 1.3.2.2 skrll {{ 0x0a46, 0x9601 }, 0}, 163 1.3.2.2 skrll #endif 164 1.3.2.2 skrll }; 165 1.3.2.2 skrll #define udav_lookup(v, p) ((struct udav_type *)usb_lookup(udav_devs, v, p)) 166 1.3.2.2 skrll 167 1.3.2.2 skrll 168 1.3.2.2 skrll /* Probe */ 169 1.3.2.2 skrll USB_MATCH(udav) 170 1.3.2.2 skrll { 171 1.3.2.2 skrll USB_MATCH_START(udav, uaa); 172 1.3.2.2 skrll 173 1.3.2.2 skrll if (uaa->iface != NULL) 174 1.3.2.2 skrll return (UMATCH_NONE); 175 1.3.2.2 skrll 176 1.3.2.2 skrll return (udav_lookup(uaa->vendor, uaa->product) != NULL ? 177 1.3.2.2 skrll UMATCH_VENDOR_PRODUCT : UMATCH_NONE); 178 1.3.2.2 skrll } 179 1.3.2.2 skrll 180 1.3.2.2 skrll /* Attach */ 181 1.3.2.2 skrll USB_ATTACH(udav) 182 1.3.2.2 skrll { 183 1.3.2.2 skrll USB_ATTACH_START(udav, sc, uaa); 184 1.3.2.2 skrll usbd_device_handle dev = uaa->device; 185 1.3.2.2 skrll usbd_interface_handle iface; 186 1.3.2.2 skrll usbd_status err; 187 1.3.2.2 skrll usb_interface_descriptor_t *id; 188 1.3.2.2 skrll usb_endpoint_descriptor_t *ed; 189 1.3.2.2 skrll char devinfo[1024]; 190 1.3.2.2 skrll char *devname = USBDEVNAME(sc->sc_dev); 191 1.3.2.2 skrll struct ifnet *ifp; 192 1.3.2.2 skrll struct mii_data *mii; 193 1.3.2.2 skrll u_char eaddr[ETHER_ADDR_LEN]; 194 1.3.2.2 skrll int i, s; 195 1.3.2.2 skrll 196 1.3.2.2 skrll usbd_devinfo(dev, 0, devinfo, sizeof(devinfo)); 197 1.3.2.2 skrll USB_ATTACH_SETUP; 198 1.3.2.2 skrll printf("%s: %s\n", devname, devinfo); 199 1.3.2.2 skrll 200 1.3.2.2 skrll /* Move the device into the configured state. */ 201 1.3.2.2 skrll err = usbd_set_config_no(dev, UDAV_CONFIG_NO, 1); 202 1.3.2.2 skrll if (err) { 203 1.3.2.2 skrll printf("%s: setting config no failed\n", devname); 204 1.3.2.2 skrll goto bad; 205 1.3.2.2 skrll } 206 1.3.2.2 skrll 207 1.3.2.2 skrll usb_init_task(&sc->sc_tick_task, udav_tick_task, sc); 208 1.3.2.2 skrll lockinit(&sc->sc_mii_lock, PZERO, "udavmii", 0, 0); 209 1.3.2.2 skrll usb_init_task(&sc->sc_stop_task, (void (*)(void *)) udav_stop_task, sc); 210 1.3.2.2 skrll 211 1.3.2.2 skrll /* get control interface */ 212 1.3.2.2 skrll err = usbd_device2interface_handle(dev, UDAV_IFACE_INDEX, &iface); 213 1.3.2.2 skrll if (err) { 214 1.3.2.2 skrll printf("%s: failed to get interface, err=%s\n", devname, 215 1.3.2.2 skrll usbd_errstr(err)); 216 1.3.2.2 skrll goto bad; 217 1.3.2.2 skrll } 218 1.3.2.2 skrll 219 1.3.2.2 skrll sc->sc_udev = dev; 220 1.3.2.2 skrll sc->sc_ctl_iface = iface; 221 1.3.2.2 skrll sc->sc_flags = udav_lookup(uaa->vendor, uaa->product)->udav_flags; 222 1.3.2.2 skrll 223 1.3.2.2 skrll /* get interface descriptor */ 224 1.3.2.2 skrll id = usbd_get_interface_descriptor(sc->sc_ctl_iface); 225 1.3.2.2 skrll 226 1.3.2.2 skrll /* find endpoints */ 227 1.3.2.2 skrll sc->sc_bulkin_no = sc->sc_bulkout_no = sc->sc_intrin_no = -1; 228 1.3.2.2 skrll for (i = 0; i < id->bNumEndpoints; i++) { 229 1.3.2.2 skrll ed = usbd_interface2endpoint_descriptor(sc->sc_ctl_iface, i); 230 1.3.2.2 skrll if (ed == NULL) { 231 1.3.2.2 skrll printf("%s: couldn't get endpoint %d\n", devname, i); 232 1.3.2.2 skrll goto bad; 233 1.3.2.2 skrll } 234 1.3.2.2 skrll if ((ed->bmAttributes & UE_XFERTYPE) == UE_BULK && 235 1.3.2.2 skrll UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN) 236 1.3.2.2 skrll sc->sc_bulkin_no = ed->bEndpointAddress; /* RX */ 237 1.3.2.2 skrll else if ((ed->bmAttributes & UE_XFERTYPE) == UE_BULK && 238 1.3.2.2 skrll UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT) 239 1.3.2.2 skrll sc->sc_bulkout_no = ed->bEndpointAddress; /* TX */ 240 1.3.2.2 skrll else if ((ed->bmAttributes & UE_XFERTYPE) == UE_INTERRUPT && 241 1.3.2.2 skrll UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN) 242 1.3.2.2 skrll sc->sc_intrin_no = ed->bEndpointAddress; /* Status */ 243 1.3.2.2 skrll } 244 1.3.2.2 skrll 245 1.3.2.2 skrll if (sc->sc_bulkin_no == -1 || sc->sc_bulkout_no == -1 || 246 1.3.2.2 skrll sc->sc_intrin_no == -1) { 247 1.3.2.2 skrll printf("%s: missing endpoint\n", devname); 248 1.3.2.2 skrll goto bad; 249 1.3.2.2 skrll } 250 1.3.2.2 skrll 251 1.3.2.2 skrll s = splnet(); 252 1.3.2.2 skrll 253 1.3.2.2 skrll /* reset the adapter */ 254 1.3.2.2 skrll udav_reset(sc); 255 1.3.2.2 skrll 256 1.3.2.2 skrll /* Get Ethernet Address */ 257 1.3.2.2 skrll err = udav_csr_read(sc, UDAV_PAR, (void *)eaddr, ETHER_ADDR_LEN); 258 1.3.2.2 skrll if (err) { 259 1.3.2.2 skrll printf("%s: read MAC address failed\n", devname); 260 1.3.2.2 skrll splx(s); 261 1.3.2.2 skrll goto bad; 262 1.3.2.2 skrll } 263 1.3.2.2 skrll 264 1.3.2.2 skrll /* Print Ethernet Address */ 265 1.3.2.2 skrll printf("%s: Ethernet address %s\n", devname, ether_sprintf(eaddr)); 266 1.3.2.2 skrll 267 1.3.2.2 skrll /* initialize interface infomation */ 268 1.3.2.2 skrll ifp = GET_IFP(sc); 269 1.3.2.2 skrll ifp->if_softc = sc; 270 1.3.2.2 skrll ifp->if_mtu = ETHERMTU; 271 1.3.2.2 skrll strncpy(ifp->if_xname, devname, IFNAMSIZ); 272 1.3.2.2 skrll ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 273 1.3.2.2 skrll ifp->if_start = udav_start; 274 1.3.2.2 skrll ifp->if_ioctl = udav_ioctl; 275 1.3.2.2 skrll ifp->if_watchdog = udav_watchdog; 276 1.3.2.2 skrll ifp->if_init = udav_init; 277 1.3.2.2 skrll ifp->if_stop = udav_stop; 278 1.3.2.2 skrll 279 1.3.2.2 skrll IFQ_SET_READY(&ifp->if_snd); 280 1.3.2.2 skrll 281 1.3.2.2 skrll /* 282 1.3.2.2 skrll * Do ifmedia setup. 283 1.3.2.2 skrll */ 284 1.3.2.2 skrll mii = &sc->sc_mii; 285 1.3.2.2 skrll mii->mii_ifp = ifp; 286 1.3.2.2 skrll mii->mii_readreg = udav_miibus_readreg; 287 1.3.2.2 skrll mii->mii_writereg = udav_miibus_writereg; 288 1.3.2.2 skrll mii->mii_statchg = udav_miibus_statchg; 289 1.3.2.2 skrll mii->mii_flags = MIIF_AUTOTSLEEP; 290 1.3.2.2 skrll ifmedia_init(&mii->mii_media, 0, 291 1.3.2.2 skrll udav_ifmedia_change, udav_ifmedia_status); 292 1.3.2.2 skrll mii_attach(self, mii, 0xffffffff, MII_PHY_ANY, MII_OFFSET_ANY, 0); 293 1.3.2.2 skrll if (LIST_FIRST(&mii->mii_phys) == NULL) { 294 1.3.2.2 skrll ifmedia_add(&mii->mii_media, IFM_ETHER | IFM_NONE, 0, NULL); 295 1.3.2.2 skrll ifmedia_set(&mii->mii_media, IFM_ETHER | IFM_NONE); 296 1.3.2.2 skrll } else 297 1.3.2.2 skrll ifmedia_set(&mii->mii_media, IFM_ETHER | IFM_AUTO); 298 1.3.2.2 skrll 299 1.3.2.2 skrll /* attach the interface */ 300 1.3.2.2 skrll if_attach(ifp); 301 1.3.2.2 skrll Ether_ifattach(ifp, eaddr); 302 1.3.2.2 skrll 303 1.3.2.2 skrll #if NRND > 0 304 1.3.2.2 skrll rnd_attach_source(&sc->rnd_source, devname, RND_TYPE_NET, 0); 305 1.3.2.2 skrll #endif 306 1.3.2.2 skrll 307 1.3.2.2 skrll usb_callout_init(sc->sc_stat_ch); 308 1.3.2.2 skrll sc->sc_attached = 1; 309 1.3.2.2 skrll splx(s); 310 1.3.2.2 skrll 311 1.3.2.2 skrll usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, dev, USBDEV(sc->sc_dev)); 312 1.3.2.2 skrll 313 1.3.2.2 skrll USB_ATTACH_SUCCESS_RETURN; 314 1.3.2.2 skrll 315 1.3.2.2 skrll bad: 316 1.3.2.2 skrll sc->sc_dying = 1; 317 1.3.2.2 skrll USB_ATTACH_ERROR_RETURN; 318 1.3.2.2 skrll } 319 1.3.2.2 skrll 320 1.3.2.2 skrll /* detach */ 321 1.3.2.2 skrll USB_DETACH(udav) 322 1.3.2.2 skrll { 323 1.3.2.2 skrll USB_DETACH_START(udav, sc); 324 1.3.2.2 skrll struct ifnet *ifp = GET_IFP(sc); 325 1.3.2.2 skrll int s; 326 1.3.2.2 skrll 327 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 328 1.3.2.2 skrll 329 1.3.2.2 skrll /* Detached before attached finished */ 330 1.3.2.2 skrll if (!sc->sc_attached) 331 1.3.2.2 skrll return (0); 332 1.3.2.2 skrll 333 1.3.2.2 skrll usb_uncallout(sc->sc_stat_ch, udav_tick, sc); 334 1.3.2.2 skrll 335 1.3.2.2 skrll /* Remove any pending tasks */ 336 1.3.2.2 skrll usb_rem_task(sc->sc_udev, &sc->sc_tick_task); 337 1.3.2.2 skrll usb_rem_task(sc->sc_udev, &sc->sc_stop_task); 338 1.3.2.2 skrll 339 1.3.2.2 skrll s = splusb(); 340 1.3.2.2 skrll 341 1.3.2.2 skrll if (--sc->sc_refcnt >= 0) { 342 1.3.2.2 skrll /* Wait for processes to go away */ 343 1.3.2.2 skrll usb_detach_wait(USBDEV(sc->sc_dev)); 344 1.3.2.2 skrll } 345 1.3.2.2 skrll if (ifp->if_flags & IFF_RUNNING) 346 1.3.2.2 skrll udav_stop(GET_IFP(sc), 1); 347 1.3.2.2 skrll 348 1.3.2.2 skrll #if NRND > 0 349 1.3.2.2 skrll rnd_detach_source(&sc->rnd_source); 350 1.3.2.2 skrll #endif 351 1.3.2.2 skrll mii_detach(&sc->sc_mii, MII_PHY_ANY, MII_OFFSET_ANY); 352 1.3.2.2 skrll ifmedia_delete_instance(&sc->sc_mii.mii_media, IFM_INST_ANY); 353 1.3.2.2 skrll ether_ifdetach(ifp); 354 1.3.2.2 skrll if_detach(ifp); 355 1.3.2.2 skrll 356 1.3.2.2 skrll #ifdef DIAGNOSTIC 357 1.3.2.2 skrll if (sc->sc_pipe_tx != NULL) 358 1.3.2.2 skrll printf("%s: detach has active tx endpoint.\n", 359 1.3.2.2 skrll USBDEVNAME(sc->sc_dev)); 360 1.3.2.2 skrll if (sc->sc_pipe_rx != NULL) 361 1.3.2.2 skrll printf("%s: detach has active rx endpoint.\n", 362 1.3.2.2 skrll USBDEVNAME(sc->sc_dev)); 363 1.3.2.2 skrll if (sc->sc_pipe_intr != NULL) 364 1.3.2.2 skrll printf("%s: detach has active intr endpoint.\n", 365 1.3.2.2 skrll USBDEVNAME(sc->sc_dev)); 366 1.3.2.2 skrll #endif 367 1.3.2.2 skrll sc->sc_attached = 0; 368 1.3.2.2 skrll 369 1.3.2.2 skrll splx(s); 370 1.3.2.2 skrll 371 1.3.2.2 skrll usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, 372 1.3.2.2 skrll USBDEV(sc->sc_dev)); 373 1.3.2.2 skrll 374 1.3.2.2 skrll return (0); 375 1.3.2.2 skrll } 376 1.3.2.2 skrll 377 1.3.2.2 skrll #if 0 378 1.3.2.2 skrll /* read memory */ 379 1.3.2.2 skrll Static int 380 1.3.2.2 skrll udav_mem_read(struct udav_softc *sc, int offset, void *buf, int len) 381 1.3.2.2 skrll { 382 1.3.2.2 skrll usb_device_request_t req; 383 1.3.2.2 skrll usbd_status err; 384 1.3.2.2 skrll 385 1.3.2.2 skrll if (sc == NULL) 386 1.3.2.2 skrll return (0); 387 1.3.2.2 skrll 388 1.3.2.2 skrll DPRINTFN(0x200, 389 1.3.2.2 skrll ("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 390 1.3.2.2 skrll 391 1.3.2.2 skrll if (sc->sc_dying) 392 1.3.2.2 skrll return (0); 393 1.3.2.2 skrll 394 1.3.2.2 skrll offset &= 0xffff; 395 1.3.2.2 skrll len &= 0xff; 396 1.3.2.2 skrll 397 1.3.2.2 skrll req.bmRequestType = UT_READ_VENDOR_DEVICE; 398 1.3.2.2 skrll req.bRequest = UDAV_REQ_MEM_READ; 399 1.3.2.2 skrll USETW(req.wValue, 0x0000); 400 1.3.2.2 skrll USETW(req.wIndex, offset); 401 1.3.2.2 skrll USETW(req.wLength, len); 402 1.3.2.2 skrll 403 1.3.2.2 skrll sc->sc_refcnt++; 404 1.3.2.2 skrll err = usbd_do_request(sc->sc_udev, &req, buf); 405 1.3.2.2 skrll if (--sc->sc_refcnt < 0) 406 1.3.2.2 skrll usb_detach_wakeup(USBDEV(sc->sc_dev)); 407 1.3.2.2 skrll if (err) { 408 1.3.2.2 skrll DPRINTF(("%s: %s: read failed. off=%04x, err=%d\n", 409 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), __func__, offset, err)); 410 1.3.2.2 skrll } 411 1.3.2.2 skrll 412 1.3.2.2 skrll return (err); 413 1.3.2.2 skrll } 414 1.3.2.2 skrll 415 1.3.2.2 skrll /* write memory */ 416 1.3.2.2 skrll Static int 417 1.3.2.2 skrll udav_mem_write(struct udav_softc *sc, int offset, void *buf, int len) 418 1.3.2.2 skrll { 419 1.3.2.2 skrll usb_device_request_t req; 420 1.3.2.2 skrll usbd_status err; 421 1.3.2.2 skrll 422 1.3.2.2 skrll if (sc == NULL) 423 1.3.2.2 skrll return (0); 424 1.3.2.2 skrll 425 1.3.2.2 skrll DPRINTFN(0x200, 426 1.3.2.2 skrll ("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 427 1.3.2.2 skrll 428 1.3.2.2 skrll if (sc->sc_dying) 429 1.3.2.2 skrll return (0); 430 1.3.2.2 skrll 431 1.3.2.2 skrll offset &= 0xffff; 432 1.3.2.2 skrll len &= 0xff; 433 1.3.2.2 skrll 434 1.3.2.2 skrll req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 435 1.3.2.2 skrll req.bRequest = UDAV_REQ_MEM_WRITE; 436 1.3.2.2 skrll USETW(req.wValue, 0x0000); 437 1.3.2.2 skrll USETW(req.wIndex, offset); 438 1.3.2.2 skrll USETW(req.wLength, len); 439 1.3.2.2 skrll 440 1.3.2.2 skrll sc->sc_refcnt++; 441 1.3.2.2 skrll err = usbd_do_request(sc->sc_udev, &req, buf); 442 1.3.2.2 skrll if (--sc->sc_refcnt < 0) 443 1.3.2.2 skrll usb_detach_wakeup(USBDEV(sc->sc_dev)); 444 1.3.2.2 skrll if (err) { 445 1.3.2.2 skrll DPRINTF(("%s: %s: write failed. off=%04x, err=%d\n", 446 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), __func__, offset, err)); 447 1.3.2.2 skrll } 448 1.3.2.2 skrll 449 1.3.2.2 skrll return (err); 450 1.3.2.2 skrll } 451 1.3.2.2 skrll 452 1.3.2.2 skrll /* write memory */ 453 1.3.2.2 skrll Static int 454 1.3.2.2 skrll udav_mem_write1(struct udav_softc *sc, int offset, unsigned char ch) 455 1.3.2.2 skrll { 456 1.3.2.2 skrll usb_device_request_t req; 457 1.3.2.2 skrll usbd_status err; 458 1.3.2.2 skrll 459 1.3.2.2 skrll if (sc == NULL) 460 1.3.2.2 skrll return (0); 461 1.3.2.2 skrll 462 1.3.2.2 skrll DPRINTFN(0x200, 463 1.3.2.2 skrll ("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 464 1.3.2.2 skrll 465 1.3.2.2 skrll if (sc->sc_dying) 466 1.3.2.2 skrll return (0); 467 1.3.2.2 skrll 468 1.3.2.2 skrll offset &= 0xffff; 469 1.3.2.2 skrll 470 1.3.2.2 skrll req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 471 1.3.2.2 skrll req.bRequest = UDAV_REQ_MEM_WRITE1; 472 1.3.2.2 skrll USETW(req.wValue, ch); 473 1.3.2.2 skrll USETW(req.wIndex, offset); 474 1.3.2.2 skrll USETW(req.wLength, 0x0000); 475 1.3.2.2 skrll 476 1.3.2.2 skrll sc->sc_refcnt++; 477 1.3.2.2 skrll err = usbd_do_request(sc->sc_udev, &req, NULL); 478 1.3.2.2 skrll if (--sc->sc_refcnt < 0) 479 1.3.2.2 skrll usb_detach_wakeup(USBDEV(sc->sc_dev)); 480 1.3.2.2 skrll if (err) { 481 1.3.2.2 skrll DPRINTF(("%s: %s: write failed. off=%04x, err=%d\n", 482 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), __func__, offset, err)); 483 1.3.2.2 skrll } 484 1.3.2.2 skrll 485 1.3.2.2 skrll return (err); 486 1.3.2.2 skrll } 487 1.3.2.2 skrll #endif 488 1.3.2.2 skrll 489 1.3.2.2 skrll /* read register(s) */ 490 1.3.2.2 skrll Static int 491 1.3.2.2 skrll udav_csr_read(struct udav_softc *sc, int offset, void *buf, int len) 492 1.3.2.2 skrll { 493 1.3.2.2 skrll usb_device_request_t req; 494 1.3.2.2 skrll usbd_status err; 495 1.3.2.2 skrll 496 1.3.2.2 skrll if (sc == NULL) 497 1.3.2.2 skrll return (0); 498 1.3.2.2 skrll 499 1.3.2.2 skrll DPRINTFN(0x200, 500 1.3.2.2 skrll ("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 501 1.3.2.2 skrll 502 1.3.2.2 skrll if (sc->sc_dying) 503 1.3.2.2 skrll return (0); 504 1.3.2.2 skrll 505 1.3.2.2 skrll offset &= 0xff; 506 1.3.2.2 skrll len &= 0xff; 507 1.3.2.2 skrll 508 1.3.2.2 skrll req.bmRequestType = UT_READ_VENDOR_DEVICE; 509 1.3.2.2 skrll req.bRequest = UDAV_REQ_REG_READ; 510 1.3.2.2 skrll USETW(req.wValue, 0x0000); 511 1.3.2.2 skrll USETW(req.wIndex, offset); 512 1.3.2.2 skrll USETW(req.wLength, len); 513 1.3.2.2 skrll 514 1.3.2.2 skrll sc->sc_refcnt++; 515 1.3.2.2 skrll err = usbd_do_request(sc->sc_udev, &req, buf); 516 1.3.2.2 skrll if (--sc->sc_refcnt < 0) 517 1.3.2.2 skrll usb_detach_wakeup(USBDEV(sc->sc_dev)); 518 1.3.2.2 skrll if (err) { 519 1.3.2.2 skrll DPRINTF(("%s: %s: read failed. off=%04x, err=%d\n", 520 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), __func__, offset, err)); 521 1.3.2.2 skrll } 522 1.3.2.2 skrll 523 1.3.2.2 skrll return (err); 524 1.3.2.2 skrll } 525 1.3.2.2 skrll 526 1.3.2.2 skrll /* write register(s) */ 527 1.3.2.2 skrll Static int 528 1.3.2.2 skrll udav_csr_write(struct udav_softc *sc, int offset, void *buf, int len) 529 1.3.2.2 skrll { 530 1.3.2.2 skrll usb_device_request_t req; 531 1.3.2.2 skrll usbd_status err; 532 1.3.2.2 skrll 533 1.3.2.2 skrll if (sc == NULL) 534 1.3.2.2 skrll return (0); 535 1.3.2.2 skrll 536 1.3.2.2 skrll DPRINTFN(0x200, 537 1.3.2.2 skrll ("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 538 1.3.2.2 skrll 539 1.3.2.2 skrll if (sc->sc_dying) 540 1.3.2.2 skrll return (0); 541 1.3.2.2 skrll 542 1.3.2.2 skrll offset &= 0xff; 543 1.3.2.2 skrll len &= 0xff; 544 1.3.2.2 skrll 545 1.3.2.2 skrll req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 546 1.3.2.2 skrll req.bRequest = UDAV_REQ_REG_WRITE; 547 1.3.2.2 skrll USETW(req.wValue, 0x0000); 548 1.3.2.2 skrll USETW(req.wIndex, offset); 549 1.3.2.2 skrll USETW(req.wLength, len); 550 1.3.2.2 skrll 551 1.3.2.2 skrll sc->sc_refcnt++; 552 1.3.2.2 skrll err = usbd_do_request(sc->sc_udev, &req, buf); 553 1.3.2.2 skrll if (--sc->sc_refcnt < 0) 554 1.3.2.2 skrll usb_detach_wakeup(USBDEV(sc->sc_dev)); 555 1.3.2.2 skrll if (err) { 556 1.3.2.2 skrll DPRINTF(("%s: %s: write failed. off=%04x, err=%d\n", 557 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), __func__, offset, err)); 558 1.3.2.2 skrll } 559 1.3.2.2 skrll 560 1.3.2.2 skrll return (err); 561 1.3.2.2 skrll } 562 1.3.2.2 skrll 563 1.3.2.2 skrll Static int 564 1.3.2.2 skrll udav_csr_read1(struct udav_softc *sc, int offset) 565 1.3.2.2 skrll { 566 1.3.2.2 skrll u_int8_t val = 0; 567 1.3.2.2 skrll 568 1.3.2.2 skrll if (sc == NULL) 569 1.3.2.2 skrll return (0); 570 1.3.2.2 skrll 571 1.3.2.2 skrll DPRINTFN(0x200, 572 1.3.2.2 skrll ("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 573 1.3.2.2 skrll 574 1.3.2.2 skrll if (sc->sc_dying) 575 1.3.2.2 skrll return (0); 576 1.3.2.2 skrll 577 1.3.2.2 skrll return (udav_csr_read(sc, offset, &val, 1) ? 0 : val); 578 1.3.2.2 skrll } 579 1.3.2.2 skrll 580 1.3.2.2 skrll /* write a register */ 581 1.3.2.2 skrll Static int 582 1.3.2.2 skrll udav_csr_write1(struct udav_softc *sc, int offset, unsigned char ch) 583 1.3.2.2 skrll { 584 1.3.2.2 skrll usb_device_request_t req; 585 1.3.2.2 skrll usbd_status err; 586 1.3.2.2 skrll 587 1.3.2.2 skrll if (sc == NULL) 588 1.3.2.2 skrll return (0); 589 1.3.2.2 skrll 590 1.3.2.2 skrll DPRINTFN(0x200, 591 1.3.2.2 skrll ("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 592 1.3.2.2 skrll 593 1.3.2.2 skrll if (sc->sc_dying) 594 1.3.2.2 skrll return (0); 595 1.3.2.2 skrll 596 1.3.2.2 skrll offset &= 0xff; 597 1.3.2.2 skrll 598 1.3.2.2 skrll req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 599 1.3.2.2 skrll req.bRequest = UDAV_REQ_REG_WRITE1; 600 1.3.2.2 skrll USETW(req.wValue, ch); 601 1.3.2.2 skrll USETW(req.wIndex, offset); 602 1.3.2.2 skrll USETW(req.wLength, 0x0000); 603 1.3.2.2 skrll 604 1.3.2.2 skrll sc->sc_refcnt++; 605 1.3.2.2 skrll err = usbd_do_request(sc->sc_udev, &req, NULL); 606 1.3.2.2 skrll if (--sc->sc_refcnt < 0) 607 1.3.2.2 skrll usb_detach_wakeup(USBDEV(sc->sc_dev)); 608 1.3.2.2 skrll if (err) { 609 1.3.2.2 skrll DPRINTF(("%s: %s: write failed. off=%04x, err=%d\n", 610 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), __func__, offset, err)); 611 1.3.2.2 skrll } 612 1.3.2.2 skrll 613 1.3.2.2 skrll return (err); 614 1.3.2.2 skrll } 615 1.3.2.2 skrll 616 1.3.2.2 skrll Static int 617 1.3.2.2 skrll udav_init(struct ifnet *ifp) 618 1.3.2.2 skrll { 619 1.3.2.2 skrll struct udav_softc *sc = ifp->if_softc; 620 1.3.2.2 skrll struct mii_data *mii = GET_MII(sc); 621 1.3.2.2 skrll u_char *eaddr; 622 1.3.2.2 skrll int s; 623 1.3.2.2 skrll 624 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 625 1.3.2.2 skrll 626 1.3.2.2 skrll if (sc->sc_dying) 627 1.3.2.2 skrll return (EIO); 628 1.3.2.2 skrll 629 1.3.2.2 skrll s = splnet(); 630 1.3.2.2 skrll 631 1.3.2.2 skrll /* Cancel pending I/O and free all TX/RX buffers */ 632 1.3.2.2 skrll udav_stop(ifp, 1); 633 1.3.2.2 skrll 634 1.3.2.2 skrll eaddr = LLADDR(ifp->if_sadl); 635 1.3.2.2 skrll udav_csr_write(sc, UDAV_PAR, eaddr, ETHER_ADDR_LEN); 636 1.3.2.2 skrll 637 1.3.2.2 skrll /* Initialize network control register */ 638 1.3.2.2 skrll /* Disable loopback */ 639 1.3.2.2 skrll UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_LBK0 | UDAV_NCR_LBK1); 640 1.3.2.2 skrll 641 1.3.2.2 skrll /* Initialize RX control register */ 642 1.3.2.2 skrll UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_DIS_LONG | UDAV_RCR_DIS_CRC); 643 1.3.2.2 skrll 644 1.3.2.2 skrll /* If we want promiscuous mode, accept all physical frames. */ 645 1.3.2.2 skrll if (ifp->if_flags & IFF_PROMISC) 646 1.3.2.2 skrll UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_ALL|UDAV_RCR_PRMSC); 647 1.3.2.2 skrll else 648 1.3.2.2 skrll UDAV_CLRBIT(sc, UDAV_RCR, UDAV_RCR_ALL|UDAV_RCR_PRMSC); 649 1.3.2.2 skrll 650 1.3.2.2 skrll /* Initialize transmit ring */ 651 1.3.2.2 skrll if (udav_tx_list_init(sc) == ENOBUFS) { 652 1.3.2.2 skrll printf("%s: tx list init failed\n", USBDEVNAME(sc->sc_dev)); 653 1.3.2.2 skrll splx(s); 654 1.3.2.2 skrll return (EIO); 655 1.3.2.2 skrll } 656 1.3.2.2 skrll 657 1.3.2.2 skrll /* Initialize receive ring */ 658 1.3.2.2 skrll if (udav_rx_list_init(sc) == ENOBUFS) { 659 1.3.2.2 skrll printf("%s: rx list init failed\n", USBDEVNAME(sc->sc_dev)); 660 1.3.2.2 skrll splx(s); 661 1.3.2.2 skrll return (EIO); 662 1.3.2.2 skrll } 663 1.3.2.2 skrll 664 1.3.2.2 skrll /* Load the multicast filter */ 665 1.3.2.2 skrll udav_setmulti(sc); 666 1.3.2.2 skrll 667 1.3.2.2 skrll /* Enable RX */ 668 1.3.2.2 skrll UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_RXEN); 669 1.3.2.2 skrll 670 1.3.2.2 skrll /* clear POWER_DOWN state of internal PHY */ 671 1.3.2.2 skrll UDAV_SETBIT(sc, UDAV_GPCR, UDAV_GPCR_GEP_CNTL0); 672 1.3.2.2 skrll UDAV_CLRBIT(sc, UDAV_GPR, UDAV_GPR_GEPIO0); 673 1.3.2.2 skrll 674 1.3.2.2 skrll mii_mediachg(mii); 675 1.3.2.2 skrll 676 1.3.2.2 skrll if (sc->sc_pipe_tx == NULL || sc->sc_pipe_rx == NULL) { 677 1.3.2.2 skrll if (udav_openpipes(sc)) { 678 1.3.2.2 skrll splx(s); 679 1.3.2.2 skrll return (EIO); 680 1.3.2.2 skrll } 681 1.3.2.2 skrll } 682 1.3.2.2 skrll 683 1.3.2.2 skrll ifp->if_flags |= IFF_RUNNING; 684 1.3.2.2 skrll ifp->if_flags &= ~IFF_OACTIVE; 685 1.3.2.2 skrll 686 1.3.2.2 skrll splx(s); 687 1.3.2.2 skrll 688 1.3.2.2 skrll usb_callout(sc->sc_stat_ch, hz, udav_tick, sc); 689 1.3.2.2 skrll 690 1.3.2.2 skrll return (0); 691 1.3.2.2 skrll } 692 1.3.2.2 skrll 693 1.3.2.2 skrll Static void 694 1.3.2.2 skrll udav_reset(struct udav_softc *sc) 695 1.3.2.2 skrll { 696 1.3.2.2 skrll int i; 697 1.3.2.2 skrll 698 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 699 1.3.2.2 skrll 700 1.3.2.2 skrll if (sc->sc_dying) 701 1.3.2.2 skrll return; 702 1.3.2.2 skrll 703 1.3.2.2 skrll /* Select PHY */ 704 1.3.2.2 skrll #if 1 705 1.3.2.2 skrll /* 706 1.3.2.2 skrll * XXX: force select internal phy. 707 1.3.2.2 skrll * external phy routines are not tested. 708 1.3.2.2 skrll */ 709 1.3.2.2 skrll UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY); 710 1.3.2.2 skrll #else 711 1.3.2.2 skrll if (sc->sc_flags & UDAV_EXT_PHY) { 712 1.3.2.2 skrll UDAV_SETBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY); 713 1.3.2.2 skrll } else { 714 1.3.2.2 skrll UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY); 715 1.3.2.2 skrll } 716 1.3.2.2 skrll #endif 717 1.3.2.2 skrll 718 1.3.2.2 skrll UDAV_SETBIT(sc, UDAV_NCR, UDAV_NCR_RST); 719 1.3.2.2 skrll 720 1.3.2.2 skrll for (i = 0; i < UDAV_TX_TIMEOUT; i++) { 721 1.3.2.2 skrll if (!(udav_csr_read1(sc, UDAV_NCR) & UDAV_NCR_RST)) 722 1.3.2.2 skrll break; 723 1.3.2.2 skrll delay(10); /* XXX */ 724 1.3.2.2 skrll } 725 1.3.2.2 skrll delay(10000); /* XXX */ 726 1.3.2.2 skrll } 727 1.3.2.2 skrll 728 1.3.2.2 skrll int 729 1.3.2.2 skrll udav_activate(device_ptr_t self, enum devact act) 730 1.3.2.2 skrll { 731 1.3.2.2 skrll struct udav_softc *sc = (struct udav_softc *)self; 732 1.3.2.2 skrll 733 1.3.2.2 skrll DPRINTF(("%s: %s: enter, act=%d\n", USBDEVNAME(sc->sc_dev), 734 1.3.2.2 skrll __func__, act)); 735 1.3.2.2 skrll switch (act) { 736 1.3.2.2 skrll case DVACT_ACTIVATE: 737 1.3.2.2 skrll return (EOPNOTSUPP); 738 1.3.2.2 skrll break; 739 1.3.2.2 skrll 740 1.3.2.2 skrll case DVACT_DEACTIVATE: 741 1.3.2.2 skrll if_deactivate(&sc->sc_ec.ec_if); 742 1.3.2.2 skrll sc->sc_dying = 1; 743 1.3.2.2 skrll break; 744 1.3.2.2 skrll } 745 1.3.2.2 skrll return (0); 746 1.3.2.2 skrll } 747 1.3.2.2 skrll 748 1.3.2.2 skrll #define UDAV_BITS 6 749 1.3.2.2 skrll 750 1.3.2.2 skrll #define UDAV_CALCHASH(addr) \ 751 1.3.2.2 skrll (ether_crc32_le((addr), ETHER_ADDR_LEN) & ((1 << UDAV_BITS) - 1)) 752 1.3.2.2 skrll 753 1.3.2.2 skrll Static void 754 1.3.2.2 skrll udav_setmulti(struct udav_softc *sc) 755 1.3.2.2 skrll { 756 1.3.2.2 skrll struct ifnet *ifp; 757 1.3.2.2 skrll struct ether_multi *enm; 758 1.3.2.2 skrll struct ether_multistep step; 759 1.3.2.2 skrll u_int8_t hashes[8]; 760 1.3.2.2 skrll int h = 0; 761 1.3.2.2 skrll 762 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 763 1.3.2.2 skrll 764 1.3.2.2 skrll if (sc->sc_dying) 765 1.3.2.2 skrll return; 766 1.3.2.2 skrll 767 1.3.2.2 skrll ifp = GET_IFP(sc); 768 1.3.2.2 skrll 769 1.3.2.2 skrll if (ifp->if_flags & IFF_PROMISC) { 770 1.3.2.2 skrll UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_ALL|UDAV_RCR_PRMSC); 771 1.3.2.2 skrll return; 772 1.3.2.2 skrll } else if (ifp->if_flags & IFF_ALLMULTI) { 773 1.3.2.2 skrll allmulti: 774 1.3.2.2 skrll ifp->if_flags |= IFF_ALLMULTI; 775 1.3.2.2 skrll UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_ALL); 776 1.3.2.2 skrll UDAV_CLRBIT(sc, UDAV_RCR, UDAV_RCR_PRMSC); 777 1.3.2.2 skrll return; 778 1.3.2.2 skrll } 779 1.3.2.2 skrll 780 1.3.2.2 skrll /* first, zot all the existing hash bits */ 781 1.3.2.2 skrll memset(hashes, 0x00, sizeof(hashes)); 782 1.3.2.2 skrll hashes[7] |= 0x80; /* broadcast address */ 783 1.3.2.2 skrll udav_csr_write(sc, UDAV_MAR, hashes, sizeof(hashes)); 784 1.3.2.2 skrll 785 1.3.2.2 skrll /* now program new ones */ 786 1.3.2.2 skrll ETHER_FIRST_MULTI(step, &sc->sc_ec, enm); 787 1.3.2.2 skrll while (enm != NULL) { 788 1.3.2.2 skrll if (memcmp(enm->enm_addrlo, enm->enm_addrhi, 789 1.3.2.2 skrll ETHER_ADDR_LEN) != 0) 790 1.3.2.2 skrll goto allmulti; 791 1.3.2.2 skrll 792 1.3.2.2 skrll h = UDAV_CALCHASH(enm->enm_addrlo); 793 1.3.2.2 skrll hashes[h>>3] |= 1 << (h & 0x7); 794 1.3.2.2 skrll ETHER_NEXT_MULTI(step, enm); 795 1.3.2.2 skrll } 796 1.3.2.2 skrll 797 1.3.2.2 skrll /* disable all multicast */ 798 1.3.2.2 skrll ifp->if_flags &= ~IFF_ALLMULTI; 799 1.3.2.2 skrll UDAV_CLRBIT(sc, UDAV_RCR, UDAV_RCR_ALL); 800 1.3.2.2 skrll 801 1.3.2.2 skrll /* write hash value to the register */ 802 1.3.2.2 skrll udav_csr_write(sc, UDAV_MAR, hashes, sizeof(hashes)); 803 1.3.2.2 skrll } 804 1.3.2.2 skrll 805 1.3.2.2 skrll Static int 806 1.3.2.2 skrll udav_openpipes(struct udav_softc *sc) 807 1.3.2.2 skrll { 808 1.3.2.2 skrll struct udav_chain *c; 809 1.3.2.2 skrll usbd_status err; 810 1.3.2.2 skrll int i; 811 1.3.2.2 skrll int error = 0; 812 1.3.2.2 skrll 813 1.3.2.2 skrll if (sc->sc_dying) 814 1.3.2.2 skrll return (EIO); 815 1.3.2.2 skrll 816 1.3.2.2 skrll sc->sc_refcnt++; 817 1.3.2.2 skrll 818 1.3.2.2 skrll /* Open RX pipe */ 819 1.3.2.2 skrll err = usbd_open_pipe(sc->sc_ctl_iface, sc->sc_bulkin_no, 820 1.3.2.2 skrll USBD_EXCLUSIVE_USE, &sc->sc_pipe_rx); 821 1.3.2.2 skrll if (err) { 822 1.3.2.2 skrll printf("%s: open rx pipe failed: %s\n", 823 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), usbd_errstr(err)); 824 1.3.2.2 skrll error = EIO; 825 1.3.2.2 skrll goto done; 826 1.3.2.2 skrll } 827 1.3.2.2 skrll 828 1.3.2.2 skrll /* Open TX pipe */ 829 1.3.2.2 skrll err = usbd_open_pipe(sc->sc_ctl_iface, sc->sc_bulkout_no, 830 1.3.2.2 skrll USBD_EXCLUSIVE_USE, &sc->sc_pipe_tx); 831 1.3.2.2 skrll if (err) { 832 1.3.2.2 skrll printf("%s: open tx pipe failed: %s\n", 833 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), usbd_errstr(err)); 834 1.3.2.2 skrll error = EIO; 835 1.3.2.2 skrll goto done; 836 1.3.2.2 skrll } 837 1.3.2.2 skrll 838 1.3.2.2 skrll #if 0 839 1.3.2.2 skrll /* XXX: interrupt endpoint is not yet supported */ 840 1.3.2.2 skrll /* Open Interrupt pipe */ 841 1.3.2.2 skrll err = usbd_open_pipe_intr(sc->sc_ctl_iface, sc->sc_intrin_no, 842 1.3.2.2 skrll USBD_EXCLUSIVE_USE, &sc->sc_pipe_intr, sc, 843 1.3.2.2 skrll &sc->sc_cdata.udav_ibuf, UDAV_INTR_PKGLEN, 844 1.3.2.2 skrll udav_intr, UDAV_INTR_INTERVAL); 845 1.3.2.2 skrll if (err) { 846 1.3.2.2 skrll printf("%s: open intr pipe failed: %s\n", 847 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), usbd_errstr(err)); 848 1.3.2.2 skrll error = EIO; 849 1.3.2.2 skrll goto done; 850 1.3.2.2 skrll } 851 1.3.2.2 skrll #endif 852 1.3.2.2 skrll 853 1.3.2.2 skrll 854 1.3.2.2 skrll /* Start up the receive pipe. */ 855 1.3.2.2 skrll for (i = 0; i < UDAV_RX_LIST_CNT; i++) { 856 1.3.2.2 skrll c = &sc->sc_cdata.udav_rx_chain[i]; 857 1.3.2.2 skrll usbd_setup_xfer(c->udav_xfer, sc->sc_pipe_rx, 858 1.3.2.2 skrll c, c->udav_buf, UDAV_BUFSZ, 859 1.3.2.2 skrll USBD_SHORT_XFER_OK | USBD_NO_COPY, 860 1.3.2.2 skrll USBD_NO_TIMEOUT, udav_rxeof); 861 1.3.2.2 skrll (void)usbd_transfer(c->udav_xfer); 862 1.3.2.2 skrll DPRINTF(("%s: %s: start read\n", USBDEVNAME(sc->sc_dev), 863 1.3.2.2 skrll __func__)); 864 1.3.2.2 skrll } 865 1.3.2.2 skrll 866 1.3.2.2 skrll done: 867 1.3.2.2 skrll if (--sc->sc_refcnt < 0) 868 1.3.2.2 skrll usb_detach_wakeup(USBDEV(sc->sc_dev)); 869 1.3.2.2 skrll 870 1.3.2.2 skrll return (error); 871 1.3.2.2 skrll } 872 1.3.2.2 skrll 873 1.3.2.2 skrll Static int 874 1.3.2.2 skrll udav_newbuf(struct udav_softc *sc, struct udav_chain *c, struct mbuf *m) 875 1.3.2.2 skrll { 876 1.3.2.2 skrll struct mbuf *m_new = NULL; 877 1.3.2.2 skrll 878 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 879 1.3.2.2 skrll 880 1.3.2.2 skrll if (m == NULL) { 881 1.3.2.2 skrll MGETHDR(m_new, M_DONTWAIT, MT_DATA); 882 1.3.2.2 skrll if (m_new == NULL) { 883 1.3.2.2 skrll printf("%s: no memory for rx list " 884 1.3.2.2 skrll "-- packet dropped!\n", USBDEVNAME(sc->sc_dev)); 885 1.3.2.2 skrll return (ENOBUFS); 886 1.3.2.2 skrll } 887 1.3.2.2 skrll MCLGET(m_new, M_DONTWAIT); 888 1.3.2.2 skrll if (!(m_new->m_flags & M_EXT)) { 889 1.3.2.2 skrll printf("%s: no memory for rx list " 890 1.3.2.2 skrll "-- packet dropped!\n", USBDEVNAME(sc->sc_dev)); 891 1.3.2.2 skrll m_freem(m_new); 892 1.3.2.2 skrll return (ENOBUFS); 893 1.3.2.2 skrll } 894 1.3.2.2 skrll m_new->m_len = m_new->m_pkthdr.len = MCLBYTES; 895 1.3.2.2 skrll } else { 896 1.3.2.2 skrll m_new = m; 897 1.3.2.2 skrll m_new->m_len = m_new->m_pkthdr.len = MCLBYTES; 898 1.3.2.2 skrll m_new->m_data = m_new->m_ext.ext_buf; 899 1.3.2.2 skrll } 900 1.3.2.2 skrll 901 1.3.2.2 skrll m_adj(m_new, ETHER_ALIGN); 902 1.3.2.2 skrll c->udav_mbuf = m_new; 903 1.3.2.2 skrll 904 1.3.2.2 skrll return (0); 905 1.3.2.2 skrll } 906 1.3.2.2 skrll 907 1.3.2.2 skrll 908 1.3.2.2 skrll Static int 909 1.3.2.2 skrll udav_rx_list_init(struct udav_softc *sc) 910 1.3.2.2 skrll { 911 1.3.2.2 skrll struct udav_cdata *cd; 912 1.3.2.2 skrll struct udav_chain *c; 913 1.3.2.2 skrll int i; 914 1.3.2.2 skrll 915 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 916 1.3.2.2 skrll 917 1.3.2.2 skrll cd = &sc->sc_cdata; 918 1.3.2.2 skrll for (i = 0; i < UDAV_RX_LIST_CNT; i++) { 919 1.3.2.2 skrll c = &cd->udav_rx_chain[i]; 920 1.3.2.2 skrll c->udav_sc = sc; 921 1.3.2.2 skrll c->udav_idx = i; 922 1.3.2.2 skrll if (udav_newbuf(sc, c, NULL) == ENOBUFS) 923 1.3.2.2 skrll return (ENOBUFS); 924 1.3.2.2 skrll if (c->udav_xfer == NULL) { 925 1.3.2.2 skrll c->udav_xfer = usbd_alloc_xfer(sc->sc_udev); 926 1.3.2.2 skrll if (c->udav_xfer == NULL) 927 1.3.2.2 skrll return (ENOBUFS); 928 1.3.2.2 skrll c->udav_buf = usbd_alloc_buffer(c->udav_xfer, UDAV_BUFSZ); 929 1.3.2.2 skrll if (c->udav_buf == NULL) { 930 1.3.2.2 skrll usbd_free_xfer(c->udav_xfer); 931 1.3.2.2 skrll return (ENOBUFS); 932 1.3.2.2 skrll } 933 1.3.2.2 skrll } 934 1.3.2.2 skrll } 935 1.3.2.2 skrll 936 1.3.2.2 skrll return (0); 937 1.3.2.2 skrll } 938 1.3.2.2 skrll 939 1.3.2.2 skrll Static int 940 1.3.2.2 skrll udav_tx_list_init(struct udav_softc *sc) 941 1.3.2.2 skrll { 942 1.3.2.2 skrll struct udav_cdata *cd; 943 1.3.2.2 skrll struct udav_chain *c; 944 1.3.2.2 skrll int i; 945 1.3.2.2 skrll 946 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 947 1.3.2.2 skrll 948 1.3.2.2 skrll cd = &sc->sc_cdata; 949 1.3.2.2 skrll for (i = 0; i < UDAV_TX_LIST_CNT; i++) { 950 1.3.2.2 skrll c = &cd->udav_tx_chain[i]; 951 1.3.2.2 skrll c->udav_sc = sc; 952 1.3.2.2 skrll c->udav_idx = i; 953 1.3.2.2 skrll c->udav_mbuf = NULL; 954 1.3.2.2 skrll if (c->udav_xfer == NULL) { 955 1.3.2.2 skrll c->udav_xfer = usbd_alloc_xfer(sc->sc_udev); 956 1.3.2.2 skrll if (c->udav_xfer == NULL) 957 1.3.2.2 skrll return (ENOBUFS); 958 1.3.2.2 skrll c->udav_buf = usbd_alloc_buffer(c->udav_xfer, UDAV_BUFSZ); 959 1.3.2.2 skrll if (c->udav_buf == NULL) { 960 1.3.2.2 skrll usbd_free_xfer(c->udav_xfer); 961 1.3.2.2 skrll return (ENOBUFS); 962 1.3.2.2 skrll } 963 1.3.2.2 skrll } 964 1.3.2.2 skrll } 965 1.3.2.2 skrll 966 1.3.2.2 skrll return (0); 967 1.3.2.2 skrll } 968 1.3.2.2 skrll 969 1.3.2.2 skrll Static void 970 1.3.2.2 skrll udav_start(struct ifnet *ifp) 971 1.3.2.2 skrll { 972 1.3.2.2 skrll struct udav_softc *sc = ifp->if_softc; 973 1.3.2.2 skrll struct mbuf *m_head = NULL; 974 1.3.2.2 skrll 975 1.3.2.2 skrll DPRINTF(("%s: %s: enter, link=%d\n", USBDEVNAME(sc->sc_dev), 976 1.3.2.2 skrll __func__, sc->sc_link)); 977 1.3.2.2 skrll 978 1.3.2.2 skrll if (sc->sc_dying) 979 1.3.2.2 skrll return; 980 1.3.2.2 skrll 981 1.3.2.2 skrll if (!sc->sc_link) 982 1.3.2.2 skrll return; 983 1.3.2.2 skrll 984 1.3.2.2 skrll if (ifp->if_flags & IFF_OACTIVE) 985 1.3.2.2 skrll return; 986 1.3.2.2 skrll 987 1.3.2.2 skrll IFQ_POLL(&ifp->if_snd, m_head); 988 1.3.2.2 skrll if (m_head == NULL) 989 1.3.2.2 skrll return; 990 1.3.2.2 skrll 991 1.3.2.2 skrll if (udav_send(sc, m_head, 0)) { 992 1.3.2.2 skrll ifp->if_flags |= IFF_OACTIVE; 993 1.3.2.2 skrll return; 994 1.3.2.2 skrll } 995 1.3.2.2 skrll 996 1.3.2.2 skrll IFQ_DEQUEUE(&ifp->if_snd, m_head); 997 1.3.2.2 skrll 998 1.3.2.2 skrll #if NBPFILTER > 0 999 1.3.2.2 skrll if (ifp->if_bpf) 1000 1.3.2.2 skrll bpf_mtap(ifp->if_bpf, m_head); 1001 1.3.2.2 skrll #endif 1002 1.3.2.2 skrll 1003 1.3.2.2 skrll ifp->if_flags |= IFF_OACTIVE; 1004 1.3.2.2 skrll 1005 1.3.2.2 skrll /* Set a timeout in case the chip goes out to lunch. */ 1006 1.3.2.2 skrll ifp->if_timer = 5; 1007 1.3.2.2 skrll } 1008 1.3.2.2 skrll 1009 1.3.2.2 skrll Static int 1010 1.3.2.2 skrll udav_send(struct udav_softc *sc, struct mbuf *m, int idx) 1011 1.3.2.2 skrll { 1012 1.3.2.2 skrll int total_len; 1013 1.3.2.2 skrll struct udav_chain *c; 1014 1.3.2.2 skrll usbd_status err; 1015 1.3.2.2 skrll 1016 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev),__func__)); 1017 1.3.2.2 skrll 1018 1.3.2.2 skrll c = &sc->sc_cdata.udav_tx_chain[idx]; 1019 1.3.2.2 skrll 1020 1.3.2.2 skrll /* Copy the mbuf data into a contiguous buffer */ 1021 1.3.2.2 skrll /* first 2 bytes are packet length */ 1022 1.3.2.2 skrll m_copydata(m, 0, m->m_pkthdr.len, c->udav_buf + 2); 1023 1.3.2.2 skrll c->udav_mbuf = m; 1024 1.3.2.2 skrll total_len = m->m_pkthdr.len; 1025 1.3.2.2 skrll if (total_len < UDAV_MIN_FRAME_LEN) { 1026 1.3.2.2 skrll memset(c->udav_buf + 2 + total_len, 0, 1027 1.3.2.2 skrll UDAV_MIN_FRAME_LEN - total_len); 1028 1.3.2.2 skrll total_len = UDAV_MIN_FRAME_LEN; 1029 1.3.2.2 skrll } 1030 1.3.2.2 skrll 1031 1.3.2.2 skrll /* Frame length is specified in the first 2bytes of the buffer */ 1032 1.3.2.2 skrll c->udav_buf[0] = (u_int8_t)total_len; 1033 1.3.2.2 skrll c->udav_buf[1] = (u_int8_t)(total_len >> 8); 1034 1.3.2.2 skrll total_len += 2; 1035 1.3.2.2 skrll 1036 1.3.2.2 skrll usbd_setup_xfer(c->udav_xfer, sc->sc_pipe_tx, c, c->udav_buf, total_len, 1037 1.3.2.2 skrll USBD_FORCE_SHORT_XFER | USBD_NO_COPY, 1038 1.3.2.2 skrll UDAV_TX_TIMEOUT, udav_txeof); 1039 1.3.2.2 skrll 1040 1.3.2.2 skrll /* Transmit */ 1041 1.3.2.2 skrll sc->sc_refcnt++; 1042 1.3.2.2 skrll err = usbd_transfer(c->udav_xfer); 1043 1.3.2.2 skrll if (--sc->sc_refcnt < 0) 1044 1.3.2.2 skrll usb_detach_wakeup(USBDEV(sc->sc_dev)); 1045 1.3.2.2 skrll if (err != USBD_IN_PROGRESS) { 1046 1.3.2.2 skrll printf("%s: udav_send error=%s\n", USBDEVNAME(sc->sc_dev), 1047 1.3.2.2 skrll usbd_errstr(err)); 1048 1.3.2.2 skrll /* Stop the interface */ 1049 1.3.2.2 skrll usb_add_task(sc->sc_udev, &sc->sc_stop_task); 1050 1.3.2.2 skrll return (EIO); 1051 1.3.2.2 skrll } 1052 1.3.2.2 skrll 1053 1.3.2.2 skrll DPRINTF(("%s: %s: send %d bytes\n", USBDEVNAME(sc->sc_dev), 1054 1.3.2.2 skrll __func__, total_len)); 1055 1.3.2.2 skrll 1056 1.3.2.2 skrll sc->sc_cdata.udav_tx_cnt++; 1057 1.3.2.2 skrll 1058 1.3.2.2 skrll return (0); 1059 1.3.2.2 skrll } 1060 1.3.2.2 skrll 1061 1.3.2.2 skrll Static void 1062 1.3.2.2 skrll udav_txeof(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status) 1063 1.3.2.2 skrll { 1064 1.3.2.2 skrll struct udav_chain *c = priv; 1065 1.3.2.2 skrll struct udav_softc *sc = c->udav_sc; 1066 1.3.2.2 skrll struct ifnet *ifp = GET_IFP(sc); 1067 1.3.2.2 skrll int s; 1068 1.3.2.2 skrll 1069 1.3.2.2 skrll if (sc->sc_dying) 1070 1.3.2.2 skrll return; 1071 1.3.2.2 skrll 1072 1.3.2.2 skrll s = splnet(); 1073 1.3.2.2 skrll 1074 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 1075 1.3.2.2 skrll 1076 1.3.2.2 skrll ifp->if_timer = 0; 1077 1.3.2.2 skrll ifp->if_flags &= ~IFF_OACTIVE; 1078 1.3.2.2 skrll 1079 1.3.2.2 skrll if (status != USBD_NORMAL_COMPLETION) { 1080 1.3.2.2 skrll if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) { 1081 1.3.2.2 skrll splx(s); 1082 1.3.2.2 skrll return; 1083 1.3.2.2 skrll } 1084 1.3.2.2 skrll ifp->if_oerrors++; 1085 1.3.2.2 skrll printf("%s: usb error on tx: %s\n", USBDEVNAME(sc->sc_dev), 1086 1.3.2.2 skrll usbd_errstr(status)); 1087 1.3.2.2 skrll if (status == USBD_STALLED) { 1088 1.3.2.2 skrll sc->sc_refcnt++; 1089 1.3.2.2 skrll usbd_clear_endpoint_stall(sc->sc_pipe_tx); 1090 1.3.2.2 skrll if (--sc->sc_refcnt < 0) 1091 1.3.2.2 skrll usb_detach_wakeup(USBDEV(sc->sc_dev)); 1092 1.3.2.2 skrll } 1093 1.3.2.2 skrll splx(s); 1094 1.3.2.2 skrll return; 1095 1.3.2.2 skrll } 1096 1.3.2.2 skrll 1097 1.3.2.2 skrll ifp->if_opackets++; 1098 1.3.2.2 skrll 1099 1.3.2.2 skrll m_freem(c->udav_mbuf); 1100 1.3.2.2 skrll c->udav_mbuf = NULL; 1101 1.3.2.2 skrll 1102 1.3.2.2 skrll if (IFQ_IS_EMPTY(&ifp->if_snd) == 0) 1103 1.3.2.2 skrll udav_start(ifp); 1104 1.3.2.2 skrll 1105 1.3.2.2 skrll splx(s); 1106 1.3.2.2 skrll } 1107 1.3.2.2 skrll 1108 1.3.2.2 skrll Static void 1109 1.3.2.2 skrll udav_rxeof(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status) 1110 1.3.2.2 skrll { 1111 1.3.2.2 skrll struct udav_chain *c = priv; 1112 1.3.2.2 skrll struct udav_softc *sc = c->udav_sc; 1113 1.3.2.2 skrll struct ifnet *ifp = GET_IFP(sc); 1114 1.3.2.2 skrll struct mbuf *m; 1115 1.3.2.2 skrll u_int32_t total_len; 1116 1.3.2.2 skrll u_int8_t *pktstat; 1117 1.3.2.2 skrll int s; 1118 1.3.2.2 skrll 1119 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev),__func__)); 1120 1.3.2.2 skrll 1121 1.3.2.2 skrll if (sc->sc_dying) 1122 1.3.2.2 skrll return; 1123 1.3.2.2 skrll 1124 1.3.2.2 skrll if (status != USBD_NORMAL_COMPLETION) { 1125 1.3.2.2 skrll if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) 1126 1.3.2.2 skrll return; 1127 1.3.2.2 skrll sc->sc_rx_errs++; 1128 1.3.2.2 skrll if (usbd_ratecheck(&sc->sc_rx_notice)) { 1129 1.3.2.2 skrll printf("%s: %u usb errors on rx: %s\n", 1130 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), sc->sc_rx_errs, 1131 1.3.2.2 skrll usbd_errstr(status)); 1132 1.3.2.2 skrll sc->sc_rx_errs = 0; 1133 1.3.2.2 skrll } 1134 1.3.2.2 skrll if (status == USBD_STALLED) { 1135 1.3.2.2 skrll sc->sc_refcnt++; 1136 1.3.2.2 skrll usbd_clear_endpoint_stall(sc->sc_pipe_rx); 1137 1.3.2.2 skrll if (--sc->sc_refcnt < 0) 1138 1.3.2.2 skrll usb_detach_wakeup(USBDEV(sc->sc_dev)); 1139 1.3.2.2 skrll } 1140 1.3.2.2 skrll goto done; 1141 1.3.2.2 skrll } 1142 1.3.2.2 skrll 1143 1.3.2.2 skrll usbd_get_xfer_status(xfer, NULL, NULL, &total_len, NULL); 1144 1.3.2.2 skrll 1145 1.3.2.2 skrll /* copy data to mbuf */ 1146 1.3.2.2 skrll m = c->udav_mbuf; 1147 1.3.2.2 skrll memcpy(mtod(m, char *), c->udav_buf, total_len); 1148 1.3.2.2 skrll 1149 1.3.2.2 skrll /* first byte in received data */ 1150 1.3.2.2 skrll pktstat = mtod(m, u_int8_t *); 1151 1.3.2.2 skrll m_adj(m, sizeof(u_int8_t)); 1152 1.3.2.2 skrll DPRINTF(("%s: RX Status: 0x%02x\n", *pktstat)); 1153 1.3.2.2 skrll 1154 1.3.2.2 skrll total_len = UGETW(mtod(m, u_int8_t *)); 1155 1.3.2.2 skrll m_adj(m, sizeof(u_int16_t)); 1156 1.3.2.2 skrll 1157 1.3.2.2 skrll if (*pktstat & UDAV_RSR_LCS) { 1158 1.3.2.2 skrll ifp->if_collisions++; 1159 1.3.2.2 skrll goto done; 1160 1.3.2.2 skrll } 1161 1.3.2.2 skrll 1162 1.3.2.2 skrll if (total_len < sizeof(struct ether_header) || 1163 1.3.2.2 skrll *pktstat & UDAV_RSR_ERR) { 1164 1.3.2.2 skrll ifp->if_ierrors++; 1165 1.3.2.2 skrll goto done; 1166 1.3.2.2 skrll } 1167 1.3.2.2 skrll 1168 1.3.2.2 skrll ifp->if_ipackets++; 1169 1.3.2.2 skrll total_len -= ETHER_CRC_LEN; 1170 1.3.2.2 skrll 1171 1.3.2.2 skrll m->m_pkthdr.len = m->m_len = total_len; 1172 1.3.2.2 skrll m->m_pkthdr.rcvif = ifp; 1173 1.3.2.2 skrll 1174 1.3.2.2 skrll s = splnet(); 1175 1.3.2.2 skrll 1176 1.3.2.2 skrll if (udav_newbuf(sc, c, NULL) == ENOBUFS) { 1177 1.3.2.2 skrll ifp->if_ierrors++; 1178 1.3.2.2 skrll goto done1; 1179 1.3.2.2 skrll } 1180 1.3.2.2 skrll 1181 1.3.2.2 skrll #if NBPFILTER > 0 1182 1.3.2.2 skrll if (ifp->if_bpf) 1183 1.3.2.2 skrll BPF_MTAP(ifp, m); 1184 1.3.2.2 skrll #endif 1185 1.3.2.2 skrll 1186 1.3.2.2 skrll DPRINTF(("%s: %s: deliver %d\n", USBDEVNAME(sc->sc_dev), 1187 1.3.2.2 skrll __func__, m->m_len)); 1188 1.3.2.2 skrll IF_INPUT(ifp, m); 1189 1.3.2.2 skrll 1190 1.3.2.2 skrll done1: 1191 1.3.2.2 skrll splx(s); 1192 1.3.2.2 skrll 1193 1.3.2.2 skrll done: 1194 1.3.2.2 skrll /* Setup new transfer */ 1195 1.3.2.2 skrll usbd_setup_xfer(xfer, sc->sc_pipe_rx, c, c->udav_buf, UDAV_BUFSZ, 1196 1.3.2.2 skrll USBD_SHORT_XFER_OK | USBD_NO_COPY, 1197 1.3.2.2 skrll USBD_NO_TIMEOUT, udav_rxeof); 1198 1.3.2.2 skrll sc->sc_refcnt++; 1199 1.3.2.2 skrll usbd_transfer(xfer); 1200 1.3.2.2 skrll if (--sc->sc_refcnt < 0) 1201 1.3.2.2 skrll usb_detach_wakeup(USBDEV(sc->sc_dev)); 1202 1.3.2.2 skrll 1203 1.3.2.2 skrll DPRINTF(("%s: %s: start rx\n", USBDEVNAME(sc->sc_dev), __func__)); 1204 1.3.2.2 skrll } 1205 1.3.2.2 skrll 1206 1.3.2.2 skrll #if 0 1207 1.3.2.2 skrll Static void udav_intr() 1208 1.3.2.2 skrll { 1209 1.3.2.2 skrll } 1210 1.3.2.2 skrll #endif 1211 1.3.2.2 skrll 1212 1.3.2.2 skrll Static int 1213 1.3.2.2 skrll udav_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 1214 1.3.2.2 skrll { 1215 1.3.2.2 skrll struct udav_softc *sc = ifp->if_softc; 1216 1.3.2.2 skrll struct ifreq *ifr = (struct ifreq *)data; 1217 1.3.2.2 skrll struct mii_data *mii; 1218 1.3.2.2 skrll int s, error = 0; 1219 1.3.2.2 skrll 1220 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 1221 1.3.2.2 skrll 1222 1.3.2.2 skrll if (sc->sc_dying) 1223 1.3.2.2 skrll return (EIO); 1224 1.3.2.2 skrll 1225 1.3.2.2 skrll s = splnet(); 1226 1.3.2.2 skrll 1227 1.3.2.2 skrll switch (cmd) { 1228 1.3.2.2 skrll case SIOCGIFMEDIA: 1229 1.3.2.2 skrll case SIOCSIFMEDIA: 1230 1.3.2.2 skrll mii = GET_MII(sc); 1231 1.3.2.2 skrll error = ifmedia_ioctl(ifp, ifr, &mii->mii_media, cmd); 1232 1.3.2.2 skrll break; 1233 1.3.2.2 skrll 1234 1.3.2.2 skrll default: 1235 1.3.2.2 skrll error = ether_ioctl(ifp, cmd, data); 1236 1.3.2.2 skrll if (error == ENETRESET) { 1237 1.3.2.2 skrll udav_setmulti(sc); 1238 1.3.2.2 skrll error = 0; 1239 1.3.2.2 skrll } 1240 1.3.2.2 skrll break; 1241 1.3.2.2 skrll } 1242 1.3.2.2 skrll 1243 1.3.2.2 skrll splx(s); 1244 1.3.2.2 skrll 1245 1.3.2.2 skrll return (error); 1246 1.3.2.2 skrll } 1247 1.3.2.2 skrll 1248 1.3.2.2 skrll Static void 1249 1.3.2.2 skrll udav_watchdog(struct ifnet *ifp) 1250 1.3.2.2 skrll { 1251 1.3.2.2 skrll struct udav_softc *sc = ifp->if_softc; 1252 1.3.2.2 skrll struct udav_chain *c; 1253 1.3.2.2 skrll usbd_status stat; 1254 1.3.2.2 skrll int s; 1255 1.3.2.2 skrll 1256 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 1257 1.3.2.2 skrll 1258 1.3.2.2 skrll ifp->if_oerrors++; 1259 1.3.2.2 skrll printf("%s: watchdog timeout\n", USBDEVNAME(sc->sc_dev)); 1260 1.3.2.2 skrll 1261 1.3.2.2 skrll s = splusb(); 1262 1.3.2.2 skrll c = &sc->sc_cdata.udav_tx_chain[0]; 1263 1.3.2.2 skrll usbd_get_xfer_status(c->udav_xfer, NULL, NULL, NULL, &stat); 1264 1.3.2.2 skrll udav_txeof(c->udav_xfer, c, stat); 1265 1.3.2.2 skrll 1266 1.3.2.2 skrll if (IFQ_IS_EMPTY(&ifp->if_snd) == 0) 1267 1.3.2.2 skrll udav_start(ifp); 1268 1.3.2.2 skrll splx(s); 1269 1.3.2.2 skrll } 1270 1.3.2.2 skrll 1271 1.3.2.2 skrll Static void 1272 1.3.2.2 skrll udav_stop_task(struct udav_softc *sc) 1273 1.3.2.2 skrll { 1274 1.3.2.2 skrll udav_stop(GET_IFP(sc), 1); 1275 1.3.2.2 skrll } 1276 1.3.2.2 skrll 1277 1.3.2.2 skrll /* Stop the adapter and free any mbufs allocated to the RX and TX lists. */ 1278 1.3.2.2 skrll Static void 1279 1.3.2.2 skrll udav_stop(struct ifnet *ifp, int disable) 1280 1.3.2.2 skrll { 1281 1.3.2.2 skrll struct udav_softc *sc = ifp->if_softc; 1282 1.3.2.2 skrll usbd_status err; 1283 1.3.2.2 skrll int i; 1284 1.3.2.2 skrll 1285 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 1286 1.3.2.2 skrll 1287 1.3.2.2 skrll ifp->if_timer = 0; 1288 1.3.2.2 skrll 1289 1.3.2.2 skrll udav_reset(sc); 1290 1.3.2.2 skrll 1291 1.3.2.2 skrll usb_uncallout(sc->sc_stat_ch, udav_tick, sc); 1292 1.3.2.2 skrll 1293 1.3.2.2 skrll /* Stop transfers */ 1294 1.3.2.2 skrll /* RX endpoint */ 1295 1.3.2.2 skrll if (sc->sc_pipe_rx != NULL) { 1296 1.3.2.2 skrll err = usbd_abort_pipe(sc->sc_pipe_rx); 1297 1.3.2.2 skrll if (err) 1298 1.3.2.2 skrll printf("%s: abort rx pipe failed: %s\n", 1299 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), usbd_errstr(err)); 1300 1.3.2.2 skrll err = usbd_close_pipe(sc->sc_pipe_rx); 1301 1.3.2.2 skrll if (err) 1302 1.3.2.2 skrll printf("%s: close rx pipe failed: %s\n", 1303 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), usbd_errstr(err)); 1304 1.3.2.2 skrll sc->sc_pipe_rx = NULL; 1305 1.3.2.2 skrll } 1306 1.3.2.2 skrll 1307 1.3.2.2 skrll /* TX endpoint */ 1308 1.3.2.2 skrll if (sc->sc_pipe_tx != NULL) { 1309 1.3.2.2 skrll err = usbd_abort_pipe(sc->sc_pipe_tx); 1310 1.3.2.2 skrll if (err) 1311 1.3.2.2 skrll printf("%s: abort tx pipe failed: %s\n", 1312 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), usbd_errstr(err)); 1313 1.3.2.2 skrll err = usbd_close_pipe(sc->sc_pipe_tx); 1314 1.3.2.2 skrll if (err) 1315 1.3.2.2 skrll printf("%s: close tx pipe failed: %s\n", 1316 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), usbd_errstr(err)); 1317 1.3.2.2 skrll sc->sc_pipe_tx = NULL; 1318 1.3.2.2 skrll } 1319 1.3.2.2 skrll 1320 1.3.2.2 skrll #if 0 1321 1.3.2.2 skrll /* XXX: Interrupt endpoint is not yet supported!! */ 1322 1.3.2.2 skrll /* Interrupt endpoint */ 1323 1.3.2.2 skrll if (sc->sc_pipe_intr != NULL) { 1324 1.3.2.2 skrll err = usbd_abort_pipe(sc->sc_pipe_intr); 1325 1.3.2.2 skrll if (err) 1326 1.3.2.2 skrll printf("%s: abort intr pipe failed: %s\n", 1327 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), usbd_errstr(err)); 1328 1.3.2.2 skrll err = usbd_close_pipe(sc->sc_pipe_intr); 1329 1.3.2.2 skrll if (err) 1330 1.3.2.2 skrll printf("%s: close intr pipe failed: %s\n", 1331 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), usbd_errstr(err)); 1332 1.3.2.2 skrll sc->sc_pipe_intr = NULL; 1333 1.3.2.2 skrll } 1334 1.3.2.2 skrll #endif 1335 1.3.2.2 skrll 1336 1.3.2.2 skrll /* Free RX resources. */ 1337 1.3.2.2 skrll for (i = 0; i < UDAV_RX_LIST_CNT; i++) { 1338 1.3.2.2 skrll if (sc->sc_cdata.udav_rx_chain[i].udav_mbuf != NULL) { 1339 1.3.2.2 skrll m_freem(sc->sc_cdata.udav_rx_chain[i].udav_mbuf); 1340 1.3.2.2 skrll sc->sc_cdata.udav_rx_chain[i].udav_mbuf = NULL; 1341 1.3.2.2 skrll } 1342 1.3.2.2 skrll if (sc->sc_cdata.udav_rx_chain[i].udav_xfer != NULL) { 1343 1.3.2.2 skrll usbd_free_xfer(sc->sc_cdata.udav_rx_chain[i].udav_xfer); 1344 1.3.2.2 skrll sc->sc_cdata.udav_rx_chain[i].udav_xfer = NULL; 1345 1.3.2.2 skrll } 1346 1.3.2.2 skrll } 1347 1.3.2.2 skrll 1348 1.3.2.2 skrll /* Free TX resources. */ 1349 1.3.2.2 skrll for (i = 0; i < UDAV_TX_LIST_CNT; i++) { 1350 1.3.2.2 skrll if (sc->sc_cdata.udav_tx_chain[i].udav_mbuf != NULL) { 1351 1.3.2.2 skrll m_freem(sc->sc_cdata.udav_tx_chain[i].udav_mbuf); 1352 1.3.2.2 skrll sc->sc_cdata.udav_tx_chain[i].udav_mbuf = NULL; 1353 1.3.2.2 skrll } 1354 1.3.2.2 skrll if (sc->sc_cdata.udav_tx_chain[i].udav_xfer != NULL) { 1355 1.3.2.2 skrll usbd_free_xfer(sc->sc_cdata.udav_tx_chain[i].udav_xfer); 1356 1.3.2.2 skrll sc->sc_cdata.udav_tx_chain[i].udav_xfer = NULL; 1357 1.3.2.2 skrll } 1358 1.3.2.2 skrll } 1359 1.3.2.2 skrll 1360 1.3.2.2 skrll sc->sc_link = 0; 1361 1.3.2.2 skrll ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE); 1362 1.3.2.2 skrll } 1363 1.3.2.2 skrll 1364 1.3.2.2 skrll /* Set media options */ 1365 1.3.2.2 skrll Static int 1366 1.3.2.2 skrll udav_ifmedia_change(struct ifnet *ifp) 1367 1.3.2.2 skrll { 1368 1.3.2.2 skrll struct udav_softc *sc = ifp->if_softc; 1369 1.3.2.2 skrll struct mii_data *mii = GET_MII(sc); 1370 1.3.2.2 skrll 1371 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 1372 1.3.2.2 skrll 1373 1.3.2.2 skrll if (sc->sc_dying) 1374 1.3.2.2 skrll return (0); 1375 1.3.2.2 skrll 1376 1.3.2.2 skrll sc->sc_link = 0; 1377 1.3.2.2 skrll if (mii->mii_instance) { 1378 1.3.2.2 skrll struct mii_softc *miisc; 1379 1.3.2.2 skrll for (miisc = LIST_FIRST(&mii->mii_phys); miisc != NULL; 1380 1.3.2.2 skrll miisc = LIST_NEXT(miisc, mii_list)) 1381 1.3.2.2 skrll mii_phy_reset(miisc); 1382 1.3.2.2 skrll } 1383 1.3.2.2 skrll 1384 1.3.2.2 skrll return (mii_mediachg(mii)); 1385 1.3.2.2 skrll } 1386 1.3.2.2 skrll 1387 1.3.2.2 skrll /* Report current media status. */ 1388 1.3.2.2 skrll Static void 1389 1.3.2.2 skrll udav_ifmedia_status(struct ifnet *ifp, struct ifmediareq *ifmr) 1390 1.3.2.2 skrll { 1391 1.3.2.2 skrll struct udav_softc *sc = ifp->if_softc; 1392 1.3.2.2 skrll struct mii_data *mii = GET_MII(sc); 1393 1.3.2.2 skrll 1394 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 1395 1.3.2.2 skrll 1396 1.3.2.2 skrll if (sc->sc_dying) 1397 1.3.2.2 skrll return; 1398 1.3.2.2 skrll 1399 1.3.2.2 skrll if ((ifp->if_flags & IFF_RUNNING) == 0) { 1400 1.3.2.2 skrll ifmr->ifm_active = IFM_ETHER | IFM_NONE; 1401 1.3.2.2 skrll ifmr->ifm_status = 0; 1402 1.3.2.2 skrll return; 1403 1.3.2.2 skrll } 1404 1.3.2.2 skrll 1405 1.3.2.2 skrll mii_pollstat(mii); 1406 1.3.2.2 skrll ifmr->ifm_active = mii->mii_media_active; 1407 1.3.2.2 skrll ifmr->ifm_status = mii->mii_media_status; 1408 1.3.2.2 skrll } 1409 1.3.2.2 skrll 1410 1.3.2.2 skrll Static void 1411 1.3.2.2 skrll udav_tick(void *xsc) 1412 1.3.2.2 skrll { 1413 1.3.2.2 skrll struct udav_softc *sc = xsc; 1414 1.3.2.2 skrll 1415 1.3.2.2 skrll if (sc == NULL) 1416 1.3.2.2 skrll return; 1417 1.3.2.2 skrll 1418 1.3.2.2 skrll DPRINTFN(0xff, ("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), 1419 1.3.2.2 skrll __func__)); 1420 1.3.2.2 skrll 1421 1.3.2.2 skrll if (sc->sc_dying) 1422 1.3.2.2 skrll return; 1423 1.3.2.2 skrll 1424 1.3.2.2 skrll /* Perform periodic stuff in process context */ 1425 1.3.2.2 skrll usb_add_task(sc->sc_udev, &sc->sc_tick_task); 1426 1.3.2.2 skrll } 1427 1.3.2.2 skrll 1428 1.3.2.2 skrll Static void 1429 1.3.2.2 skrll udav_tick_task(void *xsc) 1430 1.3.2.2 skrll { 1431 1.3.2.2 skrll struct udav_softc *sc = xsc; 1432 1.3.2.2 skrll struct ifnet *ifp; 1433 1.3.2.2 skrll struct mii_data *mii; 1434 1.3.2.2 skrll int s; 1435 1.3.2.2 skrll 1436 1.3.2.2 skrll if (sc == NULL) 1437 1.3.2.2 skrll return; 1438 1.3.2.2 skrll 1439 1.3.2.2 skrll DPRINTFN(0xff, ("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), 1440 1.3.2.2 skrll __func__)); 1441 1.3.2.2 skrll 1442 1.3.2.2 skrll if (sc->sc_dying) 1443 1.3.2.2 skrll return; 1444 1.3.2.2 skrll 1445 1.3.2.2 skrll ifp = GET_IFP(sc); 1446 1.3.2.2 skrll mii = GET_MII(sc); 1447 1.3.2.2 skrll 1448 1.3.2.2 skrll if (mii == NULL) 1449 1.3.2.2 skrll return; 1450 1.3.2.2 skrll 1451 1.3.2.2 skrll s = splnet(); 1452 1.3.2.2 skrll 1453 1.3.2.2 skrll mii_tick(mii); 1454 1.3.2.2 skrll if (!sc->sc_link) { 1455 1.3.2.2 skrll mii_pollstat(mii); 1456 1.3.2.2 skrll if (mii->mii_media_status & IFM_ACTIVE && 1457 1.3.2.2 skrll IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) { 1458 1.3.2.2 skrll DPRINTF(("%s: %s: got link\n", 1459 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), __func__)); 1460 1.3.2.2 skrll sc->sc_link++; 1461 1.3.2.2 skrll if (IFQ_IS_EMPTY(&ifp->if_snd) == 0) 1462 1.3.2.2 skrll udav_start(ifp); 1463 1.3.2.2 skrll } 1464 1.3.2.2 skrll } 1465 1.3.2.2 skrll 1466 1.3.2.2 skrll usb_callout(sc->sc_stat_ch, hz, udav_tick, sc); 1467 1.3.2.2 skrll 1468 1.3.2.2 skrll splx(s); 1469 1.3.2.2 skrll } 1470 1.3.2.2 skrll 1471 1.3.2.2 skrll /* Get exclusive access to the MII registers */ 1472 1.3.2.2 skrll Static void 1473 1.3.2.2 skrll udav_lock_mii(struct udav_softc *sc) 1474 1.3.2.2 skrll { 1475 1.3.2.2 skrll DPRINTFN(0xff, ("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), 1476 1.3.2.2 skrll __func__)); 1477 1.3.2.2 skrll 1478 1.3.2.2 skrll sc->sc_refcnt++; 1479 1.3.2.2 skrll lockmgr(&sc->sc_mii_lock, LK_EXCLUSIVE, NULL); 1480 1.3.2.2 skrll } 1481 1.3.2.2 skrll 1482 1.3.2.2 skrll Static void 1483 1.3.2.2 skrll udav_unlock_mii(struct udav_softc *sc) 1484 1.3.2.2 skrll { 1485 1.3.2.2 skrll DPRINTFN(0xff, ("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), 1486 1.3.2.2 skrll __func__)); 1487 1.3.2.2 skrll 1488 1.3.2.2 skrll lockmgr(&sc->sc_mii_lock, LK_RELEASE, NULL); 1489 1.3.2.2 skrll if (--sc->sc_refcnt < 0) 1490 1.3.2.2 skrll usb_detach_wakeup(USBDEV(sc->sc_dev)); 1491 1.3.2.2 skrll } 1492 1.3.2.2 skrll 1493 1.3.2.2 skrll Static int 1494 1.3.2.2 skrll udav_miibus_readreg(device_ptr_t dev, int phy, int reg) 1495 1.3.2.2 skrll { 1496 1.3.2.2 skrll struct udav_softc *sc; 1497 1.3.2.2 skrll u_int8_t val[2]; 1498 1.3.2.2 skrll u_int16_t data16; 1499 1.3.2.2 skrll 1500 1.3.2.2 skrll if (dev == NULL) 1501 1.3.2.2 skrll return (0); 1502 1.3.2.2 skrll 1503 1.3.2.2 skrll sc = USBGETSOFTC(dev); 1504 1.3.2.2 skrll 1505 1.3.2.2 skrll DPRINTFN(0xff, ("%s: %s: enter, phy=%d reg=0x%04x\n", 1506 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), __func__, phy, reg)); 1507 1.3.2.2 skrll 1508 1.3.2.2 skrll if (sc->sc_dying) { 1509 1.3.2.2 skrll #ifdef DIAGNOSTIC 1510 1.3.2.2 skrll printf("%s: %s: dying\n", USBDEVNAME(sc->sc_dev), 1511 1.3.2.2 skrll __func__); 1512 1.3.2.2 skrll #endif 1513 1.3.2.2 skrll return (0); 1514 1.3.2.2 skrll } 1515 1.3.2.2 skrll 1516 1.3.2.2 skrll /* XXX: one PHY only for the internal PHY */ 1517 1.3.2.2 skrll if (phy != 0) { 1518 1.3.2.2 skrll DPRINTFN(0xff, ("%s: %s: phy=%d is not supported\n", 1519 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), __func__, phy)); 1520 1.3.2.2 skrll return (0); 1521 1.3.2.2 skrll } 1522 1.3.2.2 skrll 1523 1.3.2.2 skrll udav_lock_mii(sc); 1524 1.3.2.2 skrll 1525 1.3.2.2 skrll /* select internal PHY and set PHY register address */ 1526 1.3.2.2 skrll udav_csr_write1(sc, UDAV_EPAR, 1527 1.3.2.2 skrll UDAV_EPAR_PHY_ADR0 | (reg & UDAV_EPAR_EROA_MASK)); 1528 1.3.2.2 skrll 1529 1.3.2.2 skrll /* select PHY operation and start read command */ 1530 1.3.2.2 skrll udav_csr_write1(sc, UDAV_EPCR, UDAV_EPCR_EPOS | UDAV_EPCR_ERPRR); 1531 1.3.2.2 skrll 1532 1.3.2.2 skrll /* XXX: should be wait? */ 1533 1.3.2.2 skrll 1534 1.3.2.2 skrll /* end read command */ 1535 1.3.2.2 skrll UDAV_CLRBIT(sc, UDAV_EPCR, UDAV_EPCR_ERPRR); 1536 1.3.2.2 skrll 1537 1.3.2.2 skrll /* retrieve the result from data registers */ 1538 1.3.2.2 skrll udav_csr_read(sc, UDAV_EPDRL, val, 2); 1539 1.3.2.2 skrll 1540 1.3.2.2 skrll udav_unlock_mii(sc); 1541 1.3.2.2 skrll 1542 1.3.2.2 skrll data16 = val[0] | (val[1] << 8); 1543 1.3.2.2 skrll 1544 1.3.2.2 skrll DPRINTFN(0xff, ("%s: %s: phy=%d reg=0x%04x => 0x%04x\n", 1545 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), __func__, phy, reg, data16)); 1546 1.3.2.2 skrll 1547 1.3.2.2 skrll return (data16); 1548 1.3.2.2 skrll } 1549 1.3.2.2 skrll 1550 1.3.2.2 skrll Static void 1551 1.3.2.2 skrll udav_miibus_writereg(device_ptr_t dev, int phy, int reg, int data) 1552 1.3.2.2 skrll { 1553 1.3.2.2 skrll struct udav_softc *sc; 1554 1.3.2.2 skrll u_int8_t val[2]; 1555 1.3.2.2 skrll 1556 1.3.2.2 skrll if (dev == NULL) 1557 1.3.2.2 skrll return; 1558 1.3.2.2 skrll 1559 1.3.2.2 skrll sc = USBGETSOFTC(dev); 1560 1.3.2.2 skrll 1561 1.3.2.2 skrll DPRINTFN(0xff, ("%s: %s: enter, phy=%d reg=0x%04x data=0x%04x\n", 1562 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), __func__, phy, reg, data)); 1563 1.3.2.2 skrll 1564 1.3.2.2 skrll if (sc->sc_dying) { 1565 1.3.2.2 skrll #ifdef DIAGNOSTIC 1566 1.3.2.2 skrll printf("%s: %s: dying\n", USBDEVNAME(sc->sc_dev), 1567 1.3.2.2 skrll __func__); 1568 1.3.2.2 skrll #endif 1569 1.3.2.2 skrll return; 1570 1.3.2.2 skrll } 1571 1.3.2.2 skrll 1572 1.3.2.2 skrll /* XXX: one PHY only for the internal PHY */ 1573 1.3.2.2 skrll if (phy != 0) { 1574 1.3.2.2 skrll DPRINTFN(0xff, ("%s: %s: phy=%d is not supported\n", 1575 1.3.2.2 skrll USBDEVNAME(sc->sc_dev), __func__, phy)); 1576 1.3.2.2 skrll return; 1577 1.3.2.2 skrll } 1578 1.3.2.2 skrll 1579 1.3.2.2 skrll udav_lock_mii(sc); 1580 1.3.2.2 skrll 1581 1.3.2.2 skrll /* select internal PHY and set PHY register address */ 1582 1.3.2.2 skrll udav_csr_write1(sc, UDAV_EPAR, 1583 1.3.2.2 skrll UDAV_EPAR_PHY_ADR0 | (reg & UDAV_EPAR_EROA_MASK)); 1584 1.3.2.2 skrll 1585 1.3.2.2 skrll /* put the value to the data registers */ 1586 1.3.2.2 skrll val[0] = data & 0xff; 1587 1.3.2.2 skrll val[1] = (data >> 8) & 0xff; 1588 1.3.2.2 skrll udav_csr_write(sc, UDAV_EPDRL, val, 2); 1589 1.3.2.2 skrll 1590 1.3.2.2 skrll /* select PHY operation and start write command */ 1591 1.3.2.2 skrll udav_csr_write1(sc, UDAV_EPCR, UDAV_EPCR_EPOS | UDAV_EPCR_ERPRW); 1592 1.3.2.2 skrll 1593 1.3.2.2 skrll /* XXX: should be wait? */ 1594 1.3.2.2 skrll 1595 1.3.2.2 skrll /* end write command */ 1596 1.3.2.2 skrll UDAV_CLRBIT(sc, UDAV_EPCR, UDAV_EPCR_ERPRW); 1597 1.3.2.2 skrll 1598 1.3.2.2 skrll udav_unlock_mii(sc); 1599 1.3.2.2 skrll 1600 1.3.2.2 skrll return; 1601 1.3.2.2 skrll } 1602 1.3.2.2 skrll 1603 1.3.2.2 skrll Static void 1604 1.3.2.2 skrll udav_miibus_statchg(device_ptr_t dev) 1605 1.3.2.2 skrll { 1606 1.3.2.2 skrll #ifdef UDAV_DEBUG 1607 1.3.2.2 skrll struct udav_softc *sc; 1608 1.3.2.2 skrll 1609 1.3.2.2 skrll if (dev == NULL) 1610 1.3.2.2 skrll return; 1611 1.3.2.2 skrll 1612 1.3.2.2 skrll sc = USBGETSOFTC(dev); 1613 1.3.2.2 skrll DPRINTF(("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__)); 1614 1.3.2.2 skrll #endif 1615 1.3.2.2 skrll /* Nothing to do */ 1616 1.3.2.2 skrll } 1617
Indexes created Mon Oct 20 03:09:53 GMT 2025