1 /* $NetBSD: if_udav.c,v 1.2 2003/09/04 15:17:38 tsutsui Exp $ */
2 /* $nabe: if_udav.c,v 1.3 2003/08/21 16:57:19 nabe Exp $ */
6 * Shingo WATANABE <nabe@nabechan.org>. All rights reserved.
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. Neither the name of the author nor the names of any co-contributors
17 * may be used to endorse or promote products derived from this software
18 * without specific prior written permission.
20 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
24 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
35 * DM9601(DAVICOM USB to Ethernet MAC Controller with Integrated 10/100 PHY)
36 * The spec can be found at the following url.
37 * http://www.davicom.com.tw/big5/download/Data%20Sheet/DM9601-DS-P01-930914.pdf
42 * Interrupt Endpoint support
46 #include <sys/cdefs.h>
47 __FBSDID("$FreeBSD$");
49 #include <sys/stdint.h>
50 #include <sys/stddef.h>
51 #include <sys/param.h>
52 #include <sys/queue.h>
53 #include <sys/types.h>
54 #include <sys/systm.h>
55 #include <sys/kernel.h>
57 #include <sys/linker_set.h>
58 #include <sys/module.h>
60 #include <sys/mutex.h>
61 #include <sys/condvar.h>
62 #include <sys/sysctl.h>
64 #include <sys/unistd.h>
65 #include <sys/callout.h>
66 #include <sys/malloc.h>
69 #include <dev/usb/usb.h>
70 #include <dev/usb/usbdi.h>
71 #include <dev/usb/usbdi_util.h>
74 #define USB_DEBUG_VAR udav_debug
75 #include <dev/usb/usb_debug.h>
76 #include <dev/usb/usb_process.h>
78 #include <dev/usb/net/usb_ethernet.h>
79 #include <dev/usb/net/if_udavreg.h>
83 static device_probe_t udav_probe;
84 static device_attach_t udav_attach;
85 static device_detach_t udav_detach;
87 static usb_callback_t udav_bulk_write_callback;
88 static usb_callback_t udav_bulk_read_callback;
89 static usb_callback_t udav_intr_callback;
91 static uether_fn_t udav_attach_post;
92 static uether_fn_t udav_init;
93 static uether_fn_t udav_stop;
94 static uether_fn_t udav_start;
95 static uether_fn_t udav_tick;
96 static uether_fn_t udav_setmulti;
97 static uether_fn_t udav_setpromisc;
99 static int udav_csr_read(struct udav_softc *, uint16_t, void *, int);
100 static int udav_csr_write(struct udav_softc *, uint16_t, void *, int);
101 static uint8_t udav_csr_read1(struct udav_softc *, uint16_t);
102 static int udav_csr_write1(struct udav_softc *, uint16_t, uint8_t);
103 static void udav_reset(struct udav_softc *);
104 static int udav_ifmedia_upd(struct ifnet *);
105 static void udav_ifmedia_status(struct ifnet *, struct ifmediareq *);
107 static miibus_readreg_t udav_miibus_readreg;
108 static miibus_writereg_t udav_miibus_writereg;
109 static miibus_statchg_t udav_miibus_statchg;
111 static const struct usb_config udav_config[UDAV_N_TRANSFER] = {
113 [UDAV_BULK_DT_WR] = {
115 .endpoint = UE_ADDR_ANY,
116 .direction = UE_DIR_OUT,
117 .bufsize = (MCLBYTES + 2),
118 .flags = {.pipe_bof = 1,.force_short_xfer = 1,},
119 .callback = udav_bulk_write_callback,
120 .timeout = 10000, /* 10 seconds */
123 [UDAV_BULK_DT_RD] = {
125 .endpoint = UE_ADDR_ANY,
126 .direction = UE_DIR_IN,
127 .bufsize = (MCLBYTES + 3),
128 .flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
129 .callback = udav_bulk_read_callback,
130 .timeout = 0, /* no timeout */
133 [UDAV_INTR_DT_RD] = {
134 .type = UE_INTERRUPT,
135 .endpoint = UE_ADDR_ANY,
136 .direction = UE_DIR_IN,
137 .flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
138 .bufsize = 0, /* use wMaxPacketSize */
139 .callback = udav_intr_callback,
143 static device_method_t udav_methods[] = {
144 /* Device interface */
145 DEVMETHOD(device_probe, udav_probe),
146 DEVMETHOD(device_attach, udav_attach),
147 DEVMETHOD(device_detach, udav_detach),
150 DEVMETHOD(bus_print_child, bus_generic_print_child),
151 DEVMETHOD(bus_driver_added, bus_generic_driver_added),
154 DEVMETHOD(miibus_readreg, udav_miibus_readreg),
155 DEVMETHOD(miibus_writereg, udav_miibus_writereg),
156 DEVMETHOD(miibus_statchg, udav_miibus_statchg),
161 static driver_t udav_driver = {
163 .methods = udav_methods,
164 .size = sizeof(struct udav_softc),
167 static devclass_t udav_devclass;
169 DRIVER_MODULE(udav, uhub, udav_driver, udav_devclass, NULL, 0);
170 DRIVER_MODULE(miibus, udav, miibus_driver, miibus_devclass, 0, 0);
171 MODULE_DEPEND(udav, uether, 1, 1, 1);
172 MODULE_DEPEND(udav, usb, 1, 1, 1);
173 MODULE_DEPEND(udav, ether, 1, 1, 1);
174 MODULE_DEPEND(udav, miibus, 1, 1, 1);
176 static const struct usb_ether_methods udav_ue_methods = {
177 .ue_attach_post = udav_attach_post,
178 .ue_start = udav_start,
179 .ue_init = udav_init,
180 .ue_stop = udav_stop,
181 .ue_tick = udav_tick,
182 .ue_setmulti = udav_setmulti,
183 .ue_setpromisc = udav_setpromisc,
184 .ue_mii_upd = udav_ifmedia_upd,
185 .ue_mii_sts = udav_ifmedia_status,
189 static int udav_debug = 0;
191 SYSCTL_NODE(_hw_usb, OID_AUTO, udav, CTLFLAG_RW, 0, "USB udav");
192 SYSCTL_INT(_hw_usb_udav, OID_AUTO, debug, CTLFLAG_RW, &udav_debug, 0,
196 #define UDAV_SETBIT(sc, reg, x) \
197 udav_csr_write1(sc, reg, udav_csr_read1(sc, reg) | (x))
199 #define UDAV_CLRBIT(sc, reg, x) \
200 udav_csr_write1(sc, reg, udav_csr_read1(sc, reg) & ~(x))
202 static const struct usb_device_id udav_devs[] = {
203 /* ShanTou DM9601 USB NIC */
204 {USB_VPI(USB_VENDOR_SHANTOU, USB_PRODUCT_SHANTOU_DM9601, 0)},
205 /* ShanTou ST268 USB NIC */
206 {USB_VPI(USB_VENDOR_SHANTOU, USB_PRODUCT_SHANTOU_ST268, 0)},
208 {USB_VPI(USB_VENDOR_COREGA, USB_PRODUCT_COREGA_FETHER_USB_TXC, 0)},
212 udav_attach_post(struct usb_ether *ue)
214 struct udav_softc *sc = uether_getsc(ue);
216 /* reset the adapter */
219 /* Get Ethernet Address */
220 udav_csr_read(sc, UDAV_PAR, ue->ue_eaddr, ETHER_ADDR_LEN);
224 udav_probe(device_t dev)
226 struct usb_attach_arg *uaa = device_get_ivars(dev);
228 if (uaa->usb_mode != USB_MODE_HOST)
230 if (uaa->info.bConfigIndex != UDAV_CONFIG_INDEX)
232 if (uaa->info.bIfaceIndex != UDAV_IFACE_INDEX)
235 return (usbd_lookup_id_by_uaa(udav_devs, sizeof(udav_devs), uaa));
239 udav_attach(device_t dev)
241 struct usb_attach_arg *uaa = device_get_ivars(dev);
242 struct udav_softc *sc = device_get_softc(dev);
243 struct usb_ether *ue = &sc->sc_ue;
247 sc->sc_flags = USB_GET_DRIVER_INFO(uaa);
249 device_set_usb_desc(dev);
251 mtx_init(&sc->sc_mtx, device_get_nameunit(dev), NULL, MTX_DEF);
253 iface_index = UDAV_IFACE_INDEX;
254 error = usbd_transfer_setup(uaa->device, &iface_index,
255 sc->sc_xfer, udav_config, UDAV_N_TRANSFER, sc, &sc->sc_mtx);
257 device_printf(dev, "allocating USB transfers failed!\n");
263 ue->ue_udev = uaa->device;
264 ue->ue_mtx = &sc->sc_mtx;
265 ue->ue_methods = &udav_ue_methods;
267 error = uether_ifattach(ue);
269 device_printf(dev, "could not attach interface\n");
273 return (0); /* success */
277 return (ENXIO); /* failure */
281 udav_detach(device_t dev)
283 struct udav_softc *sc = device_get_softc(dev);
284 struct usb_ether *ue = &sc->sc_ue;
286 usbd_transfer_unsetup(sc->sc_xfer, UDAV_N_TRANSFER);
288 mtx_destroy(&sc->sc_mtx);
295 udav_mem_read(struct udav_softc *sc, uint16_t offset, void *buf,
298 struct usb_device_request req;
302 req.bmRequestType = UT_READ_VENDOR_DEVICE;
303 req.bRequest = UDAV_REQ_MEM_READ;
304 USETW(req.wValue, 0x0000);
305 USETW(req.wIndex, offset);
306 USETW(req.wLength, len);
308 return (uether_do_request(&sc->sc_ue, &req, buf, 1000));
312 udav_mem_write(struct udav_softc *sc, uint16_t offset, void *buf,
315 struct usb_device_request req;
319 req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
320 req.bRequest = UDAV_REQ_MEM_WRITE;
321 USETW(req.wValue, 0x0000);
322 USETW(req.wIndex, offset);
323 USETW(req.wLength, len);
325 return (uether_do_request(&sc->sc_ue, &req, buf, 1000));
329 udav_mem_write1(struct udav_softc *sc, uint16_t offset,
332 struct usb_device_request req;
334 req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
335 req.bRequest = UDAV_REQ_MEM_WRITE1;
336 USETW(req.wValue, ch);
337 USETW(req.wIndex, offset);
338 USETW(req.wLength, 0x0000);
340 return (uether_do_request(&sc->sc_ue, &req, NULL, 1000));
345 udav_csr_read(struct udav_softc *sc, uint16_t offset, void *buf, int len)
347 struct usb_device_request req;
351 req.bmRequestType = UT_READ_VENDOR_DEVICE;
352 req.bRequest = UDAV_REQ_REG_READ;
353 USETW(req.wValue, 0x0000);
354 USETW(req.wIndex, offset);
355 USETW(req.wLength, len);
357 return (uether_do_request(&sc->sc_ue, &req, buf, 1000));
361 udav_csr_write(struct udav_softc *sc, uint16_t offset, void *buf, int len)
363 struct usb_device_request req;
368 req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
369 req.bRequest = UDAV_REQ_REG_WRITE;
370 USETW(req.wValue, 0x0000);
371 USETW(req.wIndex, offset);
372 USETW(req.wLength, len);
374 return (uether_do_request(&sc->sc_ue, &req, buf, 1000));
378 udav_csr_read1(struct udav_softc *sc, uint16_t offset)
382 udav_csr_read(sc, offset, &val, 1);
387 udav_csr_write1(struct udav_softc *sc, uint16_t offset,
390 struct usb_device_request req;
394 req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
395 req.bRequest = UDAV_REQ_REG_WRITE1;
396 USETW(req.wValue, ch);
397 USETW(req.wIndex, offset);
398 USETW(req.wLength, 0x0000);
400 return (uether_do_request(&sc->sc_ue, &req, NULL, 1000));
404 udav_init(struct usb_ether *ue)
406 struct udav_softc *sc = ue->ue_sc;
407 struct ifnet *ifp = uether_getifp(&sc->sc_ue);
409 UDAV_LOCK_ASSERT(sc, MA_OWNED);
416 /* set MAC address */
417 udav_csr_write(sc, UDAV_PAR, IF_LLADDR(ifp), ETHER_ADDR_LEN);
419 /* initialize network control register */
421 /* disable loopback */
422 UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_LBK0 | UDAV_NCR_LBK1);
424 /* Initialize RX control register */
425 UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_DIS_LONG | UDAV_RCR_DIS_CRC);
427 /* load multicast filter and update promiscious mode bit */
431 UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_RXEN);
433 /* clear POWER_DOWN state of internal PHY */
434 UDAV_SETBIT(sc, UDAV_GPCR, UDAV_GPCR_GEP_CNTL0);
435 UDAV_CLRBIT(sc, UDAV_GPR, UDAV_GPR_GEPIO0);
437 usbd_xfer_set_stall(sc->sc_xfer[UDAV_BULK_DT_WR]);
439 ifp->if_drv_flags |= IFF_DRV_RUNNING;
444 udav_reset(struct udav_softc *sc)
451 * XXX: force select internal phy.
452 * external phy routines are not tested.
454 UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY);
456 if (sc->sc_flags & UDAV_EXT_PHY)
457 UDAV_SETBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY);
459 UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY);
462 UDAV_SETBIT(sc, UDAV_NCR, UDAV_NCR_RST);
464 for (i = 0; i < UDAV_TX_TIMEOUT; i++) {
465 if (!(udav_csr_read1(sc, UDAV_NCR) & UDAV_NCR_RST))
467 if (uether_pause(&sc->sc_ue, hz / 100))
471 uether_pause(&sc->sc_ue, hz / 100);
476 udav_setmulti(struct usb_ether *ue)
478 struct udav_softc *sc = ue->ue_sc;
479 struct ifnet *ifp = uether_getifp(&sc->sc_ue);
480 struct ifmultiaddr *ifma;
481 uint8_t hashtbl[8] = { 0, 0, 0, 0, 0, 0, 0, 0 };
484 UDAV_LOCK_ASSERT(sc, MA_OWNED);
486 if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) {
487 UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_ALL|UDAV_RCR_PRMSC);
491 /* first, zot all the existing hash bits */
492 memset(hashtbl, 0x00, sizeof(hashtbl));
493 hashtbl[7] |= 0x80; /* broadcast address */
494 udav_csr_write(sc, UDAV_MAR, hashtbl, sizeof(hashtbl));
496 /* now program new ones */
498 TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link)
500 if (ifma->ifma_addr->sa_family != AF_LINK)
502 h = ether_crc32_be(LLADDR((struct sockaddr_dl *)
503 ifma->ifma_addr), ETHER_ADDR_LEN) >> 26;
504 hashtbl[h / 8] |= 1 << (h % 8);
506 if_maddr_runlock(ifp);
508 /* disable all multicast */
509 UDAV_CLRBIT(sc, UDAV_RCR, UDAV_RCR_ALL);
511 /* write hash value to the register */
512 udav_csr_write(sc, UDAV_MAR, hashtbl, sizeof(hashtbl));
516 udav_setpromisc(struct usb_ether *ue)
518 struct udav_softc *sc = ue->ue_sc;
519 struct ifnet *ifp = uether_getifp(&sc->sc_ue);
522 rxmode = udav_csr_read1(sc, UDAV_RCR);
523 rxmode &= ~(UDAV_RCR_ALL | UDAV_RCR_PRMSC);
525 if (ifp->if_flags & IFF_PROMISC)
526 rxmode |= UDAV_RCR_ALL | UDAV_RCR_PRMSC;
527 else if (ifp->if_flags & IFF_ALLMULTI)
528 rxmode |= UDAV_RCR_ALL;
530 /* write new mode bits */
531 udav_csr_write1(sc, UDAV_RCR, rxmode);
535 udav_start(struct usb_ether *ue)
537 struct udav_softc *sc = ue->ue_sc;
540 * start the USB transfers, if not already started:
542 usbd_transfer_start(sc->sc_xfer[UDAV_INTR_DT_RD]);
543 usbd_transfer_start(sc->sc_xfer[UDAV_BULK_DT_RD]);
544 usbd_transfer_start(sc->sc_xfer[UDAV_BULK_DT_WR]);
548 udav_bulk_write_callback(struct usb_xfer *xfer, usb_error_t error)
550 struct udav_softc *sc = usbd_xfer_softc(xfer);
551 struct ifnet *ifp = uether_getifp(&sc->sc_ue);
552 struct usb_page_cache *pc;
558 switch (USB_GET_STATE(xfer)) {
559 case USB_ST_TRANSFERRED:
560 DPRINTFN(11, "transfer complete\n");
566 if ((sc->sc_flags & UDAV_FLAG_LINK) == 0) {
568 * don't send anything if there is no link !
572 IFQ_DRV_DEQUEUE(&ifp->if_snd, m);
576 if (m->m_pkthdr.len > MCLBYTES)
577 m->m_pkthdr.len = MCLBYTES;
578 if (m->m_pkthdr.len < UDAV_MIN_FRAME_LEN) {
579 extra_len = UDAV_MIN_FRAME_LEN - m->m_pkthdr.len;
584 temp_len = (m->m_pkthdr.len + extra_len);
587 * the frame length is specified in the first 2 bytes of the
590 buf[0] = (uint8_t)(temp_len);
591 buf[1] = (uint8_t)(temp_len >> 8);
595 pc = usbd_xfer_get_frame(xfer, 0);
596 usbd_copy_in(pc, 0, buf, 2);
597 usbd_m_copy_in(pc, 2, m, 0, m->m_pkthdr.len);
600 usbd_frame_zero(pc, temp_len - extra_len, extra_len);
602 * if there's a BPF listener, bounce a copy
603 * of this frame to him:
609 usbd_xfer_set_frame_len(xfer, 0, temp_len);
610 usbd_transfer_submit(xfer);
614 DPRINTFN(11, "transfer error, %s\n",
619 if (error != USB_ERR_CANCELLED) {
620 /* try to clear stall first */
621 usbd_xfer_set_stall(xfer);
629 udav_bulk_read_callback(struct usb_xfer *xfer, usb_error_t error)
631 struct udav_softc *sc = usbd_xfer_softc(xfer);
632 struct usb_ether *ue = &sc->sc_ue;
633 struct ifnet *ifp = uether_getifp(ue);
634 struct usb_page_cache *pc;
635 struct udav_rxpkt stat;
639 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
641 switch (USB_GET_STATE(xfer)) {
642 case USB_ST_TRANSFERRED:
644 if (actlen < sizeof(stat) + ETHER_CRC_LEN) {
648 pc = usbd_xfer_get_frame(xfer, 0);
649 usbd_copy_out(pc, 0, &stat, sizeof(stat));
650 actlen -= sizeof(stat);
651 len = min(actlen, le16toh(stat.pktlen));
652 len -= ETHER_CRC_LEN;
654 if (stat.rxstat & UDAV_RSR_LCS) {
655 ifp->if_collisions++;
658 if (stat.rxstat & UDAV_RSR_ERR) {
662 uether_rxbuf(ue, pc, sizeof(stat), len);
666 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
667 usbd_transfer_submit(xfer);
672 DPRINTF("bulk read error, %s\n",
675 if (error != USB_ERR_CANCELLED) {
676 /* try to clear stall first */
677 usbd_xfer_set_stall(xfer);
685 udav_intr_callback(struct usb_xfer *xfer, usb_error_t error)
687 switch (USB_GET_STATE(xfer)) {
688 case USB_ST_TRANSFERRED:
691 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
692 usbd_transfer_submit(xfer);
696 if (error != USB_ERR_CANCELLED) {
697 /* try to clear stall first */
698 usbd_xfer_set_stall(xfer);
706 udav_stop(struct usb_ether *ue)
708 struct udav_softc *sc = ue->ue_sc;
709 struct ifnet *ifp = uether_getifp(&sc->sc_ue);
711 UDAV_LOCK_ASSERT(sc, MA_OWNED);
713 ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
714 sc->sc_flags &= ~UDAV_FLAG_LINK;
717 * stop all the transfers, if not already stopped:
719 usbd_transfer_stop(sc->sc_xfer[UDAV_BULK_DT_WR]);
720 usbd_transfer_stop(sc->sc_xfer[UDAV_BULK_DT_RD]);
721 usbd_transfer_stop(sc->sc_xfer[UDAV_INTR_DT_RD]);
727 udav_ifmedia_upd(struct ifnet *ifp)
729 struct udav_softc *sc = ifp->if_softc;
730 struct mii_data *mii = GET_MII(sc);
732 UDAV_LOCK_ASSERT(sc, MA_OWNED);
734 sc->sc_flags &= ~UDAV_FLAG_LINK;
735 if (mii->mii_instance) {
736 struct mii_softc *miisc;
738 LIST_FOREACH(miisc, &mii->mii_phys, mii_list)
739 mii_phy_reset(miisc);
746 udav_ifmedia_status(struct ifnet *ifp, struct ifmediareq *ifmr)
748 struct udav_softc *sc = ifp->if_softc;
749 struct mii_data *mii = GET_MII(sc);
754 ifmr->ifm_active = mii->mii_media_active;
755 ifmr->ifm_status = mii->mii_media_status;
759 udav_tick(struct usb_ether *ue)
761 struct udav_softc *sc = ue->ue_sc;
762 struct mii_data *mii = GET_MII(sc);
764 UDAV_LOCK_ASSERT(sc, MA_OWNED);
767 if ((sc->sc_flags & UDAV_FLAG_LINK) == 0
768 && mii->mii_media_status & IFM_ACTIVE &&
769 IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) {
770 sc->sc_flags |= UDAV_FLAG_LINK;
776 udav_miibus_readreg(device_t dev, int phy, int reg)
778 struct udav_softc *sc = device_get_softc(dev);
783 /* XXX: one PHY only for the internal PHY */
787 locked = mtx_owned(&sc->sc_mtx);
791 /* select internal PHY and set PHY register address */
792 udav_csr_write1(sc, UDAV_EPAR,
793 UDAV_EPAR_PHY_ADR0 | (reg & UDAV_EPAR_EROA_MASK));
795 /* select PHY operation and start read command */
796 udav_csr_write1(sc, UDAV_EPCR, UDAV_EPCR_EPOS | UDAV_EPCR_ERPRR);
798 /* XXX: should we wait? */
800 /* end read command */
801 UDAV_CLRBIT(sc, UDAV_EPCR, UDAV_EPCR_ERPRR);
803 /* retrieve the result from data registers */
804 udav_csr_read(sc, UDAV_EPDRL, val, 2);
806 data16 = (val[0] | (val[1] << 8));
808 DPRINTFN(11, "phy=%d reg=0x%04x => 0x%04x\n",
817 udav_miibus_writereg(device_t dev, int phy, int reg, int data)
819 struct udav_softc *sc = device_get_softc(dev);
823 /* XXX: one PHY only for the internal PHY */
827 locked = mtx_owned(&sc->sc_mtx);
831 /* select internal PHY and set PHY register address */
832 udav_csr_write1(sc, UDAV_EPAR,
833 UDAV_EPAR_PHY_ADR0 | (reg & UDAV_EPAR_EROA_MASK));
835 /* put the value to the data registers */
836 val[0] = (data & 0xff);
837 val[1] = (data >> 8) & 0xff;
838 udav_csr_write(sc, UDAV_EPDRL, val, 2);
840 /* select PHY operation and start write command */
841 udav_csr_write1(sc, UDAV_EPCR, UDAV_EPCR_EPOS | UDAV_EPCR_ERPRW);
843 /* XXX: should we wait? */
845 /* end write command */
846 UDAV_CLRBIT(sc, UDAV_EPCR, UDAV_EPCR_ERPRW);
854 udav_miibus_statchg(device_t dev)