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