Home | History | Annotate | Line # | Download | only in usb
if_mos.c revision 1.7.4.2
      1  1.7.4.2  martin /*	$NetBSD: if_mos.c,v 1.7.4.2 2020/04/13 08:04:49 martin Exp $	*/
      2  1.7.4.2  martin /*	$OpenBSD: if_mos.c,v 1.40 2019/07/07 06:40:10 kevlo Exp $	*/
      3  1.7.4.2  martin 
      4  1.7.4.2  martin /*
      5  1.7.4.2  martin  * Copyright (c) 2008 Johann Christian Rode <jcrode (at) gmx.net>
      6  1.7.4.2  martin  *
      7  1.7.4.2  martin  * Permission to use, copy, modify, and distribute this software for any
      8  1.7.4.2  martin  * purpose with or without fee is hereby granted, provided that the above
      9  1.7.4.2  martin  * copyright notice and this permission notice appear in all copies.
     10  1.7.4.2  martin  *
     11  1.7.4.2  martin  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     12  1.7.4.2  martin  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     13  1.7.4.2  martin  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     14  1.7.4.2  martin  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     15  1.7.4.2  martin  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
     16  1.7.4.2  martin  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
     17  1.7.4.2  martin  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     18  1.7.4.2  martin  */
     19  1.7.4.2  martin 
     20  1.7.4.2  martin /*
     21  1.7.4.2  martin  * Copyright (c) 2005, 2006, 2007 Jonathan Gray <jsg (at) openbsd.org>
     22  1.7.4.2  martin  *
     23  1.7.4.2  martin  * Permission to use, copy, modify, and distribute this software for any
     24  1.7.4.2  martin  * purpose with or without fee is hereby granted, provided that the above
     25  1.7.4.2  martin  * copyright notice and this permission notice appear in all copies.
     26  1.7.4.2  martin  *
     27  1.7.4.2  martin  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     28  1.7.4.2  martin  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     29  1.7.4.2  martin  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     30  1.7.4.2  martin  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     31  1.7.4.2  martin  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
     32  1.7.4.2  martin  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
     33  1.7.4.2  martin  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     34  1.7.4.2  martin  */
     35  1.7.4.2  martin 
     36  1.7.4.2  martin /*
     37  1.7.4.2  martin  * Copyright (c) 1997, 1998, 1999, 2000-2003
     38  1.7.4.2  martin  *	Bill Paul <wpaul (at) windriver.com>.  All rights reserved.
     39  1.7.4.2  martin  *
     40  1.7.4.2  martin  * Redistribution and use in source and binary forms, with or without
     41  1.7.4.2  martin  * modification, are permitted provided that the following conditions
     42  1.7.4.2  martin  * are met:
     43  1.7.4.2  martin  * 1. Redistributions of source code must retain the above copyright
     44  1.7.4.2  martin  *    notice, this list of conditions and the following disclaimer.
     45  1.7.4.2  martin  * 2. Redistributions in binary form must reproduce the above copyright
     46  1.7.4.2  martin  *    notice, this list of conditions and the following disclaimer in the
     47  1.7.4.2  martin  *    documentation and/or other materials provided with the distribution.
     48  1.7.4.2  martin  * 3. All advertising materials mentioning features or use of this software
     49  1.7.4.2  martin  *    must display the following acknowledgement:
     50  1.7.4.2  martin  *	This product includes software developed by Bill Paul.
     51  1.7.4.2  martin  * 4. Neither the name of the author nor the names of any co-contributors
     52  1.7.4.2  martin  *    may be used to endorse or promote products derived from this software
     53  1.7.4.2  martin  *    without specific prior written permission.
     54  1.7.4.2  martin  *
     55  1.7.4.2  martin  * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
     56  1.7.4.2  martin  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     57  1.7.4.2  martin  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     58  1.7.4.2  martin  * ARE DISCLAIMED.  IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
     59  1.7.4.2  martin  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     60  1.7.4.2  martin  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     61  1.7.4.2  martin  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     62  1.7.4.2  martin  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     63  1.7.4.2  martin  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     64  1.7.4.2  martin  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
     65  1.7.4.2  martin  * THE POSSIBILITY OF SUCH DAMAGE.
     66  1.7.4.2  martin  */
     67  1.7.4.2  martin 
     68  1.7.4.2  martin /*
     69  1.7.4.2  martin  * Moschip MCS7730/MCS7830/MCS7832 USB to Ethernet controller
     70  1.7.4.2  martin  * The datasheet is available at the following URL:
     71  1.7.4.2  martin  * http://www.moschip.com/data/products/MCS7830/Data%20Sheet_7830.pdf
     72  1.7.4.2  martin  */
     73  1.7.4.2  martin 
     74  1.7.4.2  martin #include <sys/cdefs.h>
     75  1.7.4.2  martin __KERNEL_RCSID(0, "$NetBSD: if_mos.c,v 1.7.4.2 2020/04/13 08:04:49 martin Exp $");
     76  1.7.4.2  martin 
     77  1.7.4.2  martin #include <sys/param.h>
     78  1.7.4.2  martin 
     79  1.7.4.2  martin #include <dev/usb/usbnet.h>
     80  1.7.4.2  martin #include <dev/usb/if_mosreg.h>
     81  1.7.4.2  martin 
     82  1.7.4.2  martin #define MOS_PAUSE_REWRITES	3
     83  1.7.4.2  martin 
     84  1.7.4.2  martin #define MOS_TIMEOUT		1000
     85  1.7.4.2  martin 
     86  1.7.4.2  martin #define MOS_RX_LIST_CNT		1
     87  1.7.4.2  martin #define MOS_TX_LIST_CNT		1
     88  1.7.4.2  martin 
     89  1.7.4.2  martin /* Maximum size of a fast ethernet frame plus one byte for the status */
     90  1.7.4.2  martin #define MOS_BUFSZ	 	(ETHER_MAX_LEN+1)
     91  1.7.4.2  martin 
     92  1.7.4.2  martin /*
     93  1.7.4.2  martin  * USB endpoints.
     94  1.7.4.2  martin  */
     95  1.7.4.2  martin #define MOS_ENDPT_RX		0
     96  1.7.4.2  martin #define MOS_ENDPT_TX		1
     97  1.7.4.2  martin #define MOS_ENDPT_INTR		2
     98  1.7.4.2  martin #define MOS_ENDPT_MAX		3
     99  1.7.4.2  martin 
    100  1.7.4.2  martin /*
    101  1.7.4.2  martin  * USB vendor requests.
    102  1.7.4.2  martin  */
    103  1.7.4.2  martin #define MOS_UR_READREG		0x0e
    104  1.7.4.2  martin #define MOS_UR_WRITEREG		0x0d
    105  1.7.4.2  martin 
    106  1.7.4.2  martin #define MOS_CONFIG_NO		1
    107  1.7.4.2  martin #define MOS_IFACE_IDX		0
    108  1.7.4.2  martin 
    109  1.7.4.2  martin struct mos_type {
    110  1.7.4.2  martin 	struct usb_devno	mos_dev;
    111  1.7.4.2  martin 	u_int16_t		mos_flags;
    112  1.7.4.2  martin #define MCS7730	0x0001		/* MCS7730 */
    113  1.7.4.2  martin #define MCS7830	0x0002		/* MCS7830 */
    114  1.7.4.2  martin #define MCS7832	0x0004		/* MCS7832 */
    115  1.7.4.2  martin };
    116  1.7.4.2  martin 
    117  1.7.4.2  martin #define MOS_INC(x, y)           (x) = (x + 1) % y
    118  1.7.4.2  martin 
    119  1.7.4.2  martin #ifdef MOS_DEBUG
    120  1.7.4.2  martin #define DPRINTF(x)      do { if (mosdebug) printf x; } while (0)
    121  1.7.4.2  martin #define DPRINTFN(n,x)   do { if (mosdebug >= (n)) printf x; } while (0)
    122  1.7.4.2  martin int     mosdebug = 0;
    123  1.7.4.2  martin #else
    124  1.7.4.2  martin #define DPRINTF(x)	__nothing
    125  1.7.4.2  martin #define DPRINTFN(n,x)	__nothing
    126  1.7.4.2  martin #endif
    127  1.7.4.2  martin 
    128  1.7.4.2  martin /*
    129  1.7.4.2  martin  * Various supported device vendors/products.
    130  1.7.4.2  martin  */
    131  1.7.4.2  martin static const struct mos_type mos_devs[] = {
    132  1.7.4.2  martin 	{ { USB_VENDOR_MOSCHIP, USB_PRODUCT_MOSCHIP_MCS7730 }, MCS7730 },
    133  1.7.4.2  martin 	{ { USB_VENDOR_MOSCHIP, USB_PRODUCT_MOSCHIP_MCS7830 }, MCS7830 },
    134  1.7.4.2  martin 	{ { USB_VENDOR_MOSCHIP, USB_PRODUCT_MOSCHIP_MCS7832 }, MCS7832 },
    135  1.7.4.2  martin 	{ { USB_VENDOR_SITECOMEU, USB_PRODUCT_SITECOMEU_LN030 }, MCS7830 },
    136  1.7.4.2  martin };
    137  1.7.4.2  martin #define mos_lookup(v, p) ((const struct mos_type *)usb_lookup(mos_devs, v, p))
    138  1.7.4.2  martin 
    139  1.7.4.2  martin static int mos_match(device_t, cfdata_t, void *);
    140  1.7.4.2  martin static void mos_attach(device_t, device_t, void *);
    141  1.7.4.2  martin 
    142  1.7.4.2  martin CFATTACH_DECL_NEW(mos, sizeof(struct usbnet),
    143  1.7.4.2  martin 	mos_match, mos_attach, usbnet_detach, usbnet_activate);
    144  1.7.4.2  martin 
    145  1.7.4.2  martin static void mos_uno_rx_loop(struct usbnet *, struct usbnet_chain *, uint32_t);
    146  1.7.4.2  martin static unsigned mos_uno_tx_prepare(struct usbnet *, struct mbuf *,
    147  1.7.4.2  martin 				   struct usbnet_chain *);
    148  1.7.4.2  martin static int mos_uno_ioctl(struct ifnet *, u_long, void *);
    149  1.7.4.2  martin static int mos_uno_init(struct ifnet *);
    150  1.7.4.2  martin static void mos_chip_init(struct usbnet *);
    151  1.7.4.2  martin static void mos_uno_stop(struct ifnet *ifp, int disable);
    152  1.7.4.2  martin static int mos_uno_mii_read_reg(struct usbnet *, int, int, uint16_t *);
    153  1.7.4.2  martin static int mos_uno_mii_write_reg(struct usbnet *, int, int, uint16_t);
    154  1.7.4.2  martin static void mos_uno_mii_statchg(struct ifnet *);
    155  1.7.4.2  martin static void mos_reset(struct usbnet *);
    156  1.7.4.2  martin 
    157  1.7.4.2  martin static int mos_reg_read_1(struct usbnet *, int);
    158  1.7.4.2  martin static int mos_reg_read_2(struct usbnet *, int);
    159  1.7.4.2  martin static int mos_reg_write_1(struct usbnet *, int, int);
    160  1.7.4.2  martin static int mos_reg_write_2(struct usbnet *, int, int);
    161  1.7.4.2  martin static int mos_readmac(struct usbnet *);
    162  1.7.4.2  martin static int mos_writemac(struct usbnet *);
    163  1.7.4.2  martin static int mos_write_mcast(struct usbnet *, uint8_t *);
    164  1.7.4.2  martin 
    165  1.7.4.2  martin static const struct usbnet_ops mos_ops = {
    166  1.7.4.2  martin 	.uno_stop = mos_uno_stop,
    167  1.7.4.2  martin 	.uno_ioctl = mos_uno_ioctl,
    168  1.7.4.2  martin 	.uno_read_reg = mos_uno_mii_read_reg,
    169  1.7.4.2  martin 	.uno_write_reg = mos_uno_mii_write_reg,
    170  1.7.4.2  martin 	.uno_statchg = mos_uno_mii_statchg,
    171  1.7.4.2  martin 	.uno_tx_prepare = mos_uno_tx_prepare,
    172  1.7.4.2  martin 	.uno_rx_loop = mos_uno_rx_loop,
    173  1.7.4.2  martin 	.uno_init = mos_uno_init,
    174  1.7.4.2  martin };
    175  1.7.4.2  martin 
    176  1.7.4.2  martin static int
    177  1.7.4.2  martin mos_reg_read_1(struct usbnet *un, int reg)
    178  1.7.4.2  martin {
    179  1.7.4.2  martin 	usb_device_request_t	req;
    180  1.7.4.2  martin 	usbd_status		err;
    181  1.7.4.2  martin 	uByte			val = 0;
    182  1.7.4.2  martin 
    183  1.7.4.2  martin 	if (usbnet_isdying(un))
    184  1.7.4.2  martin 		return 0;
    185  1.7.4.2  martin 
    186  1.7.4.2  martin 	req.bmRequestType = UT_READ_VENDOR_DEVICE;
    187  1.7.4.2  martin 	req.bRequest = MOS_UR_READREG;
    188  1.7.4.2  martin 	USETW(req.wValue, 0);
    189  1.7.4.2  martin 	USETW(req.wIndex, reg);
    190  1.7.4.2  martin 	USETW(req.wLength, 1);
    191  1.7.4.2  martin 
    192  1.7.4.2  martin 	err = usbd_do_request(un->un_udev, &req, &val);
    193  1.7.4.2  martin 
    194  1.7.4.2  martin 	if (err) {
    195  1.7.4.2  martin 		aprint_error_dev(un->un_dev, "read reg %x\n", reg);
    196  1.7.4.2  martin 		return 0;
    197  1.7.4.2  martin 	}
    198  1.7.4.2  martin 
    199  1.7.4.2  martin 	return val;
    200  1.7.4.2  martin }
    201  1.7.4.2  martin 
    202  1.7.4.2  martin static int
    203  1.7.4.2  martin mos_reg_read_2(struct usbnet *un, int reg)
    204  1.7.4.2  martin {
    205  1.7.4.2  martin 	usb_device_request_t	req;
    206  1.7.4.2  martin 	usbd_status		err;
    207  1.7.4.2  martin 	uWord			val;
    208  1.7.4.2  martin 
    209  1.7.4.2  martin 	if (usbnet_isdying(un))
    210  1.7.4.2  martin 		return 0;
    211  1.7.4.2  martin 
    212  1.7.4.2  martin 	USETW(val,0);
    213  1.7.4.2  martin 
    214  1.7.4.2  martin 	req.bmRequestType = UT_READ_VENDOR_DEVICE;
    215  1.7.4.2  martin 	req.bRequest = MOS_UR_READREG;
    216  1.7.4.2  martin 	USETW(req.wValue, 0);
    217  1.7.4.2  martin 	USETW(req.wIndex, reg);
    218  1.7.4.2  martin 	USETW(req.wLength, 2);
    219  1.7.4.2  martin 
    220  1.7.4.2  martin 	err = usbd_do_request(un->un_udev, &req, &val);
    221  1.7.4.2  martin 
    222  1.7.4.2  martin 	if (err) {
    223  1.7.4.2  martin 		aprint_error_dev(un->un_dev, "read reg2 %x\n", reg);
    224  1.7.4.2  martin 		return 0;
    225  1.7.4.2  martin 	}
    226  1.7.4.2  martin 
    227  1.7.4.2  martin 	return UGETW(val);
    228  1.7.4.2  martin }
    229  1.7.4.2  martin 
    230  1.7.4.2  martin static int
    231  1.7.4.2  martin mos_reg_write_1(struct usbnet *un, int reg, int aval)
    232  1.7.4.2  martin {
    233  1.7.4.2  martin 	usb_device_request_t	req;
    234  1.7.4.2  martin 	usbd_status		err;
    235  1.7.4.2  martin 	uByte			val;
    236  1.7.4.2  martin 
    237  1.7.4.2  martin 	if (usbnet_isdying(un))
    238  1.7.4.2  martin 		return 0;
    239  1.7.4.2  martin 
    240  1.7.4.2  martin 	val = aval;
    241  1.7.4.2  martin 
    242  1.7.4.2  martin 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    243  1.7.4.2  martin 	req.bRequest = MOS_UR_WRITEREG;
    244  1.7.4.2  martin 	USETW(req.wValue, 0);
    245  1.7.4.2  martin 	USETW(req.wIndex, reg);
    246  1.7.4.2  martin 	USETW(req.wLength, 1);
    247  1.7.4.2  martin 
    248  1.7.4.2  martin 	err = usbd_do_request(un->un_udev, &req, &val);
    249  1.7.4.2  martin 
    250  1.7.4.2  martin 	if (err)
    251  1.7.4.2  martin 		aprint_error_dev(un->un_dev, "write reg %x <- %x\n",
    252  1.7.4.2  martin 		    reg, aval);
    253  1.7.4.2  martin 
    254  1.7.4.2  martin 	return 0;
    255  1.7.4.2  martin }
    256  1.7.4.2  martin 
    257  1.7.4.2  martin static int
    258  1.7.4.2  martin mos_reg_write_2(struct usbnet *un, int reg, int aval)
    259  1.7.4.2  martin {
    260  1.7.4.2  martin 	usb_device_request_t	req;
    261  1.7.4.2  martin 	usbd_status		err;
    262  1.7.4.2  martin 	uWord			val;
    263  1.7.4.2  martin 
    264  1.7.4.2  martin 	USETW(val, aval);
    265  1.7.4.2  martin 
    266  1.7.4.2  martin 	if (usbnet_isdying(un))
    267  1.7.4.2  martin 		return EIO;
    268  1.7.4.2  martin 
    269  1.7.4.2  martin 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    270  1.7.4.2  martin 	req.bRequest = MOS_UR_WRITEREG;
    271  1.7.4.2  martin 	USETW(req.wValue, 0);
    272  1.7.4.2  martin 	USETW(req.wIndex, reg);
    273  1.7.4.2  martin 	USETW(req.wLength, 2);
    274  1.7.4.2  martin 
    275  1.7.4.2  martin 	err = usbd_do_request(un->un_udev, &req, &val);
    276  1.7.4.2  martin 
    277  1.7.4.2  martin 	if (err)
    278  1.7.4.2  martin 		aprint_error_dev(un->un_dev, "write reg2 %x <- %x\n",
    279  1.7.4.2  martin 		    reg, aval);
    280  1.7.4.2  martin 
    281  1.7.4.2  martin 	return 0;
    282  1.7.4.2  martin }
    283  1.7.4.2  martin 
    284  1.7.4.2  martin static int
    285  1.7.4.2  martin mos_readmac(struct usbnet *un)
    286  1.7.4.2  martin {
    287  1.7.4.2  martin 	usb_device_request_t	req;
    288  1.7.4.2  martin 	usbd_status		err;
    289  1.7.4.2  martin 
    290  1.7.4.2  martin 	if (usbnet_isdying(un))
    291  1.7.4.2  martin 		return 0;
    292  1.7.4.2  martin 
    293  1.7.4.2  martin 	req.bmRequestType = UT_READ_VENDOR_DEVICE;
    294  1.7.4.2  martin 	req.bRequest = MOS_UR_READREG;
    295  1.7.4.2  martin 	USETW(req.wValue, 0);
    296  1.7.4.2  martin 	USETW(req.wIndex, MOS_MAC);
    297  1.7.4.2  martin 	USETW(req.wLength, ETHER_ADDR_LEN);
    298  1.7.4.2  martin 
    299  1.7.4.2  martin 	err = usbd_do_request(un->un_udev, &req, un->un_eaddr);
    300  1.7.4.2  martin 
    301  1.7.4.2  martin 	if (err)
    302  1.7.4.2  martin 		aprint_error_dev(un->un_dev, "%s: failed", __func__);
    303  1.7.4.2  martin 
    304  1.7.4.2  martin 	return err;
    305  1.7.4.2  martin }
    306  1.7.4.2  martin 
    307  1.7.4.2  martin static int
    308  1.7.4.2  martin mos_writemac(struct usbnet *un)
    309  1.7.4.2  martin {
    310  1.7.4.2  martin 	usb_device_request_t	req;
    311  1.7.4.2  martin 	usbd_status		err;
    312  1.7.4.2  martin 
    313  1.7.4.2  martin 	if (usbnet_isdying(un))
    314  1.7.4.2  martin 		return 0;
    315  1.7.4.2  martin 
    316  1.7.4.2  martin 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    317  1.7.4.2  martin 	req.bRequest = MOS_UR_WRITEREG;
    318  1.7.4.2  martin 	USETW(req.wValue, 0);
    319  1.7.4.2  martin 	USETW(req.wIndex, MOS_MAC);
    320  1.7.4.2  martin 	USETW(req.wLength, ETHER_ADDR_LEN);
    321  1.7.4.2  martin 
    322  1.7.4.2  martin 	err = usbd_do_request(un->un_udev, &req, un->un_eaddr);
    323  1.7.4.2  martin 
    324  1.7.4.2  martin 	if (err)
    325  1.7.4.2  martin 		aprint_error_dev(un->un_dev, "%s: failed", __func__);
    326  1.7.4.2  martin 
    327  1.7.4.2  martin 	return 0;
    328  1.7.4.2  martin }
    329  1.7.4.2  martin 
    330  1.7.4.2  martin static int
    331  1.7.4.2  martin mos_write_mcast(struct usbnet *un, uint8_t *hashtbl)
    332  1.7.4.2  martin {
    333  1.7.4.2  martin 	usb_device_request_t	req;
    334  1.7.4.2  martin 	usbd_status		err;
    335  1.7.4.2  martin 
    336  1.7.4.2  martin 	if (usbnet_isdying(un))
    337  1.7.4.2  martin 		return EIO;
    338  1.7.4.2  martin 
    339  1.7.4.2  martin 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    340  1.7.4.2  martin 	req.bRequest = MOS_UR_WRITEREG;
    341  1.7.4.2  martin 	USETW(req.wValue, 0);
    342  1.7.4.2  martin 	USETW(req.wIndex, MOS_MCAST_TABLE);
    343  1.7.4.2  martin 	USETW(req.wLength, 8);
    344  1.7.4.2  martin 
    345  1.7.4.2  martin 	err = usbd_do_request(un->un_udev, &req, hashtbl);
    346  1.7.4.2  martin 
    347  1.7.4.2  martin 	if (err) {
    348  1.7.4.2  martin 		aprint_error_dev(un->un_dev, "%s: failed", __func__);
    349  1.7.4.2  martin 		return(-1);
    350  1.7.4.2  martin 	}
    351  1.7.4.2  martin 
    352  1.7.4.2  martin 	return 0;
    353  1.7.4.2  martin }
    354  1.7.4.2  martin 
    355  1.7.4.2  martin static int
    356  1.7.4.2  martin mos_uno_mii_read_reg(struct usbnet *un, int phy, int reg, uint16_t *val)
    357  1.7.4.2  martin {
    358  1.7.4.2  martin 	int			i, res;
    359  1.7.4.2  martin 
    360  1.7.4.2  martin 	mos_reg_write_2(un, MOS_PHY_DATA, 0);
    361  1.7.4.2  martin 	mos_reg_write_1(un, MOS_PHY_CTL, (phy & MOS_PHYCTL_PHYADDR) |
    362  1.7.4.2  martin 	    MOS_PHYCTL_READ);
    363  1.7.4.2  martin 	mos_reg_write_1(un, MOS_PHY_STS, (reg & MOS_PHYSTS_PHYREG) |
    364  1.7.4.2  martin 	    MOS_PHYSTS_PENDING);
    365  1.7.4.2  martin 
    366  1.7.4.2  martin 	for (i = 0; i < MOS_TIMEOUT; i++) {
    367  1.7.4.2  martin 		if (mos_reg_read_1(un, MOS_PHY_STS) & MOS_PHYSTS_READY)
    368  1.7.4.2  martin 			break;
    369  1.7.4.2  martin 	}
    370  1.7.4.2  martin 	if (i == MOS_TIMEOUT) {
    371  1.7.4.2  martin 		aprint_error_dev(un->un_dev, "read PHY failed\n");
    372  1.7.4.2  martin 		return EIO;
    373  1.7.4.2  martin 	}
    374  1.7.4.2  martin 
    375  1.7.4.2  martin 	res = mos_reg_read_2(un, MOS_PHY_DATA);
    376  1.7.4.2  martin 	*val = res;
    377  1.7.4.2  martin 
    378  1.7.4.2  martin 	DPRINTFN(10,("%s: %s: phy %d reg %d val %u\n",
    379  1.7.4.2  martin 	    device_xname(un->un_dev), __func__, phy, reg, res));
    380  1.7.4.2  martin 
    381  1.7.4.2  martin 	return 0;
    382  1.7.4.2  martin }
    383  1.7.4.2  martin 
    384  1.7.4.2  martin static int
    385  1.7.4.2  martin mos_uno_mii_write_reg(struct usbnet *un, int phy, int reg, uint16_t val)
    386  1.7.4.2  martin {
    387  1.7.4.2  martin 	int			i;
    388  1.7.4.2  martin 
    389  1.7.4.2  martin 	DPRINTFN(10,("%s: %s: phy %d reg %d val %u\n",
    390  1.7.4.2  martin 	    device_xname(un->un_dev), __func__, phy, reg, val));
    391  1.7.4.2  martin 
    392  1.7.4.2  martin 	mos_reg_write_2(un, MOS_PHY_DATA, val);
    393  1.7.4.2  martin 	mos_reg_write_1(un, MOS_PHY_CTL, (phy & MOS_PHYCTL_PHYADDR) |
    394  1.7.4.2  martin 	    MOS_PHYCTL_WRITE);
    395  1.7.4.2  martin 	mos_reg_write_1(un, MOS_PHY_STS, (reg & MOS_PHYSTS_PHYREG) |
    396  1.7.4.2  martin 	    MOS_PHYSTS_PENDING);
    397  1.7.4.2  martin 
    398  1.7.4.2  martin 	for (i = 0; i < MOS_TIMEOUT; i++) {
    399  1.7.4.2  martin 		if (mos_reg_read_1(un, MOS_PHY_STS) & MOS_PHYSTS_READY)
    400  1.7.4.2  martin 			break;
    401  1.7.4.2  martin 	}
    402  1.7.4.2  martin 	if (i == MOS_TIMEOUT) {
    403  1.7.4.2  martin 		aprint_error_dev(un->un_dev, "write PHY failed\n");
    404  1.7.4.2  martin 		return EIO;
    405  1.7.4.2  martin 	}
    406  1.7.4.2  martin 
    407  1.7.4.2  martin 	return 0;
    408  1.7.4.2  martin }
    409  1.7.4.2  martin 
    410  1.7.4.2  martin void
    411  1.7.4.2  martin mos_uno_mii_statchg(struct ifnet *ifp)
    412  1.7.4.2  martin {
    413  1.7.4.2  martin 	struct usbnet * const		un = ifp->if_softc;
    414  1.7.4.2  martin 	struct mii_data * const		mii = usbnet_mii(un);
    415  1.7.4.2  martin 	int				val, err;
    416  1.7.4.2  martin 
    417  1.7.4.2  martin 	if (usbnet_isdying(un))
    418  1.7.4.2  martin 		return;
    419  1.7.4.2  martin 
    420  1.7.4.2  martin 	DPRINTFN(10,("%s: %s: enter\n", device_xname(un->un_dev), __func__));
    421  1.7.4.2  martin 
    422  1.7.4.2  martin 	/* disable RX, TX prior to changing FDX, SPEEDSEL */
    423  1.7.4.2  martin 	val = mos_reg_read_1(un, MOS_CTL);
    424  1.7.4.2  martin 	val &= ~(MOS_CTL_TX_ENB | MOS_CTL_RX_ENB);
    425  1.7.4.2  martin 	mos_reg_write_1(un, MOS_CTL, val);
    426  1.7.4.2  martin 
    427  1.7.4.2  martin 	/* reset register which counts dropped frames */
    428  1.7.4.2  martin 	mos_reg_write_1(un, MOS_FRAME_DROP_CNT, 0);
    429  1.7.4.2  martin 
    430  1.7.4.2  martin 	if ((mii->mii_media_active & IFM_GMASK) == IFM_FDX)
    431  1.7.4.2  martin 		val |= MOS_CTL_FDX_ENB;
    432  1.7.4.2  martin 	else
    433  1.7.4.2  martin 		val &= ~(MOS_CTL_FDX_ENB);
    434  1.7.4.2  martin 
    435  1.7.4.2  martin 	if ((mii->mii_media_status & (IFM_ACTIVE | IFM_AVALID)) ==
    436  1.7.4.2  martin 	    (IFM_ACTIVE | IFM_AVALID)) {
    437  1.7.4.2  martin 		switch (IFM_SUBTYPE(mii->mii_media_active)) {
    438  1.7.4.2  martin 		case IFM_100_TX:
    439  1.7.4.2  martin 			val |=  MOS_CTL_SPEEDSEL;
    440  1.7.4.2  martin 			break;
    441  1.7.4.2  martin 		case IFM_10_T:
    442  1.7.4.2  martin 			val &= ~(MOS_CTL_SPEEDSEL);
    443  1.7.4.2  martin 			break;
    444  1.7.4.2  martin 		}
    445  1.7.4.2  martin 		usbnet_set_link(un, true);
    446  1.7.4.2  martin 	}
    447  1.7.4.2  martin 
    448  1.7.4.2  martin 	/* re-enable TX, RX */
    449  1.7.4.2  martin 	val |= (MOS_CTL_TX_ENB | MOS_CTL_RX_ENB);
    450  1.7.4.2  martin 	err = mos_reg_write_1(un, MOS_CTL, val);
    451  1.7.4.2  martin 
    452  1.7.4.2  martin 	if (err)
    453  1.7.4.2  martin 		aprint_error_dev(un->un_dev, "media change failed\n");
    454  1.7.4.2  martin }
    455  1.7.4.2  martin 
    456  1.7.4.2  martin static void
    457  1.7.4.2  martin mos_rcvfilt_locked(struct usbnet *un)
    458  1.7.4.2  martin {
    459  1.7.4.2  martin 	struct ifnet		*ifp = usbnet_ifp(un);
    460  1.7.4.2  martin 	struct ethercom		*ec = usbnet_ec(un);
    461  1.7.4.2  martin 	struct ether_multi	*enm;
    462  1.7.4.2  martin 	struct ether_multistep	step;
    463  1.7.4.2  martin 	u_int32_t h = 0;
    464  1.7.4.2  martin 	u_int8_t rxmode, mchash[8] = { 0, 0, 0, 0, 0, 0, 0, 0 };
    465  1.7.4.2  martin 
    466  1.7.4.2  martin 	if (usbnet_isdying(un))
    467  1.7.4.2  martin 		return;
    468  1.7.4.2  martin 
    469  1.7.4.2  martin 	rxmode = mos_reg_read_1(un, MOS_CTL);
    470  1.7.4.2  martin 	rxmode &= ~(MOS_CTL_ALLMULTI | MOS_CTL_RX_PROMISC);
    471  1.7.4.2  martin 
    472  1.7.4.2  martin 	ETHER_LOCK(ec);
    473  1.7.4.2  martin 	if (ifp->if_flags & IFF_PROMISC) {
    474  1.7.4.2  martin 		ec->ec_flags |= ETHER_F_ALLMULTI;
    475  1.7.4.2  martin 		ETHER_UNLOCK(ec);
    476  1.7.4.2  martin 		/* run promisc. mode */
    477  1.7.4.2  martin 		rxmode |= MOS_CTL_ALLMULTI; /* ??? */
    478  1.7.4.2  martin 		rxmode |= MOS_CTL_RX_PROMISC;
    479  1.7.4.2  martin 		goto update;
    480  1.7.4.2  martin 	}
    481  1.7.4.2  martin 	ec->ec_flags &= ~ETHER_F_ALLMULTI;
    482  1.7.4.2  martin 	ETHER_FIRST_MULTI(step, ec, enm);
    483  1.7.4.2  martin 	while (enm != NULL) {
    484  1.7.4.2  martin 		if (memcmp(enm->enm_addrlo, enm->enm_addrhi, ETHER_ADDR_LEN)) {
    485  1.7.4.2  martin 			ec->ec_flags |= ETHER_F_ALLMULTI;
    486  1.7.4.2  martin 			ETHER_UNLOCK(ec);
    487  1.7.4.2  martin 			memset(mchash, 0, sizeof(mchash)); /* correct ??? */
    488  1.7.4.2  martin 			/* accept all multicast frame */
    489  1.7.4.2  martin 			rxmode |= MOS_CTL_ALLMULTI;
    490  1.7.4.2  martin 			goto update;
    491  1.7.4.2  martin 		}
    492  1.7.4.2  martin 		h = ether_crc32_be(enm->enm_addrlo, ETHER_ADDR_LEN);
    493  1.7.4.2  martin 		/* 3(31:29) and 3(28:26) sampling to have uint8_t[8] */
    494  1.7.4.2  martin 		mchash[h >> 29] |= 1 << ((h >> 26) % 8);
    495  1.7.4.2  martin 		ETHER_NEXT_MULTI(step, enm);
    496  1.7.4.2  martin 	}
    497  1.7.4.2  martin 	ETHER_UNLOCK(ec);
    498  1.7.4.2  martin 	/* MOS receive filter is always on */
    499  1.7.4.2  martin  update:
    500  1.7.4.2  martin 	/*
    501  1.7.4.2  martin 	 * The datasheet claims broadcast frames were always accepted
    502  1.7.4.2  martin 	 * regardless of filter settings. But the hardware seems to
    503  1.7.4.2  martin 	 * filter broadcast frames, so pass them explicitly.
    504  1.7.4.2  martin 	 */
    505  1.7.4.2  martin 	mchash[7] |= 0x80;
    506  1.7.4.2  martin 	mos_write_mcast(un, mchash);
    507  1.7.4.2  martin 	mos_reg_write_1(un, MOS_CTL, rxmode);
    508  1.7.4.2  martin }
    509  1.7.4.2  martin 
    510  1.7.4.2  martin static void
    511  1.7.4.2  martin mos_reset(struct usbnet *un)
    512  1.7.4.2  martin {
    513  1.7.4.2  martin 	u_int8_t ctl;
    514  1.7.4.2  martin 
    515  1.7.4.2  martin 	if (usbnet_isdying(un))
    516  1.7.4.2  martin 		return;
    517  1.7.4.2  martin 
    518  1.7.4.2  martin 	ctl = mos_reg_read_1(un, MOS_CTL);
    519  1.7.4.2  martin 	ctl &= ~(MOS_CTL_RX_PROMISC | MOS_CTL_ALLMULTI | MOS_CTL_TX_ENB |
    520  1.7.4.2  martin 	    MOS_CTL_RX_ENB);
    521  1.7.4.2  martin 	/* Disable RX, TX, promiscuous and allmulticast mode */
    522  1.7.4.2  martin 	mos_reg_write_1(un, MOS_CTL, ctl);
    523  1.7.4.2  martin 
    524  1.7.4.2  martin 	/* Reset frame drop counter register to zero */
    525  1.7.4.2  martin 	mos_reg_write_1(un, MOS_FRAME_DROP_CNT, 0);
    526  1.7.4.2  martin 
    527  1.7.4.2  martin 	/* Wait a little while for the chip to get its brains in order. */
    528  1.7.4.2  martin 	DELAY(1000);
    529  1.7.4.2  martin }
    530  1.7.4.2  martin 
    531  1.7.4.2  martin void
    532  1.7.4.2  martin mos_chip_init(struct usbnet *un)
    533  1.7.4.2  martin {
    534  1.7.4.2  martin 	int	i;
    535  1.7.4.2  martin 
    536  1.7.4.2  martin 	/*
    537  1.7.4.2  martin 	 * Rev.C devices have a pause threshold register which needs to be set
    538  1.7.4.2  martin 	 * at startup.
    539  1.7.4.2  martin 	 */
    540  1.7.4.2  martin 	if (mos_reg_read_1(un, MOS_PAUSE_TRHD) != -1) {
    541  1.7.4.2  martin 		for (i = 0; i < MOS_PAUSE_REWRITES; i++)
    542  1.7.4.2  martin 			mos_reg_write_1(un, MOS_PAUSE_TRHD, 0);
    543  1.7.4.2  martin 	}
    544  1.7.4.2  martin }
    545  1.7.4.2  martin 
    546  1.7.4.2  martin /*
    547  1.7.4.2  martin  * Probe for a MCS7x30 chip.
    548  1.7.4.2  martin  */
    549  1.7.4.2  martin static int
    550  1.7.4.2  martin mos_match(device_t parent, cfdata_t match, void *aux)
    551  1.7.4.2  martin {
    552  1.7.4.2  martin 	struct usb_attach_arg *uaa = aux;
    553  1.7.4.2  martin 
    554  1.7.4.2  martin 	return (mos_lookup(uaa->uaa_vendor, uaa->uaa_product) != NULL ?
    555  1.7.4.2  martin 	    UMATCH_VENDOR_PRODUCT : UMATCH_NONE);
    556  1.7.4.2  martin }
    557  1.7.4.2  martin 
    558  1.7.4.2  martin /*
    559  1.7.4.2  martin  * Attach the interface.
    560  1.7.4.2  martin  */
    561  1.7.4.2  martin static void
    562  1.7.4.2  martin mos_attach(device_t parent, device_t self, void *aux)
    563  1.7.4.2  martin {
    564  1.7.4.2  martin 	USBNET_MII_DECL_DEFAULT(unm);
    565  1.7.4.2  martin 	struct usbnet *		un = device_private(self);
    566  1.7.4.2  martin 	struct usb_attach_arg	*uaa = aux;
    567  1.7.4.2  martin 	struct usbd_device	*dev = uaa->uaa_device;
    568  1.7.4.2  martin 	usbd_status		err;
    569  1.7.4.2  martin 	usb_interface_descriptor_t 	*id;
    570  1.7.4.2  martin 	usb_endpoint_descriptor_t 	*ed;
    571  1.7.4.2  martin 	char			*devinfop;
    572  1.7.4.2  martin 	int			i;
    573  1.7.4.2  martin 
    574  1.7.4.2  martin 	aprint_naive("\n");
    575  1.7.4.2  martin 	aprint_normal("\n");
    576  1.7.4.2  martin 	devinfop = usbd_devinfo_alloc(dev, 0);
    577  1.7.4.2  martin 	aprint_normal_dev(self, "%s\n", devinfop);
    578  1.7.4.2  martin 	usbd_devinfo_free(devinfop);
    579  1.7.4.2  martin 
    580  1.7.4.2  martin 	un->un_dev = self;
    581  1.7.4.2  martin 	un->un_udev = dev;
    582  1.7.4.2  martin 	un->un_sc = un;
    583  1.7.4.2  martin 	un->un_ops = &mos_ops;
    584  1.7.4.2  martin 	un->un_rx_xfer_flags = USBD_SHORT_XFER_OK;
    585  1.7.4.2  martin 	un->un_tx_xfer_flags = USBD_FORCE_SHORT_XFER;
    586  1.7.4.2  martin 	un->un_rx_list_cnt = MOS_RX_LIST_CNT;
    587  1.7.4.2  martin 	un->un_tx_list_cnt = MOS_TX_LIST_CNT;
    588  1.7.4.2  martin 	un->un_rx_bufsz = un->un_tx_bufsz = MOS_BUFSZ;
    589  1.7.4.2  martin 
    590  1.7.4.2  martin 	err = usbd_set_config_no(dev, MOS_CONFIG_NO, 1);
    591  1.7.4.2  martin 	if (err) {
    592  1.7.4.2  martin 		aprint_error_dev(self, "failed to set configuration"
    593  1.7.4.2  martin 		    ", err=%s\n", usbd_errstr(err));
    594  1.7.4.2  martin 		return;
    595  1.7.4.2  martin 	}
    596  1.7.4.2  martin 
    597  1.7.4.2  martin 	err = usbd_device2interface_handle(dev, MOS_IFACE_IDX, &un->un_iface);
    598  1.7.4.2  martin 	if (err) {
    599  1.7.4.2  martin 		aprint_error_dev(self, "failed getting interface handle"
    600  1.7.4.2  martin 		    ", err=%s\n", usbd_errstr(err));
    601  1.7.4.2  martin 		return;
    602  1.7.4.2  martin 	}
    603  1.7.4.2  martin 
    604  1.7.4.2  martin 	un->un_flags = mos_lookup(uaa->uaa_vendor, uaa->uaa_product)->mos_flags;
    605  1.7.4.2  martin 
    606  1.7.4.2  martin 	id = usbd_get_interface_descriptor(un->un_iface);
    607  1.7.4.2  martin 
    608  1.7.4.2  martin 	/* Find endpoints. */
    609  1.7.4.2  martin 	for (i = 0; i < id->bNumEndpoints; i++) {
    610  1.7.4.2  martin 		ed = usbd_interface2endpoint_descriptor(un->un_iface, i);
    611  1.7.4.2  martin 		if (!ed) {
    612  1.7.4.2  martin 			aprint_error_dev(self, "couldn't get ep %d\n", i);
    613  1.7.4.2  martin 			return;
    614  1.7.4.2  martin 		}
    615  1.7.4.2  martin 		if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
    616  1.7.4.2  martin 		    UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
    617  1.7.4.2  martin 			un->un_ed[USBNET_ENDPT_RX] = ed->bEndpointAddress;
    618  1.7.4.2  martin 		} else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
    619  1.7.4.2  martin 			   UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
    620  1.7.4.2  martin 			un->un_ed[USBNET_ENDPT_TX] = ed->bEndpointAddress;
    621  1.7.4.2  martin 		} else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
    622  1.7.4.2  martin 			   UE_GET_XFERTYPE(ed->bmAttributes) == UE_INTERRUPT) {
    623  1.7.4.2  martin 			un->un_ed[USBNET_ENDPT_INTR] = ed->bEndpointAddress;
    624  1.7.4.2  martin 		}
    625  1.7.4.2  martin 	}
    626  1.7.4.2  martin 
    627  1.7.4.2  martin 	if (un->un_flags & MCS7730)
    628  1.7.4.2  martin 		aprint_normal_dev(self, "MCS7730\n");
    629  1.7.4.2  martin 	else if (un->un_flags & MCS7830)
    630  1.7.4.2  martin 		aprint_normal_dev(self, "MCS7830\n");
    631  1.7.4.2  martin 	else if (un->un_flags & MCS7832)
    632  1.7.4.2  martin 		aprint_normal_dev(self, "MCS7832\n");
    633  1.7.4.2  martin 
    634  1.7.4.2  martin 	/* Set these up now for register access. */
    635  1.7.4.2  martin 	usbnet_attach(un, "mosdet");
    636  1.7.4.2  martin 
    637  1.7.4.2  martin 	mos_chip_init(un);
    638  1.7.4.2  martin 
    639  1.7.4.2  martin 	/*
    640  1.7.4.2  martin 	 * Read MAC address, inform the world.
    641  1.7.4.2  martin 	 */
    642  1.7.4.2  martin 	err = mos_readmac(un);
    643  1.7.4.2  martin 	if (err) {
    644  1.7.4.2  martin 		aprint_error_dev(self, "couldn't read MAC address\n");
    645  1.7.4.2  martin 		return;
    646  1.7.4.2  martin 	}
    647  1.7.4.2  martin 
    648  1.7.4.2  martin 	struct ifnet *ifp = usbnet_ifp(un);
    649  1.7.4.2  martin 	ifp->if_capabilities = ETHERCAP_VLAN_MTU;
    650  1.7.4.2  martin 
    651  1.7.4.2  martin 	usbnet_attach_ifp(un, IFF_SIMPLEX | IFF_BROADCAST | IFF_MULTICAST,
    652  1.7.4.2  martin 	    0, &unm);
    653  1.7.4.2  martin }
    654  1.7.4.2  martin 
    655  1.7.4.2  martin /*
    656  1.7.4.2  martin  * A frame has been uploaded: pass the resulting mbuf chain up to
    657  1.7.4.2  martin  * the higher level protocols.
    658  1.7.4.2  martin  */
    659  1.7.4.2  martin void
    660  1.7.4.2  martin mos_uno_rx_loop(struct usbnet * un, struct usbnet_chain *c, uint32_t total_len)
    661  1.7.4.2  martin {
    662  1.7.4.2  martin 	struct ifnet		*ifp = usbnet_ifp(un);
    663  1.7.4.2  martin 	uint8_t			*buf = c->unc_buf;
    664  1.7.4.2  martin 	u_int8_t		rxstat;
    665  1.7.4.2  martin 	u_int16_t		pktlen = 0;
    666  1.7.4.2  martin 
    667  1.7.4.2  martin 	DPRINTFN(5,("%s: %s: enter len %u\n",
    668  1.7.4.2  martin 	    device_xname(un->un_dev), __func__, total_len));
    669  1.7.4.2  martin 
    670  1.7.4.2  martin 	if (total_len <= 1)
    671  1.7.4.2  martin 		return;
    672  1.7.4.2  martin 
    673  1.7.4.2  martin 	/* evaluate status byte at the end */
    674  1.7.4.2  martin 	pktlen = total_len - 1;
    675  1.7.4.2  martin 	if (pktlen > un->un_rx_bufsz) {
    676  1.7.4.2  martin 		if_statinc(ifp, if_ierrors);
    677  1.7.4.2  martin 		return;
    678  1.7.4.2  martin 	}
    679  1.7.4.2  martin 	rxstat = buf[pktlen] & MOS_RXSTS_MASK;
    680  1.7.4.2  martin 
    681  1.7.4.2  martin 	if (rxstat != MOS_RXSTS_VALID) {
    682  1.7.4.2  martin 		DPRINTF(("%s: erroneous frame received: ",
    683  1.7.4.2  martin 		    device_xname(un->un_dev)));
    684  1.7.4.2  martin 		if (rxstat & MOS_RXSTS_SHORT_FRAME)
    685  1.7.4.2  martin 			DPRINTF(("frame size less than 64 bytes\n"));
    686  1.7.4.2  martin 		if (rxstat & MOS_RXSTS_LARGE_FRAME)
    687  1.7.4.2  martin 			DPRINTF(("frame size larger than 1532 bytes\n"));
    688  1.7.4.2  martin 		if (rxstat & MOS_RXSTS_CRC_ERROR)
    689  1.7.4.2  martin 			DPRINTF(("CRC error\n"));
    690  1.7.4.2  martin 		if (rxstat & MOS_RXSTS_ALIGN_ERROR)
    691  1.7.4.2  martin 			DPRINTF(("alignment error\n"));
    692  1.7.4.2  martin 		if_statinc(ifp, if_ierrors);
    693  1.7.4.2  martin 		return;
    694  1.7.4.2  martin 	}
    695  1.7.4.2  martin 
    696  1.7.4.2  martin 	if (pktlen < sizeof(struct ether_header) ) {
    697  1.7.4.2  martin 		if_statinc(ifp, if_ierrors);
    698  1.7.4.2  martin 		return;
    699  1.7.4.2  martin 	}
    700  1.7.4.2  martin 
    701  1.7.4.2  martin 	usbnet_enqueue(un, c->unc_buf, pktlen, 0, 0, 0);
    702  1.7.4.2  martin }
    703  1.7.4.2  martin 
    704  1.7.4.2  martin static unsigned
    705  1.7.4.2  martin mos_uno_tx_prepare(struct usbnet *un, struct mbuf *m, struct usbnet_chain *c)
    706  1.7.4.2  martin {
    707  1.7.4.2  martin 	int			length;
    708  1.7.4.2  martin 
    709  1.7.4.2  martin 	if ((unsigned)m->m_pkthdr.len > un->un_tx_bufsz)
    710  1.7.4.2  martin 		return 0;
    711  1.7.4.2  martin 
    712  1.7.4.2  martin 	m_copydata(m, 0, m->m_pkthdr.len, c->unc_buf);
    713  1.7.4.2  martin 	length = m->m_pkthdr.len;
    714  1.7.4.2  martin 
    715  1.7.4.2  martin 	DPRINTFN(5,("%s: %s: len %u\n",
    716  1.7.4.2  martin 	    device_xname(un->un_dev), __func__, length));
    717  1.7.4.2  martin 
    718  1.7.4.2  martin 	return length;
    719  1.7.4.2  martin }
    720  1.7.4.2  martin 
    721  1.7.4.2  martin static int
    722  1.7.4.2  martin mos_init_locked(struct ifnet *ifp)
    723  1.7.4.2  martin {
    724  1.7.4.2  martin 	struct usbnet * const un = ifp->if_softc;
    725  1.7.4.2  martin 	u_int8_t		rxmode;
    726  1.7.4.2  martin 	unsigned char		ipgs[2];
    727  1.7.4.2  martin 
    728  1.7.4.2  martin 	if (usbnet_isdying(un))
    729  1.7.4.2  martin 		return EIO;
    730  1.7.4.2  martin 
    731  1.7.4.2  martin 	/* Cancel pending I/O */
    732  1.7.4.2  martin 	usbnet_stop(un, ifp, 1);
    733  1.7.4.2  martin 
    734  1.7.4.2  martin 	/* Reset the ethernet interface. */
    735  1.7.4.2  martin 	mos_reset(un);
    736  1.7.4.2  martin 
    737  1.7.4.2  martin 	/* Write MAC address. */
    738  1.7.4.2  martin 	mos_writemac(un);
    739  1.7.4.2  martin 
    740  1.7.4.2  martin 	/* Read and set transmitter IPG values */
    741  1.7.4.2  martin 	ipgs[0] = mos_reg_read_1(un, MOS_IPG0);
    742  1.7.4.2  martin 	ipgs[1] = mos_reg_read_1(un, MOS_IPG1);
    743  1.7.4.2  martin 	mos_reg_write_1(un, MOS_IPG0, ipgs[0]);
    744  1.7.4.2  martin 	mos_reg_write_1(un, MOS_IPG1, ipgs[1]);
    745  1.7.4.2  martin 
    746  1.7.4.2  martin 	/* Accept multicast frame or run promisc. mode */
    747  1.7.4.2  martin 	mos_rcvfilt_locked(un);
    748  1.7.4.2  martin 
    749  1.7.4.2  martin 	/* Enable receiver and transmitter, bridge controls speed/duplex mode */
    750  1.7.4.2  martin 	rxmode = mos_reg_read_1(un, MOS_CTL);
    751  1.7.4.2  martin 	rxmode |= MOS_CTL_RX_ENB | MOS_CTL_TX_ENB | MOS_CTL_BS_ENB;
    752  1.7.4.2  martin 	rxmode &= ~(MOS_CTL_SLEEP);
    753  1.7.4.2  martin 	mos_reg_write_1(un, MOS_CTL, rxmode);
    754  1.7.4.2  martin 
    755  1.7.4.2  martin 	return usbnet_init_rx_tx(un);
    756  1.7.4.2  martin }
    757  1.7.4.2  martin 
    758  1.7.4.2  martin static int
    759  1.7.4.2  martin mos_uno_init(struct ifnet *ifp)
    760  1.7.4.2  martin {
    761  1.7.4.2  martin 	struct usbnet * const un = ifp->if_softc;
    762  1.7.4.2  martin 
    763  1.7.4.2  martin 	usbnet_lock_core(un);
    764  1.7.4.2  martin 	usbnet_busy(un);
    765  1.7.4.2  martin 	int ret = mos_init_locked(ifp);
    766  1.7.4.2  martin 	usbnet_unbusy(un);
    767  1.7.4.2  martin 	usbnet_unlock_core(un);
    768  1.7.4.2  martin 
    769  1.7.4.2  martin 	return ret;
    770  1.7.4.2  martin }
    771  1.7.4.2  martin 
    772  1.7.4.2  martin static int
    773  1.7.4.2  martin mos_uno_ioctl(struct ifnet *ifp, u_long cmd, void *data)
    774  1.7.4.2  martin {
    775  1.7.4.2  martin 	struct usbnet * const un = ifp->if_softc;
    776  1.7.4.2  martin 
    777  1.7.4.2  martin 	usbnet_lock_core(un);
    778  1.7.4.2  martin 	usbnet_busy(un);
    779  1.7.4.2  martin 
    780  1.7.4.2  martin 	switch (cmd) {
    781  1.7.4.2  martin 	case SIOCADDMULTI:
    782  1.7.4.2  martin 	case SIOCDELMULTI:
    783  1.7.4.2  martin 		mos_rcvfilt_locked(un);
    784  1.7.4.2  martin 		break;
    785  1.7.4.2  martin 	default:
    786  1.7.4.2  martin 		break;
    787  1.7.4.2  martin 	}
    788  1.7.4.2  martin 
    789  1.7.4.2  martin 	usbnet_unbusy(un);
    790  1.7.4.2  martin 	usbnet_unlock_core(un);
    791  1.7.4.2  martin 
    792  1.7.4.2  martin 	return 0;
    793  1.7.4.2  martin }
    794  1.7.4.2  martin 
    795  1.7.4.2  martin void
    796  1.7.4.2  martin mos_uno_stop(struct ifnet *ifp, int disable)
    797  1.7.4.2  martin {
    798  1.7.4.2  martin 	struct usbnet * const un = ifp->if_softc;
    799  1.7.4.2  martin 
    800  1.7.4.2  martin 	mos_reset(un);
    801  1.7.4.2  martin }
    802