1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43#include <linux/crc32.h>
44#include <linux/etherdevice.h>
45#include <linux/ethtool.h>
46#include <linux/init.h>
47#include <linux/mii.h>
48#include <linux/module.h>
49#include <linux/netdevice.h>
50#include <linux/slab.h>
51#include <linux/usb.h>
52#include <linux/usb/usbnet.h>
53
54
55#define MCS7830_RD_BMREQ (USB_DIR_IN | USB_TYPE_VENDOR | \
56 USB_RECIP_DEVICE)
57#define MCS7830_WR_BMREQ (USB_DIR_OUT | USB_TYPE_VENDOR | \
58 USB_RECIP_DEVICE)
59#define MCS7830_RD_BREQ 0x0E
60#define MCS7830_WR_BREQ 0x0D
61
62#define MCS7830_CTRL_TIMEOUT 1000
63#define MCS7830_MAX_MCAST 64
64
65#define MCS7830_VENDOR_ID 0x9710
66#define MCS7832_PRODUCT_ID 0x7832
67#define MCS7830_PRODUCT_ID 0x7830
68#define MCS7730_PRODUCT_ID 0x7730
69
70#define SITECOM_VENDOR_ID 0x0DF6
71#define LN_030_PRODUCT_ID 0x0021
72
73#define MCS7830_MII_ADVERTISE (ADVERTISE_PAUSE_CAP | ADVERTISE_100FULL | \
74 ADVERTISE_100HALF | ADVERTISE_10FULL | \
75 ADVERTISE_10HALF | ADVERTISE_CSMA)
76
77
78enum {
79 HIF_REG_MULTICAST_HASH = 0x00,
80 HIF_REG_PACKET_GAP1 = 0x08,
81 HIF_REG_PACKET_GAP2 = 0x09,
82 HIF_REG_PHY_DATA = 0x0a,
83 HIF_REG_PHY_CMD1 = 0x0c,
84 HIF_REG_PHY_CMD1_READ = 0x40,
85 HIF_REG_PHY_CMD1_WRITE = 0x20,
86 HIF_REG_PHY_CMD1_PHYADDR = 0x01,
87 HIF_REG_PHY_CMD2 = 0x0d,
88 HIF_REG_PHY_CMD2_PEND_FLAG_BIT = 0x80,
89 HIF_REG_PHY_CMD2_READY_FLAG_BIT = 0x40,
90 HIF_REG_CONFIG = 0x0e,
91
92 HIF_REG_CONFIG_CFG = 0x80,
93 HIF_REG_CONFIG_SPEED100 = 0x40,
94 HIF_REG_CONFIG_FULLDUPLEX_ENABLE = 0x20,
95 HIF_REG_CONFIG_RXENABLE = 0x10,
96 HIF_REG_CONFIG_TXENABLE = 0x08,
97 HIF_REG_CONFIG_SLEEPMODE = 0x04,
98 HIF_REG_CONFIG_ALLMULTICAST = 0x02,
99 HIF_REG_CONFIG_PROMISCUOUS = 0x01,
100 HIF_REG_ETHERNET_ADDR = 0x0f,
101 HIF_REG_FRAME_DROP_COUNTER = 0x15,
102 HIF_REG_PAUSE_THRESHOLD = 0x16,
103 HIF_REG_PAUSE_THRESHOLD_DEFAULT = 0,
104};
105
106
107enum {
108 MCS7830_RX_SHORT_FRAME = 0x01,
109 MCS7830_RX_LENGTH_ERROR = 0x02,
110 MCS7830_RX_ALIGNMENT_ERROR = 0x04,
111 MCS7830_RX_CRC_ERROR = 0x08,
112 MCS7830_RX_LARGE_FRAME = 0x10,
113 MCS7830_RX_FRAME_CORRECT = 0x20,
114
115};
116
117struct mcs7830_data {
118 u8 multi_filter[8];
119 u8 config;
120};
121
122static const char driver_name[] = "MOSCHIP usb-ethernet driver";
123
124static int mcs7830_get_reg(struct usbnet *dev, u16 index, u16 size, void *data)
125{
126 return usbnet_read_cmd(dev, MCS7830_RD_BREQ, MCS7830_RD_BMREQ,
127 0x0000, index, data, size);
128}
129
130static int mcs7830_set_reg(struct usbnet *dev, u16 index, u16 size, const void *data)
131{
132 return usbnet_write_cmd(dev, MCS7830_WR_BREQ, MCS7830_WR_BMREQ,
133 0x0000, index, data, size);
134}
135
136static void mcs7830_set_reg_async(struct usbnet *dev, u16 index, u16 size, void *data)
137{
138 usbnet_write_cmd_async(dev, MCS7830_WR_BREQ, MCS7830_WR_BMREQ,
139 0x0000, index, data, size);
140}
141
142static int mcs7830_hif_get_mac_address(struct usbnet *dev, unsigned char *addr)
143{
144 int ret = mcs7830_get_reg(dev, HIF_REG_ETHERNET_ADDR, ETH_ALEN, addr);
145 if (ret < 0)
146 return ret;
147 return 0;
148}
149
150static int mcs7830_hif_set_mac_address(struct usbnet *dev, unsigned char *addr)
151{
152 int ret = mcs7830_set_reg(dev, HIF_REG_ETHERNET_ADDR, ETH_ALEN, addr);
153
154 if (ret < 0)
155 return ret;
156 return 0;
157}
158
159static int mcs7830_set_mac_address(struct net_device *netdev, void *p)
160{
161 int ret;
162 struct usbnet *dev = netdev_priv(netdev);
163 struct sockaddr *addr = p;
164
165 if (netif_running(netdev))
166 return -EBUSY;
167
168 if (!is_valid_ether_addr(addr->sa_data))
169 return -EADDRNOTAVAIL;
170
171 ret = mcs7830_hif_set_mac_address(dev, addr->sa_data);
172
173 if (ret < 0)
174 return ret;
175
176
177 memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
178
179 return 0;
180}
181
182static int mcs7830_read_phy(struct usbnet *dev, u8 index)
183{
184 int ret;
185 int i;
186 __le16 val;
187
188 u8 cmd[2] = {
189 HIF_REG_PHY_CMD1_READ | HIF_REG_PHY_CMD1_PHYADDR,
190 HIF_REG_PHY_CMD2_PEND_FLAG_BIT | index,
191 };
192
193 mutex_lock(&dev->phy_mutex);
194
195 ret = mcs7830_set_reg(dev, HIF_REG_PHY_CMD1, 2, cmd);
196 if (ret < 0)
197 goto out;
198
199
200 for (i = 0; i < 10; i++) {
201 ret = mcs7830_get_reg(dev, HIF_REG_PHY_CMD1, 2, cmd);
202 if ((ret < 0) || (cmd[1] & HIF_REG_PHY_CMD2_READY_FLAG_BIT))
203 break;
204 ret = -EIO;
205 msleep(1);
206 }
207 if (ret < 0)
208 goto out;
209
210
211 ret = mcs7830_get_reg(dev, HIF_REG_PHY_DATA, 2, &val);
212 if (ret < 0)
213 goto out;
214 ret = le16_to_cpu(val);
215 dev_dbg(&dev->udev->dev, "read PHY reg %02x: %04x (%d tries)\n",
216 index, val, i);
217out:
218 mutex_unlock(&dev->phy_mutex);
219 return ret;
220}
221
222static int mcs7830_write_phy(struct usbnet *dev, u8 index, u16 val)
223{
224 int ret;
225 int i;
226 __le16 le_val;
227
228 u8 cmd[2] = {
229 HIF_REG_PHY_CMD1_WRITE | HIF_REG_PHY_CMD1_PHYADDR,
230 HIF_REG_PHY_CMD2_PEND_FLAG_BIT | (index & 0x1F),
231 };
232
233 mutex_lock(&dev->phy_mutex);
234
235
236 le_val = cpu_to_le16(val);
237 ret = mcs7830_set_reg(dev, HIF_REG_PHY_DATA, 2, &le_val);
238 if (ret < 0)
239 goto out;
240
241
242 ret = mcs7830_set_reg(dev, HIF_REG_PHY_CMD1, 2, cmd);
243 if (ret < 0)
244 goto out;
245
246
247 for (i = 0; i < 10; i++) {
248 ret = mcs7830_get_reg(dev, HIF_REG_PHY_CMD1, 2, cmd);
249 if ((ret < 0) || (cmd[1] & HIF_REG_PHY_CMD2_READY_FLAG_BIT))
250 break;
251 ret = -EIO;
252 msleep(1);
253 }
254 if (ret < 0)
255 goto out;
256
257 ret = 0;
258 dev_dbg(&dev->udev->dev, "write PHY reg %02x: %04x (%d tries)\n",
259 index, val, i);
260out:
261 mutex_unlock(&dev->phy_mutex);
262 return ret;
263}
264
265
266
267
268
269static int mcs7830_set_autoneg(struct usbnet *dev, int ptrUserPhyMode)
270{
271 int ret;
272
273 ret = mcs7830_write_phy(dev, MII_ADVERTISE, MCS7830_MII_ADVERTISE);
274
275
276 if (!ret)
277 ret = mcs7830_write_phy(dev, MII_BMCR, 0x0000);
278
279 if (!ret)
280 ret = mcs7830_write_phy(dev, MII_BMCR, BMCR_ANENABLE);
281
282 if (!ret)
283 ret = mcs7830_write_phy(dev, MII_BMCR,
284 BMCR_ANENABLE | BMCR_ANRESTART );
285 return ret;
286}
287
288
289
290
291
292static int mcs7830_get_rev(struct usbnet *dev)
293{
294 u8 dummy[2];
295 int ret;
296 ret = mcs7830_get_reg(dev, HIF_REG_FRAME_DROP_COUNTER, 2, dummy);
297 if (ret > 0)
298 return 2;
299 return 1;
300}
301
302
303
304
305static void mcs7830_rev_C_fixup(struct usbnet *dev)
306{
307 u8 pause_threshold = HIF_REG_PAUSE_THRESHOLD_DEFAULT;
308 int retry;
309
310 for (retry = 0; retry < 2; retry++) {
311 if (mcs7830_get_rev(dev) == 2) {
312 dev_info(&dev->udev->dev, "applying rev.C fixup\n");
313 mcs7830_set_reg(dev, HIF_REG_PAUSE_THRESHOLD,
314 1, &pause_threshold);
315 }
316 msleep(1);
317 }
318}
319
320static int mcs7830_mdio_read(struct net_device *netdev, int phy_id,
321 int location)
322{
323 struct usbnet *dev = netdev_priv(netdev);
324 return mcs7830_read_phy(dev, location);
325}
326
327static void mcs7830_mdio_write(struct net_device *netdev, int phy_id,
328 int location, int val)
329{
330 struct usbnet *dev = netdev_priv(netdev);
331 mcs7830_write_phy(dev, location, val);
332}
333
334static int mcs7830_ioctl(struct net_device *net, struct ifreq *rq, int cmd)
335{
336 struct usbnet *dev = netdev_priv(net);
337 return generic_mii_ioctl(&dev->mii, if_mii(rq), cmd, NULL);
338}
339
340static inline struct mcs7830_data *mcs7830_get_data(struct usbnet *dev)
341{
342 return (struct mcs7830_data *)&dev->data;
343}
344
345static void mcs7830_hif_update_multicast_hash(struct usbnet *dev)
346{
347 struct mcs7830_data *data = mcs7830_get_data(dev);
348 mcs7830_set_reg_async(dev, HIF_REG_MULTICAST_HASH,
349 sizeof data->multi_filter,
350 data->multi_filter);
351}
352
353static void mcs7830_hif_update_config(struct usbnet *dev)
354{
355
356
357 struct mcs7830_data *data = mcs7830_get_data(dev);
358 mcs7830_set_reg_async(dev, HIF_REG_CONFIG, 1, &data->config);
359}
360
361static void mcs7830_data_set_multicast(struct net_device *net)
362{
363 struct usbnet *dev = netdev_priv(net);
364 struct mcs7830_data *data = mcs7830_get_data(dev);
365
366 memset(data->multi_filter, 0, sizeof data->multi_filter);
367
368 data->config = HIF_REG_CONFIG_TXENABLE;
369
370
371 data->config |= HIF_REG_CONFIG_ALLMULTICAST;
372
373 if (net->flags & IFF_PROMISC) {
374 data->config |= HIF_REG_CONFIG_PROMISCUOUS;
375 } else if (net->flags & IFF_ALLMULTI ||
376 netdev_mc_count(net) > MCS7830_MAX_MCAST) {
377 data->config |= HIF_REG_CONFIG_ALLMULTICAST;
378 } else if (netdev_mc_empty(net)) {
379
380 } else {
381
382
383
384
385 struct netdev_hw_addr *ha;
386 u32 crc_bits;
387
388
389 netdev_for_each_mc_addr(ha, net) {
390 crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
391 data->multi_filter[crc_bits >> 3] |= 1 << (crc_bits & 7);
392 }
393 }
394}
395
396static int mcs7830_apply_base_config(struct usbnet *dev)
397{
398 int ret;
399
400
401 ret = mcs7830_hif_set_mac_address(dev, dev->net->dev_addr);
402 if (ret) {
403 dev_info(&dev->udev->dev, "Cannot set MAC address\n");
404 goto out;
405 }
406
407
408 ret = mcs7830_set_autoneg(dev, 0);
409 if (ret) {
410 dev_info(&dev->udev->dev, "Cannot set autoneg\n");
411 goto out;
412 }
413
414 mcs7830_hif_update_multicast_hash(dev);
415 mcs7830_hif_update_config(dev);
416
417 mcs7830_rev_C_fixup(dev);
418 ret = 0;
419out:
420 return ret;
421}
422
423
424static void mcs7830_set_multicast(struct net_device *net)
425{
426 struct usbnet *dev = netdev_priv(net);
427
428 mcs7830_data_set_multicast(net);
429
430 mcs7830_hif_update_multicast_hash(dev);
431 mcs7830_hif_update_config(dev);
432}
433
434static int mcs7830_get_regs_len(struct net_device *net)
435{
436 struct usbnet *dev = netdev_priv(net);
437
438 switch (mcs7830_get_rev(dev)) {
439 case 1:
440 return 21;
441 case 2:
442 return 32;
443 }
444 return 0;
445}
446
447static void mcs7830_get_drvinfo(struct net_device *net, struct ethtool_drvinfo *drvinfo)
448{
449 usbnet_get_drvinfo(net, drvinfo);
450 drvinfo->regdump_len = mcs7830_get_regs_len(net);
451}
452
453static void mcs7830_get_regs(struct net_device *net, struct ethtool_regs *regs, void *data)
454{
455 struct usbnet *dev = netdev_priv(net);
456
457 regs->version = mcs7830_get_rev(dev);
458 mcs7830_get_reg(dev, 0, regs->len, data);
459}
460
461static const struct ethtool_ops mcs7830_ethtool_ops = {
462 .get_drvinfo = mcs7830_get_drvinfo,
463 .get_regs_len = mcs7830_get_regs_len,
464 .get_regs = mcs7830_get_regs,
465
466
467 .get_link = usbnet_get_link,
468 .get_msglevel = usbnet_get_msglevel,
469 .set_msglevel = usbnet_set_msglevel,
470 .get_settings = usbnet_get_settings,
471 .set_settings = usbnet_set_settings,
472 .nway_reset = usbnet_nway_reset,
473};
474
475static const struct net_device_ops mcs7830_netdev_ops = {
476 .ndo_open = usbnet_open,
477 .ndo_stop = usbnet_stop,
478 .ndo_start_xmit = usbnet_start_xmit,
479 .ndo_tx_timeout = usbnet_tx_timeout,
480 .ndo_change_mtu = usbnet_change_mtu,
481 .ndo_validate_addr = eth_validate_addr,
482 .ndo_do_ioctl = mcs7830_ioctl,
483 .ndo_set_rx_mode = mcs7830_set_multicast,
484 .ndo_set_mac_address = mcs7830_set_mac_address,
485};
486
487static int mcs7830_bind(struct usbnet *dev, struct usb_interface *udev)
488{
489 struct net_device *net = dev->net;
490 int ret;
491 int retry;
492
493
494 ret = -EINVAL;
495 for (retry = 0; retry < 5 && ret; retry++)
496 ret = mcs7830_hif_get_mac_address(dev, net->dev_addr);
497 if (ret) {
498 dev_warn(&dev->udev->dev, "Cannot read MAC address\n");
499 goto out;
500 }
501
502 mcs7830_data_set_multicast(net);
503
504 ret = mcs7830_apply_base_config(dev);
505 if (ret)
506 goto out;
507
508 net->ethtool_ops = &mcs7830_ethtool_ops;
509 net->netdev_ops = &mcs7830_netdev_ops;
510
511
512 dev->rx_urb_size = ETH_FRAME_LEN + 1;
513
514 dev->mii.mdio_read = mcs7830_mdio_read;
515 dev->mii.mdio_write = mcs7830_mdio_write;
516 dev->mii.dev = net;
517 dev->mii.phy_id_mask = 0x3f;
518 dev->mii.reg_num_mask = 0x1f;
519 dev->mii.phy_id = *((u8 *) net->dev_addr + 1);
520
521 ret = usbnet_get_endpoints(dev, udev);
522out:
523 return ret;
524}
525
526
527static int mcs7830_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
528{
529 u8 status;
530
531 if (skb->len == 0) {
532 dev_err(&dev->udev->dev, "unexpected empty rx frame\n");
533 return 0;
534 }
535
536 skb_trim(skb, skb->len - 1);
537 status = skb->data[skb->len];
538
539 if (status != MCS7830_RX_FRAME_CORRECT) {
540 dev_dbg(&dev->udev->dev, "rx fixup status %x\n", status);
541
542
543
544 dev->net->stats.rx_errors++;
545
546 if (status & (MCS7830_RX_SHORT_FRAME
547 |MCS7830_RX_LENGTH_ERROR
548 |MCS7830_RX_LARGE_FRAME))
549 dev->net->stats.rx_length_errors++;
550 if (status & MCS7830_RX_ALIGNMENT_ERROR)
551 dev->net->stats.rx_frame_errors++;
552 if (status & MCS7830_RX_CRC_ERROR)
553 dev->net->stats.rx_crc_errors++;
554 }
555
556 return skb->len > 0;
557}
558
559static void mcs7830_status(struct usbnet *dev, struct urb *urb)
560{
561 u8 *buf = urb->transfer_buffer;
562 bool link, link_changed;
563
564 if (urb->actual_length < 16)
565 return;
566
567 link = !(buf[1] == 0x20);
568 link_changed = netif_carrier_ok(dev->net) != link;
569 if (link_changed) {
570 usbnet_link_change(dev, link, 0);
571 netdev_dbg(dev->net, "Link Status is: %d\n", link);
572 }
573}
574
575static const struct driver_info moschip_info = {
576 .description = "MOSCHIP 7830/7832/7730 usb-NET adapter",
577 .bind = mcs7830_bind,
578 .rx_fixup = mcs7830_rx_fixup,
579 .flags = FLAG_ETHER | FLAG_LINK_INTR,
580 .status = mcs7830_status,
581 .in = 1,
582 .out = 2,
583};
584
585static const struct driver_info sitecom_info = {
586 .description = "Sitecom LN-30 usb-NET adapter",
587 .bind = mcs7830_bind,
588 .rx_fixup = mcs7830_rx_fixup,
589 .flags = FLAG_ETHER | FLAG_LINK_INTR,
590 .status = mcs7830_status,
591 .in = 1,
592 .out = 2,
593};
594
595static const struct usb_device_id products[] = {
596 {
597 USB_DEVICE(MCS7830_VENDOR_ID, MCS7832_PRODUCT_ID),
598 .driver_info = (unsigned long) &moschip_info,
599 },
600 {
601 USB_DEVICE(MCS7830_VENDOR_ID, MCS7830_PRODUCT_ID),
602 .driver_info = (unsigned long) &moschip_info,
603 },
604 {
605 USB_DEVICE(MCS7830_VENDOR_ID, MCS7730_PRODUCT_ID),
606 .driver_info = (unsigned long) &moschip_info,
607 },
608 {
609 USB_DEVICE(SITECOM_VENDOR_ID, LN_030_PRODUCT_ID),
610 .driver_info = (unsigned long) &sitecom_info,
611 },
612 {},
613};
614MODULE_DEVICE_TABLE(usb, products);
615
616static int mcs7830_reset_resume (struct usb_interface *intf)
617{
618
619
620
621 struct usbnet *dev = usb_get_intfdata(intf);
622
623 mcs7830_apply_base_config(dev);
624
625 usbnet_resume(intf);
626
627 return 0;
628}
629
630static struct usb_driver mcs7830_driver = {
631 .name = driver_name,
632 .id_table = products,
633 .probe = usbnet_probe,
634 .disconnect = usbnet_disconnect,
635 .suspend = usbnet_suspend,
636 .resume = usbnet_resume,
637 .reset_resume = mcs7830_reset_resume,
638 .disable_hub_initiated_lpm = 1,
639};
640
641module_usb_driver(mcs7830_driver);
642
643MODULE_DESCRIPTION("USB to network adapter MCS7830)");
644MODULE_LICENSE("GPL");
645