Loading...
1 /***************************************************************************
2 *
3 * Copyright (C) 2007-2008 SMSC
4 *
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License
7 * as published by the Free Software Foundation; either version 2
8 * of the License, or (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
18 *
19 *****************************************************************************/
20
21#include <linux/module.h>
22#include <linux/kmod.h>
23#include <linux/init.h>
24#include <linux/netdevice.h>
25#include <linux/etherdevice.h>
26#include <linux/ethtool.h>
27#include <linux/mii.h>
28#include <linux/usb.h>
29#include <linux/crc32.h>
30#include <linux/usb/usbnet.h>
31#include <linux/slab.h>
32#include "smsc95xx.h"
33
34#define SMSC_CHIPNAME "smsc95xx"
35#define SMSC_DRIVER_VERSION "1.0.4"
36#define HS_USB_PKT_SIZE (512)
37#define FS_USB_PKT_SIZE (64)
38#define DEFAULT_HS_BURST_CAP_SIZE (16 * 1024 + 5 * HS_USB_PKT_SIZE)
39#define DEFAULT_FS_BURST_CAP_SIZE (6 * 1024 + 33 * FS_USB_PKT_SIZE)
40#define DEFAULT_BULK_IN_DELAY (0x00002000)
41#define MAX_SINGLE_PACKET_SIZE (2048)
42#define LAN95XX_EEPROM_MAGIC (0x9500)
43#define EEPROM_MAC_OFFSET (0x01)
44#define DEFAULT_TX_CSUM_ENABLE (true)
45#define DEFAULT_RX_CSUM_ENABLE (true)
46#define SMSC95XX_INTERNAL_PHY_ID (1)
47#define SMSC95XX_TX_OVERHEAD (8)
48#define SMSC95XX_TX_OVERHEAD_CSUM (12)
49
50struct smsc95xx_priv {
51 u32 mac_cr;
52 u32 hash_hi;
53 u32 hash_lo;
54 spinlock_t mac_cr_lock;
55};
56
57struct usb_context {
58 struct usb_ctrlrequest req;
59 struct usbnet *dev;
60};
61
62static int turbo_mode = true;
63module_param(turbo_mode, bool, 0644);
64MODULE_PARM_DESC(turbo_mode, "Enable multiple frames per Rx transaction");
65
66static int smsc95xx_read_reg(struct usbnet *dev, u32 index, u32 *data)
67{
68 u32 *buf = kmalloc(4, GFP_KERNEL);
69 int ret;
70
71 BUG_ON(!dev);
72
73 if (!buf)
74 return -ENOMEM;
75
76 ret = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0),
77 USB_VENDOR_REQUEST_READ_REGISTER,
78 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
79 00, index, buf, 4, USB_CTRL_GET_TIMEOUT);
80
81 if (unlikely(ret < 0))
82 netdev_warn(dev->net, "Failed to read register index 0x%08x\n", index);
83
84 le32_to_cpus(buf);
85 *data = *buf;
86 kfree(buf);
87
88 return ret;
89}
90
91static int smsc95xx_write_reg(struct usbnet *dev, u32 index, u32 data)
92{
93 u32 *buf = kmalloc(4, GFP_KERNEL);
94 int ret;
95
96 BUG_ON(!dev);
97
98 if (!buf)
99 return -ENOMEM;
100
101 *buf = data;
102 cpu_to_le32s(buf);
103
104 ret = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0),
105 USB_VENDOR_REQUEST_WRITE_REGISTER,
106 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
107 00, index, buf, 4, USB_CTRL_SET_TIMEOUT);
108
109 if (unlikely(ret < 0))
110 netdev_warn(dev->net, "Failed to write register index 0x%08x\n", index);
111
112 kfree(buf);
113
114 return ret;
115}
116
117/* Loop until the read is completed with timeout
118 * called with phy_mutex held */
119static int smsc95xx_phy_wait_not_busy(struct usbnet *dev)
120{
121 unsigned long start_time = jiffies;
122 u32 val;
123
124 do {
125 smsc95xx_read_reg(dev, MII_ADDR, &val);
126 if (!(val & MII_BUSY_))
127 return 0;
128 } while (!time_after(jiffies, start_time + HZ));
129
130 return -EIO;
131}
132
133static int smsc95xx_mdio_read(struct net_device *netdev, int phy_id, int idx)
134{
135 struct usbnet *dev = netdev_priv(netdev);
136 u32 val, addr;
137
138 mutex_lock(&dev->phy_mutex);
139
140 /* confirm MII not busy */
141 if (smsc95xx_phy_wait_not_busy(dev)) {
142 netdev_warn(dev->net, "MII is busy in smsc95xx_mdio_read\n");
143 mutex_unlock(&dev->phy_mutex);
144 return -EIO;
145 }
146
147 /* set the address, index & direction (read from PHY) */
148 phy_id &= dev->mii.phy_id_mask;
149 idx &= dev->mii.reg_num_mask;
150 addr = (phy_id << 11) | (idx << 6) | MII_READ_;
151 smsc95xx_write_reg(dev, MII_ADDR, addr);
152
153 if (smsc95xx_phy_wait_not_busy(dev)) {
154 netdev_warn(dev->net, "Timed out reading MII reg %02X\n", idx);
155 mutex_unlock(&dev->phy_mutex);
156 return -EIO;
157 }
158
159 smsc95xx_read_reg(dev, MII_DATA, &val);
160
161 mutex_unlock(&dev->phy_mutex);
162
163 return (u16)(val & 0xFFFF);
164}
165
166static void smsc95xx_mdio_write(struct net_device *netdev, int phy_id, int idx,
167 int regval)
168{
169 struct usbnet *dev = netdev_priv(netdev);
170 u32 val, addr;
171
172 mutex_lock(&dev->phy_mutex);
173
174 /* confirm MII not busy */
175 if (smsc95xx_phy_wait_not_busy(dev)) {
176 netdev_warn(dev->net, "MII is busy in smsc95xx_mdio_write\n");
177 mutex_unlock(&dev->phy_mutex);
178 return;
179 }
180
181 val = regval;
182 smsc95xx_write_reg(dev, MII_DATA, val);
183
184 /* set the address, index & direction (write to PHY) */
185 phy_id &= dev->mii.phy_id_mask;
186 idx &= dev->mii.reg_num_mask;
187 addr = (phy_id << 11) | (idx << 6) | MII_WRITE_;
188 smsc95xx_write_reg(dev, MII_ADDR, addr);
189
190 if (smsc95xx_phy_wait_not_busy(dev))
191 netdev_warn(dev->net, "Timed out writing MII reg %02X\n", idx);
192
193 mutex_unlock(&dev->phy_mutex);
194}
195
196static int smsc95xx_wait_eeprom(struct usbnet *dev)
197{
198 unsigned long start_time = jiffies;
199 u32 val;
200
201 do {
202 smsc95xx_read_reg(dev, E2P_CMD, &val);
203 if (!(val & E2P_CMD_BUSY_) || (val & E2P_CMD_TIMEOUT_))
204 break;
205 udelay(40);
206 } while (!time_after(jiffies, start_time + HZ));
207
208 if (val & (E2P_CMD_TIMEOUT_ | E2P_CMD_BUSY_)) {
209 netdev_warn(dev->net, "EEPROM read operation timeout\n");
210 return -EIO;
211 }
212
213 return 0;
214}
215
216static int smsc95xx_eeprom_confirm_not_busy(struct usbnet *dev)
217{
218 unsigned long start_time = jiffies;
219 u32 val;
220
221 do {
222 smsc95xx_read_reg(dev, E2P_CMD, &val);
223
224 if (!(val & E2P_CMD_BUSY_))
225 return 0;
226
227 udelay(40);
228 } while (!time_after(jiffies, start_time + HZ));
229
230 netdev_warn(dev->net, "EEPROM is busy\n");
231 return -EIO;
232}
233
234static int smsc95xx_read_eeprom(struct usbnet *dev, u32 offset, u32 length,
235 u8 *data)
236{
237 u32 val;
238 int i, ret;
239
240 BUG_ON(!dev);
241 BUG_ON(!data);
242
243 ret = smsc95xx_eeprom_confirm_not_busy(dev);
244 if (ret)
245 return ret;
246
247 for (i = 0; i < length; i++) {
248 val = E2P_CMD_BUSY_ | E2P_CMD_READ_ | (offset & E2P_CMD_ADDR_);
249 smsc95xx_write_reg(dev, E2P_CMD, val);
250
251 ret = smsc95xx_wait_eeprom(dev);
252 if (ret < 0)
253 return ret;
254
255 smsc95xx_read_reg(dev, E2P_DATA, &val);
256
257 data[i] = val & 0xFF;
258 offset++;
259 }
260
261 return 0;
262}
263
264static int smsc95xx_write_eeprom(struct usbnet *dev, u32 offset, u32 length,
265 u8 *data)
266{
267 u32 val;
268 int i, ret;
269
270 BUG_ON(!dev);
271 BUG_ON(!data);
272
273 ret = smsc95xx_eeprom_confirm_not_busy(dev);
274 if (ret)
275 return ret;
276
277 /* Issue write/erase enable command */
278 val = E2P_CMD_BUSY_ | E2P_CMD_EWEN_;
279 smsc95xx_write_reg(dev, E2P_CMD, val);
280
281 ret = smsc95xx_wait_eeprom(dev);
282 if (ret < 0)
283 return ret;
284
285 for (i = 0; i < length; i++) {
286
287 /* Fill data register */
288 val = data[i];
289 smsc95xx_write_reg(dev, E2P_DATA, val);
290
291 /* Send "write" command */
292 val = E2P_CMD_BUSY_ | E2P_CMD_WRITE_ | (offset & E2P_CMD_ADDR_);
293 smsc95xx_write_reg(dev, E2P_CMD, val);
294
295 ret = smsc95xx_wait_eeprom(dev);
296 if (ret < 0)
297 return ret;
298
299 offset++;
300 }
301
302 return 0;
303}
304
305static void smsc95xx_async_cmd_callback(struct urb *urb)
306{
307 struct usb_context *usb_context = urb->context;
308 struct usbnet *dev = usb_context->dev;
309 int status = urb->status;
310
311 if (status < 0)
312 netdev_warn(dev->net, "async callback failed with %d\n", status);
313
314 kfree(usb_context);
315 usb_free_urb(urb);
316}
317
318static int smsc95xx_write_reg_async(struct usbnet *dev, u16 index, u32 *data)
319{
320 struct usb_context *usb_context;
321 int status;
322 struct urb *urb;
323 const u16 size = 4;
324
325 urb = usb_alloc_urb(0, GFP_ATOMIC);
326 if (!urb) {
327 netdev_warn(dev->net, "Error allocating URB\n");
328 return -ENOMEM;
329 }
330
331 usb_context = kmalloc(sizeof(struct usb_context), GFP_ATOMIC);
332 if (usb_context == NULL) {
333 netdev_warn(dev->net, "Error allocating control msg\n");
334 usb_free_urb(urb);
335 return -ENOMEM;
336 }
337
338 usb_context->req.bRequestType =
339 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE;
340 usb_context->req.bRequest = USB_VENDOR_REQUEST_WRITE_REGISTER;
341 usb_context->req.wValue = 00;
342 usb_context->req.wIndex = cpu_to_le16(index);
343 usb_context->req.wLength = cpu_to_le16(size);
344
345 usb_fill_control_urb(urb, dev->udev, usb_sndctrlpipe(dev->udev, 0),
346 (void *)&usb_context->req, data, size,
347 smsc95xx_async_cmd_callback,
348 (void *)usb_context);
349
350 status = usb_submit_urb(urb, GFP_ATOMIC);
351 if (status < 0) {
352 netdev_warn(dev->net, "Error submitting control msg, sts=%d\n",
353 status);
354 kfree(usb_context);
355 usb_free_urb(urb);
356 }
357
358 return status;
359}
360
361/* returns hash bit number for given MAC address
362 * example:
363 * 01 00 5E 00 00 01 -> returns bit number 31 */
364static unsigned int smsc95xx_hash(char addr[ETH_ALEN])
365{
366 return (ether_crc(ETH_ALEN, addr) >> 26) & 0x3f;
367}
368
369static void smsc95xx_set_multicast(struct net_device *netdev)
370{
371 struct usbnet *dev = netdev_priv(netdev);
372 struct smsc95xx_priv *pdata = (struct smsc95xx_priv *)(dev->data[0]);
373 unsigned long flags;
374
375 pdata->hash_hi = 0;
376 pdata->hash_lo = 0;
377
378 spin_lock_irqsave(&pdata->mac_cr_lock, flags);
379
380 if (dev->net->flags & IFF_PROMISC) {
381 netif_dbg(dev, drv, dev->net, "promiscuous mode enabled\n");
382 pdata->mac_cr |= MAC_CR_PRMS_;
383 pdata->mac_cr &= ~(MAC_CR_MCPAS_ | MAC_CR_HPFILT_);
384 } else if (dev->net->flags & IFF_ALLMULTI) {
385 netif_dbg(dev, drv, dev->net, "receive all multicast enabled\n");
386 pdata->mac_cr |= MAC_CR_MCPAS_;
387 pdata->mac_cr &= ~(MAC_CR_PRMS_ | MAC_CR_HPFILT_);
388 } else if (!netdev_mc_empty(dev->net)) {
389 struct netdev_hw_addr *ha;
390
391 pdata->mac_cr |= MAC_CR_HPFILT_;
392 pdata->mac_cr &= ~(MAC_CR_PRMS_ | MAC_CR_MCPAS_);
393
394 netdev_for_each_mc_addr(ha, netdev) {
395 u32 bitnum = smsc95xx_hash(ha->addr);
396 u32 mask = 0x01 << (bitnum & 0x1F);
397 if (bitnum & 0x20)
398 pdata->hash_hi |= mask;
399 else
400 pdata->hash_lo |= mask;
401 }
402
403 netif_dbg(dev, drv, dev->net, "HASHH=0x%08X, HASHL=0x%08X\n",
404 pdata->hash_hi, pdata->hash_lo);
405 } else {
406 netif_dbg(dev, drv, dev->net, "receive own packets only\n");
407 pdata->mac_cr &=
408 ~(MAC_CR_PRMS_ | MAC_CR_MCPAS_ | MAC_CR_HPFILT_);
409 }
410
411 spin_unlock_irqrestore(&pdata->mac_cr_lock, flags);
412
413 /* Initiate async writes, as we can't wait for completion here */
414 smsc95xx_write_reg_async(dev, HASHH, &pdata->hash_hi);
415 smsc95xx_write_reg_async(dev, HASHL, &pdata->hash_lo);
416 smsc95xx_write_reg_async(dev, MAC_CR, &pdata->mac_cr);
417}
418
419static void smsc95xx_phy_update_flowcontrol(struct usbnet *dev, u8 duplex,
420 u16 lcladv, u16 rmtadv)
421{
422 u32 flow, afc_cfg = 0;
423
424 int ret = smsc95xx_read_reg(dev, AFC_CFG, &afc_cfg);
425 if (ret < 0) {
426 netdev_warn(dev->net, "error reading AFC_CFG\n");
427 return;
428 }
429
430 if (duplex == DUPLEX_FULL) {
431 u8 cap = mii_resolve_flowctrl_fdx(lcladv, rmtadv);
432
433 if (cap & FLOW_CTRL_RX)
434 flow = 0xFFFF0002;
435 else
436 flow = 0;
437
438 if (cap & FLOW_CTRL_TX)
439 afc_cfg |= 0xF;
440 else
441 afc_cfg &= ~0xF;
442
443 netif_dbg(dev, link, dev->net, "rx pause %s, tx pause %s\n",
444 cap & FLOW_CTRL_RX ? "enabled" : "disabled",
445 cap & FLOW_CTRL_TX ? "enabled" : "disabled");
446 } else {
447 netif_dbg(dev, link, dev->net, "half duplex\n");
448 flow = 0;
449 afc_cfg |= 0xF;
450 }
451
452 smsc95xx_write_reg(dev, FLOW, flow);
453 smsc95xx_write_reg(dev, AFC_CFG, afc_cfg);
454}
455
456static int smsc95xx_link_reset(struct usbnet *dev)
457{
458 struct smsc95xx_priv *pdata = (struct smsc95xx_priv *)(dev->data[0]);
459 struct mii_if_info *mii = &dev->mii;
460 struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
461 unsigned long flags;
462 u16 lcladv, rmtadv;
463 u32 intdata;
464
465 /* clear interrupt status */
466 smsc95xx_mdio_read(dev->net, mii->phy_id, PHY_INT_SRC);
467 intdata = 0xFFFFFFFF;
468 smsc95xx_write_reg(dev, INT_STS, intdata);
469
470 mii_check_media(mii, 1, 1);
471 mii_ethtool_gset(&dev->mii, &ecmd);
472 lcladv = smsc95xx_mdio_read(dev->net, mii->phy_id, MII_ADVERTISE);
473 rmtadv = smsc95xx_mdio_read(dev->net, mii->phy_id, MII_LPA);
474
475 netif_dbg(dev, link, dev->net,
476 "speed: %u duplex: %d lcladv: %04x rmtadv: %04x\n",
477 ethtool_cmd_speed(&ecmd), ecmd.duplex, lcladv, rmtadv);
478
479 spin_lock_irqsave(&pdata->mac_cr_lock, flags);
480 if (ecmd.duplex != DUPLEX_FULL) {
481 pdata->mac_cr &= ~MAC_CR_FDPX_;
482 pdata->mac_cr |= MAC_CR_RCVOWN_;
483 } else {
484 pdata->mac_cr &= ~MAC_CR_RCVOWN_;
485 pdata->mac_cr |= MAC_CR_FDPX_;
486 }
487 spin_unlock_irqrestore(&pdata->mac_cr_lock, flags);
488
489 smsc95xx_write_reg(dev, MAC_CR, pdata->mac_cr);
490
491 smsc95xx_phy_update_flowcontrol(dev, ecmd.duplex, lcladv, rmtadv);
492
493 return 0;
494}
495
496static void smsc95xx_status(struct usbnet *dev, struct urb *urb)
497{
498 u32 intdata;
499
500 if (urb->actual_length != 4) {
501 netdev_warn(dev->net, "unexpected urb length %d\n",
502 urb->actual_length);
503 return;
504 }
505
506 memcpy(&intdata, urb->transfer_buffer, 4);
507 le32_to_cpus(&intdata);
508
509 netif_dbg(dev, link, dev->net, "intdata: 0x%08X\n", intdata);
510
511 if (intdata & INT_ENP_PHY_INT_)
512 usbnet_defer_kevent(dev, EVENT_LINK_RESET);
513 else
514 netdev_warn(dev->net, "unexpected interrupt, intdata=0x%08X\n",
515 intdata);
516}
517
518/* Enable or disable Tx & Rx checksum offload engines */
519static int smsc95xx_set_features(struct net_device *netdev, u32 features)
520{
521 struct usbnet *dev = netdev_priv(netdev);
522 u32 read_buf;
523 int ret;
524
525 ret = smsc95xx_read_reg(dev, COE_CR, &read_buf);
526 if (ret < 0) {
527 netdev_warn(dev->net, "Failed to read COE_CR: %d\n", ret);
528 return ret;
529 }
530
531 if (features & NETIF_F_HW_CSUM)
532 read_buf |= Tx_COE_EN_;
533 else
534 read_buf &= ~Tx_COE_EN_;
535
536 if (features & NETIF_F_RXCSUM)
537 read_buf |= Rx_COE_EN_;
538 else
539 read_buf &= ~Rx_COE_EN_;
540
541 ret = smsc95xx_write_reg(dev, COE_CR, read_buf);
542 if (ret < 0) {
543 netdev_warn(dev->net, "Failed to write COE_CR: %d\n", ret);
544 return ret;
545 }
546
547 netif_dbg(dev, hw, dev->net, "COE_CR = 0x%08x\n", read_buf);
548 return 0;
549}
550
551static int smsc95xx_ethtool_get_eeprom_len(struct net_device *net)
552{
553 return MAX_EEPROM_SIZE;
554}
555
556static int smsc95xx_ethtool_get_eeprom(struct net_device *netdev,
557 struct ethtool_eeprom *ee, u8 *data)
558{
559 struct usbnet *dev = netdev_priv(netdev);
560
561 ee->magic = LAN95XX_EEPROM_MAGIC;
562
563 return smsc95xx_read_eeprom(dev, ee->offset, ee->len, data);
564}
565
566static int smsc95xx_ethtool_set_eeprom(struct net_device *netdev,
567 struct ethtool_eeprom *ee, u8 *data)
568{
569 struct usbnet *dev = netdev_priv(netdev);
570
571 if (ee->magic != LAN95XX_EEPROM_MAGIC) {
572 netdev_warn(dev->net, "EEPROM: magic value mismatch, magic = 0x%x\n",
573 ee->magic);
574 return -EINVAL;
575 }
576
577 return smsc95xx_write_eeprom(dev, ee->offset, ee->len, data);
578}
579
580static const struct ethtool_ops smsc95xx_ethtool_ops = {
581 .get_link = usbnet_get_link,
582 .nway_reset = usbnet_nway_reset,
583 .get_drvinfo = usbnet_get_drvinfo,
584 .get_msglevel = usbnet_get_msglevel,
585 .set_msglevel = usbnet_set_msglevel,
586 .get_settings = usbnet_get_settings,
587 .set_settings = usbnet_set_settings,
588 .get_eeprom_len = smsc95xx_ethtool_get_eeprom_len,
589 .get_eeprom = smsc95xx_ethtool_get_eeprom,
590 .set_eeprom = smsc95xx_ethtool_set_eeprom,
591};
592
593static int smsc95xx_ioctl(struct net_device *netdev, struct ifreq *rq, int cmd)
594{
595 struct usbnet *dev = netdev_priv(netdev);
596
597 if (!netif_running(netdev))
598 return -EINVAL;
599
600 return generic_mii_ioctl(&dev->mii, if_mii(rq), cmd, NULL);
601}
602
603static void smsc95xx_init_mac_address(struct usbnet *dev)
604{
605 /* try reading mac address from EEPROM */
606 if (smsc95xx_read_eeprom(dev, EEPROM_MAC_OFFSET, ETH_ALEN,
607 dev->net->dev_addr) == 0) {
608 if (is_valid_ether_addr(dev->net->dev_addr)) {
609 /* eeprom values are valid so use them */
610 netif_dbg(dev, ifup, dev->net, "MAC address read from EEPROM\n");
611 return;
612 }
613 }
614
615 /* no eeprom, or eeprom values are invalid. generate random MAC */
616 random_ether_addr(dev->net->dev_addr);
617 netif_dbg(dev, ifup, dev->net, "MAC address set to random_ether_addr\n");
618}
619
620static int smsc95xx_set_mac_address(struct usbnet *dev)
621{
622 u32 addr_lo = dev->net->dev_addr[0] | dev->net->dev_addr[1] << 8 |
623 dev->net->dev_addr[2] << 16 | dev->net->dev_addr[3] << 24;
624 u32 addr_hi = dev->net->dev_addr[4] | dev->net->dev_addr[5] << 8;
625 int ret;
626
627 ret = smsc95xx_write_reg(dev, ADDRL, addr_lo);
628 if (ret < 0) {
629 netdev_warn(dev->net, "Failed to write ADDRL: %d\n", ret);
630 return ret;
631 }
632
633 ret = smsc95xx_write_reg(dev, ADDRH, addr_hi);
634 if (ret < 0) {
635 netdev_warn(dev->net, "Failed to write ADDRH: %d\n", ret);
636 return ret;
637 }
638
639 return 0;
640}
641
642/* starts the TX path */
643static void smsc95xx_start_tx_path(struct usbnet *dev)
644{
645 struct smsc95xx_priv *pdata = (struct smsc95xx_priv *)(dev->data[0]);
646 unsigned long flags;
647 u32 reg_val;
648
649 /* Enable Tx at MAC */
650 spin_lock_irqsave(&pdata->mac_cr_lock, flags);
651 pdata->mac_cr |= MAC_CR_TXEN_;
652 spin_unlock_irqrestore(&pdata->mac_cr_lock, flags);
653
654 smsc95xx_write_reg(dev, MAC_CR, pdata->mac_cr);
655
656 /* Enable Tx at SCSRs */
657 reg_val = TX_CFG_ON_;
658 smsc95xx_write_reg(dev, TX_CFG, reg_val);
659}
660
661/* Starts the Receive path */
662static void smsc95xx_start_rx_path(struct usbnet *dev)
663{
664 struct smsc95xx_priv *pdata = (struct smsc95xx_priv *)(dev->data[0]);
665 unsigned long flags;
666
667 spin_lock_irqsave(&pdata->mac_cr_lock, flags);
668 pdata->mac_cr |= MAC_CR_RXEN_;
669 spin_unlock_irqrestore(&pdata->mac_cr_lock, flags);
670
671 smsc95xx_write_reg(dev, MAC_CR, pdata->mac_cr);
672}
673
674static int smsc95xx_phy_initialize(struct usbnet *dev)
675{
676 int bmcr, timeout = 0;
677
678 /* Initialize MII structure */
679 dev->mii.dev = dev->net;
680 dev->mii.mdio_read = smsc95xx_mdio_read;
681 dev->mii.mdio_write = smsc95xx_mdio_write;
682 dev->mii.phy_id_mask = 0x1f;
683 dev->mii.reg_num_mask = 0x1f;
684 dev->mii.phy_id = SMSC95XX_INTERNAL_PHY_ID;
685
686 /* reset phy and wait for reset to complete */
687 smsc95xx_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET);
688
689 do {
690 msleep(10);
691 bmcr = smsc95xx_mdio_read(dev->net, dev->mii.phy_id, MII_BMCR);
692 timeout++;
693 } while ((bmcr & BMCR_RESET) && (timeout < 100));
694
695 if (timeout >= 100) {
696 netdev_warn(dev->net, "timeout on PHY Reset");
697 return -EIO;
698 }
699
700 smsc95xx_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
701 ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP |
702 ADVERTISE_PAUSE_ASYM);
703
704 /* read to clear */
705 smsc95xx_mdio_read(dev->net, dev->mii.phy_id, PHY_INT_SRC);
706
707 smsc95xx_mdio_write(dev->net, dev->mii.phy_id, PHY_INT_MASK,
708 PHY_INT_MASK_DEFAULT_);
709 mii_nway_restart(&dev->mii);
710
711 netif_dbg(dev, ifup, dev->net, "phy initialised successfully\n");
712 return 0;
713}
714
715static int smsc95xx_reset(struct usbnet *dev)
716{
717 struct smsc95xx_priv *pdata = (struct smsc95xx_priv *)(dev->data[0]);
718 u32 read_buf, write_buf, burst_cap;
719 int ret = 0, timeout;
720
721 netif_dbg(dev, ifup, dev->net, "entering smsc95xx_reset\n");
722
723 write_buf = HW_CFG_LRST_;
724 ret = smsc95xx_write_reg(dev, HW_CFG, write_buf);
725 if (ret < 0) {
726 netdev_warn(dev->net, "Failed to write HW_CFG_LRST_ bit in HW_CFG register, ret = %d\n",
727 ret);
728 return ret;
729 }
730
731 timeout = 0;
732 do {
733 ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
734 if (ret < 0) {
735 netdev_warn(dev->net, "Failed to read HW_CFG: %d\n", ret);
736 return ret;
737 }
738 msleep(10);
739 timeout++;
740 } while ((read_buf & HW_CFG_LRST_) && (timeout < 100));
741
742 if (timeout >= 100) {
743 netdev_warn(dev->net, "timeout waiting for completion of Lite Reset\n");
744 return ret;
745 }
746
747 write_buf = PM_CTL_PHY_RST_;
748 ret = smsc95xx_write_reg(dev, PM_CTRL, write_buf);
749 if (ret < 0) {
750 netdev_warn(dev->net, "Failed to write PM_CTRL: %d\n", ret);
751 return ret;
752 }
753
754 timeout = 0;
755 do {
756 ret = smsc95xx_read_reg(dev, PM_CTRL, &read_buf);
757 if (ret < 0) {
758 netdev_warn(dev->net, "Failed to read PM_CTRL: %d\n", ret);
759 return ret;
760 }
761 msleep(10);
762 timeout++;
763 } while ((read_buf & PM_CTL_PHY_RST_) && (timeout < 100));
764
765 if (timeout >= 100) {
766 netdev_warn(dev->net, "timeout waiting for PHY Reset\n");
767 return ret;
768 }
769
770 ret = smsc95xx_set_mac_address(dev);
771 if (ret < 0)
772 return ret;
773
774 netif_dbg(dev, ifup, dev->net,
775 "MAC Address: %pM\n", dev->net->dev_addr);
776
777 ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
778 if (ret < 0) {
779 netdev_warn(dev->net, "Failed to read HW_CFG: %d\n", ret);
780 return ret;
781 }
782
783 netif_dbg(dev, ifup, dev->net,
784 "Read Value from HW_CFG : 0x%08x\n", read_buf);
785
786 read_buf |= HW_CFG_BIR_;
787
788 ret = smsc95xx_write_reg(dev, HW_CFG, read_buf);
789 if (ret < 0) {
790 netdev_warn(dev->net, "Failed to write HW_CFG_BIR_ bit in HW_CFG register, ret = %d\n",
791 ret);
792 return ret;
793 }
794
795 ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
796 if (ret < 0) {
797 netdev_warn(dev->net, "Failed to read HW_CFG: %d\n", ret);
798 return ret;
799 }
800 netif_dbg(dev, ifup, dev->net,
801 "Read Value from HW_CFG after writing HW_CFG_BIR_: 0x%08x\n",
802 read_buf);
803
804 if (!turbo_mode) {
805 burst_cap = 0;
806 dev->rx_urb_size = MAX_SINGLE_PACKET_SIZE;
807 } else if (dev->udev->speed == USB_SPEED_HIGH) {
808 burst_cap = DEFAULT_HS_BURST_CAP_SIZE / HS_USB_PKT_SIZE;
809 dev->rx_urb_size = DEFAULT_HS_BURST_CAP_SIZE;
810 } else {
811 burst_cap = DEFAULT_FS_BURST_CAP_SIZE / FS_USB_PKT_SIZE;
812 dev->rx_urb_size = DEFAULT_FS_BURST_CAP_SIZE;
813 }
814
815 netif_dbg(dev, ifup, dev->net,
816 "rx_urb_size=%ld\n", (ulong)dev->rx_urb_size);
817
818 ret = smsc95xx_write_reg(dev, BURST_CAP, burst_cap);
819 if (ret < 0) {
820 netdev_warn(dev->net, "Failed to write BURST_CAP: %d\n", ret);
821 return ret;
822 }
823
824 ret = smsc95xx_read_reg(dev, BURST_CAP, &read_buf);
825 if (ret < 0) {
826 netdev_warn(dev->net, "Failed to read BURST_CAP: %d\n", ret);
827 return ret;
828 }
829 netif_dbg(dev, ifup, dev->net,
830 "Read Value from BURST_CAP after writing: 0x%08x\n",
831 read_buf);
832
833 read_buf = DEFAULT_BULK_IN_DELAY;
834 ret = smsc95xx_write_reg(dev, BULK_IN_DLY, read_buf);
835 if (ret < 0) {
836 netdev_warn(dev->net, "ret = %d\n", ret);
837 return ret;
838 }
839
840 ret = smsc95xx_read_reg(dev, BULK_IN_DLY, &read_buf);
841 if (ret < 0) {
842 netdev_warn(dev->net, "Failed to read BULK_IN_DLY: %d\n", ret);
843 return ret;
844 }
845 netif_dbg(dev, ifup, dev->net,
846 "Read Value from BULK_IN_DLY after writing: 0x%08x\n",
847 read_buf);
848
849 ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
850 if (ret < 0) {
851 netdev_warn(dev->net, "Failed to read HW_CFG: %d\n", ret);
852 return ret;
853 }
854 netif_dbg(dev, ifup, dev->net,
855 "Read Value from HW_CFG: 0x%08x\n", read_buf);
856
857 if (turbo_mode)
858 read_buf |= (HW_CFG_MEF_ | HW_CFG_BCE_);
859
860 read_buf &= ~HW_CFG_RXDOFF_;
861
862 /* set Rx data offset=2, Make IP header aligns on word boundary. */
863 read_buf |= NET_IP_ALIGN << 9;
864
865 ret = smsc95xx_write_reg(dev, HW_CFG, read_buf);
866 if (ret < 0) {
867 netdev_warn(dev->net, "Failed to write HW_CFG register, ret=%d\n",
868 ret);
869 return ret;
870 }
871
872 ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
873 if (ret < 0) {
874 netdev_warn(dev->net, "Failed to read HW_CFG: %d\n", ret);
875 return ret;
876 }
877 netif_dbg(dev, ifup, dev->net,
878 "Read Value from HW_CFG after writing: 0x%08x\n", read_buf);
879
880 write_buf = 0xFFFFFFFF;
881 ret = smsc95xx_write_reg(dev, INT_STS, write_buf);
882 if (ret < 0) {
883 netdev_warn(dev->net, "Failed to write INT_STS register, ret=%d\n",
884 ret);
885 return ret;
886 }
887
888 ret = smsc95xx_read_reg(dev, ID_REV, &read_buf);
889 if (ret < 0) {
890 netdev_warn(dev->net, "Failed to read ID_REV: %d\n", ret);
891 return ret;
892 }
893 netif_dbg(dev, ifup, dev->net, "ID_REV = 0x%08x\n", read_buf);
894
895 /* Configure GPIO pins as LED outputs */
896 write_buf = LED_GPIO_CFG_SPD_LED | LED_GPIO_CFG_LNK_LED |
897 LED_GPIO_CFG_FDX_LED;
898 ret = smsc95xx_write_reg(dev, LED_GPIO_CFG, write_buf);
899 if (ret < 0) {
900 netdev_warn(dev->net, "Failed to write LED_GPIO_CFG register, ret=%d\n",
901 ret);
902 return ret;
903 }
904
905 /* Init Tx */
906 write_buf = 0;
907 ret = smsc95xx_write_reg(dev, FLOW, write_buf);
908 if (ret < 0) {
909 netdev_warn(dev->net, "Failed to write FLOW: %d\n", ret);
910 return ret;
911 }
912
913 read_buf = AFC_CFG_DEFAULT;
914 ret = smsc95xx_write_reg(dev, AFC_CFG, read_buf);
915 if (ret < 0) {
916 netdev_warn(dev->net, "Failed to write AFC_CFG: %d\n", ret);
917 return ret;
918 }
919
920 /* Don't need mac_cr_lock during initialisation */
921 ret = smsc95xx_read_reg(dev, MAC_CR, &pdata->mac_cr);
922 if (ret < 0) {
923 netdev_warn(dev->net, "Failed to read MAC_CR: %d\n", ret);
924 return ret;
925 }
926
927 /* Init Rx */
928 /* Set Vlan */
929 write_buf = (u32)ETH_P_8021Q;
930 ret = smsc95xx_write_reg(dev, VLAN1, write_buf);
931 if (ret < 0) {
932 netdev_warn(dev->net, "Failed to write VAN1: %d\n", ret);
933 return ret;
934 }
935
936 /* Enable or disable checksum offload engines */
937 smsc95xx_set_features(dev->net, dev->net->features);
938
939 smsc95xx_set_multicast(dev->net);
940
941 if (smsc95xx_phy_initialize(dev) < 0)
942 return -EIO;
943
944 ret = smsc95xx_read_reg(dev, INT_EP_CTL, &read_buf);
945 if (ret < 0) {
946 netdev_warn(dev->net, "Failed to read INT_EP_CTL: %d\n", ret);
947 return ret;
948 }
949
950 /* enable PHY interrupts */
951 read_buf |= INT_EP_CTL_PHY_INT_;
952
953 ret = smsc95xx_write_reg(dev, INT_EP_CTL, read_buf);
954 if (ret < 0) {
955 netdev_warn(dev->net, "Failed to write INT_EP_CTL: %d\n", ret);
956 return ret;
957 }
958
959 smsc95xx_start_tx_path(dev);
960 smsc95xx_start_rx_path(dev);
961
962 netif_dbg(dev, ifup, dev->net, "smsc95xx_reset, return 0\n");
963 return 0;
964}
965
966static const struct net_device_ops smsc95xx_netdev_ops = {
967 .ndo_open = usbnet_open,
968 .ndo_stop = usbnet_stop,
969 .ndo_start_xmit = usbnet_start_xmit,
970 .ndo_tx_timeout = usbnet_tx_timeout,
971 .ndo_change_mtu = usbnet_change_mtu,
972 .ndo_set_mac_address = eth_mac_addr,
973 .ndo_validate_addr = eth_validate_addr,
974 .ndo_do_ioctl = smsc95xx_ioctl,
975 .ndo_set_multicast_list = smsc95xx_set_multicast,
976 .ndo_set_features = smsc95xx_set_features,
977};
978
979static int smsc95xx_bind(struct usbnet *dev, struct usb_interface *intf)
980{
981 struct smsc95xx_priv *pdata = NULL;
982 int ret;
983
984 printk(KERN_INFO SMSC_CHIPNAME " v" SMSC_DRIVER_VERSION "\n");
985
986 ret = usbnet_get_endpoints(dev, intf);
987 if (ret < 0) {
988 netdev_warn(dev->net, "usbnet_get_endpoints failed: %d\n", ret);
989 return ret;
990 }
991
992 dev->data[0] = (unsigned long)kzalloc(sizeof(struct smsc95xx_priv),
993 GFP_KERNEL);
994
995 pdata = (struct smsc95xx_priv *)(dev->data[0]);
996 if (!pdata) {
997 netdev_warn(dev->net, "Unable to allocate struct smsc95xx_priv\n");
998 return -ENOMEM;
999 }
1000
1001 spin_lock_init(&pdata->mac_cr_lock);
1002
1003 if (DEFAULT_TX_CSUM_ENABLE)
1004 dev->net->features |= NETIF_F_HW_CSUM;
1005 if (DEFAULT_RX_CSUM_ENABLE)
1006 dev->net->features |= NETIF_F_RXCSUM;
1007
1008 dev->net->hw_features = NETIF_F_HW_CSUM | NETIF_F_RXCSUM;
1009
1010 smsc95xx_init_mac_address(dev);
1011
1012 /* Init all registers */
1013 ret = smsc95xx_reset(dev);
1014
1015 dev->net->netdev_ops = &smsc95xx_netdev_ops;
1016 dev->net->ethtool_ops = &smsc95xx_ethtool_ops;
1017 dev->net->flags |= IFF_MULTICAST;
1018 dev->net->hard_header_len += SMSC95XX_TX_OVERHEAD_CSUM;
1019 return 0;
1020}
1021
1022static void smsc95xx_unbind(struct usbnet *dev, struct usb_interface *intf)
1023{
1024 struct smsc95xx_priv *pdata = (struct smsc95xx_priv *)(dev->data[0]);
1025 if (pdata) {
1026 netif_dbg(dev, ifdown, dev->net, "free pdata\n");
1027 kfree(pdata);
1028 pdata = NULL;
1029 dev->data[0] = 0;
1030 }
1031}
1032
1033static void smsc95xx_rx_csum_offload(struct sk_buff *skb)
1034{
1035 skb->csum = *(u16 *)(skb_tail_pointer(skb) - 2);
1036 skb->ip_summed = CHECKSUM_COMPLETE;
1037 skb_trim(skb, skb->len - 2);
1038}
1039
1040static int smsc95xx_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
1041{
1042 while (skb->len > 0) {
1043 u32 header, align_count;
1044 struct sk_buff *ax_skb;
1045 unsigned char *packet;
1046 u16 size;
1047
1048 memcpy(&header, skb->data, sizeof(header));
1049 le32_to_cpus(&header);
1050 skb_pull(skb, 4 + NET_IP_ALIGN);
1051 packet = skb->data;
1052
1053 /* get the packet length */
1054 size = (u16)((header & RX_STS_FL_) >> 16);
1055 align_count = (4 - ((size + NET_IP_ALIGN) % 4)) % 4;
1056
1057 if (unlikely(header & RX_STS_ES_)) {
1058 netif_dbg(dev, rx_err, dev->net,
1059 "Error header=0x%08x\n", header);
1060 dev->net->stats.rx_errors++;
1061 dev->net->stats.rx_dropped++;
1062
1063 if (header & RX_STS_CRC_) {
1064 dev->net->stats.rx_crc_errors++;
1065 } else {
1066 if (header & (RX_STS_TL_ | RX_STS_RF_))
1067 dev->net->stats.rx_frame_errors++;
1068
1069 if ((header & RX_STS_LE_) &&
1070 (!(header & RX_STS_FT_)))
1071 dev->net->stats.rx_length_errors++;
1072 }
1073 } else {
1074 /* ETH_FRAME_LEN + 4(CRC) + 2(COE) + 4(Vlan) */
1075 if (unlikely(size > (ETH_FRAME_LEN + 12))) {
1076 netif_dbg(dev, rx_err, dev->net,
1077 "size err header=0x%08x\n", header);
1078 return 0;
1079 }
1080
1081 /* last frame in this batch */
1082 if (skb->len == size) {
1083 if (dev->net->features & NETIF_F_RXCSUM)
1084 smsc95xx_rx_csum_offload(skb);
1085 skb_trim(skb, skb->len - 4); /* remove fcs */
1086 skb->truesize = size + sizeof(struct sk_buff);
1087
1088 return 1;
1089 }
1090
1091 ax_skb = skb_clone(skb, GFP_ATOMIC);
1092 if (unlikely(!ax_skb)) {
1093 netdev_warn(dev->net, "Error allocating skb\n");
1094 return 0;
1095 }
1096
1097 ax_skb->len = size;
1098 ax_skb->data = packet;
1099 skb_set_tail_pointer(ax_skb, size);
1100
1101 if (dev->net->features & NETIF_F_RXCSUM)
1102 smsc95xx_rx_csum_offload(ax_skb);
1103 skb_trim(ax_skb, ax_skb->len - 4); /* remove fcs */
1104 ax_skb->truesize = size + sizeof(struct sk_buff);
1105
1106 usbnet_skb_return(dev, ax_skb);
1107 }
1108
1109 skb_pull(skb, size);
1110
1111 /* padding bytes before the next frame starts */
1112 if (skb->len)
1113 skb_pull(skb, align_count);
1114 }
1115
1116 if (unlikely(skb->len < 0)) {
1117 netdev_warn(dev->net, "invalid rx length<0 %d\n", skb->len);
1118 return 0;
1119 }
1120
1121 return 1;
1122}
1123
1124static u32 smsc95xx_calc_csum_preamble(struct sk_buff *skb)
1125{
1126 u16 low_16 = (u16)skb_checksum_start_offset(skb);
1127 u16 high_16 = low_16 + skb->csum_offset;
1128 return (high_16 << 16) | low_16;
1129}
1130
1131static struct sk_buff *smsc95xx_tx_fixup(struct usbnet *dev,
1132 struct sk_buff *skb, gfp_t flags)
1133{
1134 bool csum = skb->ip_summed == CHECKSUM_PARTIAL;
1135 int overhead = csum ? SMSC95XX_TX_OVERHEAD_CSUM : SMSC95XX_TX_OVERHEAD;
1136 u32 tx_cmd_a, tx_cmd_b;
1137
1138 /* We do not advertise SG, so skbs should be already linearized */
1139 BUG_ON(skb_shinfo(skb)->nr_frags);
1140
1141 if (skb_headroom(skb) < overhead) {
1142 struct sk_buff *skb2 = skb_copy_expand(skb,
1143 overhead, 0, flags);
1144 dev_kfree_skb_any(skb);
1145 skb = skb2;
1146 if (!skb)
1147 return NULL;
1148 }
1149
1150 if (csum) {
1151 if (skb->len <= 45) {
1152 /* workaround - hardware tx checksum does not work
1153 * properly with extremely small packets */
1154 long csstart = skb_checksum_start_offset(skb);
1155 __wsum calc = csum_partial(skb->data + csstart,
1156 skb->len - csstart, 0);
1157 *((__sum16 *)(skb->data + csstart
1158 + skb->csum_offset)) = csum_fold(calc);
1159
1160 csum = false;
1161 } else {
1162 u32 csum_preamble = smsc95xx_calc_csum_preamble(skb);
1163 skb_push(skb, 4);
1164 memcpy(skb->data, &csum_preamble, 4);
1165 }
1166 }
1167
1168 skb_push(skb, 4);
1169 tx_cmd_b = (u32)(skb->len - 4);
1170 if (csum)
1171 tx_cmd_b |= TX_CMD_B_CSUM_ENABLE;
1172 cpu_to_le32s(&tx_cmd_b);
1173 memcpy(skb->data, &tx_cmd_b, 4);
1174
1175 skb_push(skb, 4);
1176 tx_cmd_a = (u32)(skb->len - 8) | TX_CMD_A_FIRST_SEG_ |
1177 TX_CMD_A_LAST_SEG_;
1178 cpu_to_le32s(&tx_cmd_a);
1179 memcpy(skb->data, &tx_cmd_a, 4);
1180
1181 return skb;
1182}
1183
1184static const struct driver_info smsc95xx_info = {
1185 .description = "smsc95xx USB 2.0 Ethernet",
1186 .bind = smsc95xx_bind,
1187 .unbind = smsc95xx_unbind,
1188 .link_reset = smsc95xx_link_reset,
1189 .reset = smsc95xx_reset,
1190 .rx_fixup = smsc95xx_rx_fixup,
1191 .tx_fixup = smsc95xx_tx_fixup,
1192 .status = smsc95xx_status,
1193 .flags = FLAG_ETHER | FLAG_SEND_ZLP,
1194};
1195
1196static const struct usb_device_id products[] = {
1197 {
1198 /* SMSC9500 USB Ethernet Device */
1199 USB_DEVICE(0x0424, 0x9500),
1200 .driver_info = (unsigned long) &smsc95xx_info,
1201 },
1202 {
1203 /* SMSC9505 USB Ethernet Device */
1204 USB_DEVICE(0x0424, 0x9505),
1205 .driver_info = (unsigned long) &smsc95xx_info,
1206 },
1207 {
1208 /* SMSC9500A USB Ethernet Device */
1209 USB_DEVICE(0x0424, 0x9E00),
1210 .driver_info = (unsigned long) &smsc95xx_info,
1211 },
1212 {
1213 /* SMSC9505A USB Ethernet Device */
1214 USB_DEVICE(0x0424, 0x9E01),
1215 .driver_info = (unsigned long) &smsc95xx_info,
1216 },
1217 {
1218 /* SMSC9512/9514 USB Hub & Ethernet Device */
1219 USB_DEVICE(0x0424, 0xec00),
1220 .driver_info = (unsigned long) &smsc95xx_info,
1221 },
1222 {
1223 /* SMSC9500 USB Ethernet Device (SAL10) */
1224 USB_DEVICE(0x0424, 0x9900),
1225 .driver_info = (unsigned long) &smsc95xx_info,
1226 },
1227 {
1228 /* SMSC9505 USB Ethernet Device (SAL10) */
1229 USB_DEVICE(0x0424, 0x9901),
1230 .driver_info = (unsigned long) &smsc95xx_info,
1231 },
1232 {
1233 /* SMSC9500A USB Ethernet Device (SAL10) */
1234 USB_DEVICE(0x0424, 0x9902),
1235 .driver_info = (unsigned long) &smsc95xx_info,
1236 },
1237 {
1238 /* SMSC9505A USB Ethernet Device (SAL10) */
1239 USB_DEVICE(0x0424, 0x9903),
1240 .driver_info = (unsigned long) &smsc95xx_info,
1241 },
1242 {
1243 /* SMSC9512/9514 USB Hub & Ethernet Device (SAL10) */
1244 USB_DEVICE(0x0424, 0x9904),
1245 .driver_info = (unsigned long) &smsc95xx_info,
1246 },
1247 {
1248 /* SMSC9500A USB Ethernet Device (HAL) */
1249 USB_DEVICE(0x0424, 0x9905),
1250 .driver_info = (unsigned long) &smsc95xx_info,
1251 },
1252 {
1253 /* SMSC9505A USB Ethernet Device (HAL) */
1254 USB_DEVICE(0x0424, 0x9906),
1255 .driver_info = (unsigned long) &smsc95xx_info,
1256 },
1257 {
1258 /* SMSC9500 USB Ethernet Device (Alternate ID) */
1259 USB_DEVICE(0x0424, 0x9907),
1260 .driver_info = (unsigned long) &smsc95xx_info,
1261 },
1262 {
1263 /* SMSC9500A USB Ethernet Device (Alternate ID) */
1264 USB_DEVICE(0x0424, 0x9908),
1265 .driver_info = (unsigned long) &smsc95xx_info,
1266 },
1267 {
1268 /* SMSC9512/9514 USB Hub & Ethernet Device (Alternate ID) */
1269 USB_DEVICE(0x0424, 0x9909),
1270 .driver_info = (unsigned long) &smsc95xx_info,
1271 },
1272 {
1273 /* SMSC LAN9530 USB Ethernet Device */
1274 USB_DEVICE(0x0424, 0x9530),
1275 .driver_info = (unsigned long) &smsc95xx_info,
1276 },
1277 {
1278 /* SMSC LAN9730 USB Ethernet Device */
1279 USB_DEVICE(0x0424, 0x9730),
1280 .driver_info = (unsigned long) &smsc95xx_info,
1281 },
1282 {
1283 /* SMSC LAN89530 USB Ethernet Device */
1284 USB_DEVICE(0x0424, 0x9E08),
1285 .driver_info = (unsigned long) &smsc95xx_info,
1286 },
1287 { }, /* END */
1288};
1289MODULE_DEVICE_TABLE(usb, products);
1290
1291static struct usb_driver smsc95xx_driver = {
1292 .name = "smsc95xx",
1293 .id_table = products,
1294 .probe = usbnet_probe,
1295 .suspend = usbnet_suspend,
1296 .resume = usbnet_resume,
1297 .disconnect = usbnet_disconnect,
1298};
1299
1300static int __init smsc95xx_init(void)
1301{
1302 return usb_register(&smsc95xx_driver);
1303}
1304module_init(smsc95xx_init);
1305
1306static void __exit smsc95xx_exit(void)
1307{
1308 usb_deregister(&smsc95xx_driver);
1309}
1310module_exit(smsc95xx_exit);
1311
1312MODULE_AUTHOR("Nancy Lin");
1313MODULE_AUTHOR("Steve Glendinning <steve.glendinning@smsc.com>");
1314MODULE_DESCRIPTION("SMSC95XX USB 2.0 Ethernet Devices");
1315MODULE_LICENSE("GPL");
1// SPDX-License-Identifier: GPL-2.0-or-later
2 /***************************************************************************
3 *
4 * Copyright (C) 2007-2008 SMSC
5 *
6 *****************************************************************************/
7
8#include <linux/module.h>
9#include <linux/kmod.h>
10#include <linux/netdevice.h>
11#include <linux/etherdevice.h>
12#include <linux/ethtool.h>
13#include <linux/mii.h>
14#include <linux/usb.h>
15#include <linux/bitrev.h>
16#include <linux/crc16.h>
17#include <linux/crc32.h>
18#include <linux/usb/usbnet.h>
19#include <linux/slab.h>
20#include <linux/of_net.h>
21#include <linux/mdio.h>
22#include <linux/phy.h>
23#include "smsc95xx.h"
24
25#define SMSC_CHIPNAME "smsc95xx"
26#define SMSC_DRIVER_VERSION "2.0.0"
27#define HS_USB_PKT_SIZE (512)
28#define FS_USB_PKT_SIZE (64)
29#define DEFAULT_HS_BURST_CAP_SIZE (16 * 1024 + 5 * HS_USB_PKT_SIZE)
30#define DEFAULT_FS_BURST_CAP_SIZE (6 * 1024 + 33 * FS_USB_PKT_SIZE)
31#define DEFAULT_BULK_IN_DELAY (0x00002000)
32#define MAX_SINGLE_PACKET_SIZE (2048)
33#define LAN95XX_EEPROM_MAGIC (0x9500)
34#define EEPROM_MAC_OFFSET (0x01)
35#define DEFAULT_TX_CSUM_ENABLE (true)
36#define DEFAULT_RX_CSUM_ENABLE (true)
37#define SMSC95XX_INTERNAL_PHY_ID (1)
38#define SMSC95XX_TX_OVERHEAD (8)
39#define SMSC95XX_TX_OVERHEAD_CSUM (12)
40#define SUPPORTED_WAKE (WAKE_PHY | WAKE_UCAST | WAKE_BCAST | \
41 WAKE_MCAST | WAKE_ARP | WAKE_MAGIC)
42
43#define FEATURE_8_WAKEUP_FILTERS (0x01)
44#define FEATURE_PHY_NLP_CROSSOVER (0x02)
45#define FEATURE_REMOTE_WAKEUP (0x04)
46
47#define SUSPEND_SUSPEND0 (0x01)
48#define SUSPEND_SUSPEND1 (0x02)
49#define SUSPEND_SUSPEND2 (0x04)
50#define SUSPEND_SUSPEND3 (0x08)
51#define SUSPEND_ALLMODES (SUSPEND_SUSPEND0 | SUSPEND_SUSPEND1 | \
52 SUSPEND_SUSPEND2 | SUSPEND_SUSPEND3)
53
54struct smsc95xx_priv {
55 u32 mac_cr;
56 u32 hash_hi;
57 u32 hash_lo;
58 u32 wolopts;
59 spinlock_t mac_cr_lock;
60 u8 features;
61 u8 suspend_flags;
62 struct mii_bus *mdiobus;
63 struct phy_device *phydev;
64};
65
66static bool turbo_mode = true;
67module_param(turbo_mode, bool, 0644);
68MODULE_PARM_DESC(turbo_mode, "Enable multiple frames per Rx transaction");
69
70static int __must_check __smsc95xx_read_reg(struct usbnet *dev, u32 index,
71 u32 *data, int in_pm)
72{
73 u32 buf;
74 int ret;
75 int (*fn)(struct usbnet *, u8, u8, u16, u16, void *, u16);
76
77 BUG_ON(!dev);
78
79 if (!in_pm)
80 fn = usbnet_read_cmd;
81 else
82 fn = usbnet_read_cmd_nopm;
83
84 ret = fn(dev, USB_VENDOR_REQUEST_READ_REGISTER, USB_DIR_IN
85 | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
86 0, index, &buf, 4);
87 if (unlikely(ret < 0)) {
88 netdev_warn(dev->net, "Failed to read reg index 0x%08x: %d\n",
89 index, ret);
90 return ret;
91 }
92
93 le32_to_cpus(&buf);
94 *data = buf;
95
96 return ret;
97}
98
99static int __must_check __smsc95xx_write_reg(struct usbnet *dev, u32 index,
100 u32 data, int in_pm)
101{
102 u32 buf;
103 int ret;
104 int (*fn)(struct usbnet *, u8, u8, u16, u16, const void *, u16);
105
106 BUG_ON(!dev);
107
108 if (!in_pm)
109 fn = usbnet_write_cmd;
110 else
111 fn = usbnet_write_cmd_nopm;
112
113 buf = data;
114 cpu_to_le32s(&buf);
115
116 ret = fn(dev, USB_VENDOR_REQUEST_WRITE_REGISTER, USB_DIR_OUT
117 | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
118 0, index, &buf, 4);
119 if (unlikely(ret < 0))
120 netdev_warn(dev->net, "Failed to write reg index 0x%08x: %d\n",
121 index, ret);
122
123 return ret;
124}
125
126static int __must_check smsc95xx_read_reg_nopm(struct usbnet *dev, u32 index,
127 u32 *data)
128{
129 return __smsc95xx_read_reg(dev, index, data, 1);
130}
131
132static int __must_check smsc95xx_write_reg_nopm(struct usbnet *dev, u32 index,
133 u32 data)
134{
135 return __smsc95xx_write_reg(dev, index, data, 1);
136}
137
138static int __must_check smsc95xx_read_reg(struct usbnet *dev, u32 index,
139 u32 *data)
140{
141 return __smsc95xx_read_reg(dev, index, data, 0);
142}
143
144static int __must_check smsc95xx_write_reg(struct usbnet *dev, u32 index,
145 u32 data)
146{
147 return __smsc95xx_write_reg(dev, index, data, 0);
148}
149
150/* Loop until the read is completed with timeout
151 * called with phy_mutex held */
152static int __must_check __smsc95xx_phy_wait_not_busy(struct usbnet *dev,
153 int in_pm)
154{
155 unsigned long start_time = jiffies;
156 u32 val;
157 int ret;
158
159 do {
160 ret = __smsc95xx_read_reg(dev, MII_ADDR, &val, in_pm);
161 if (ret < 0) {
162 netdev_warn(dev->net, "Error reading MII_ACCESS\n");
163 return ret;
164 }
165
166 if (!(val & MII_BUSY_))
167 return 0;
168 } while (!time_after(jiffies, start_time + HZ));
169
170 return -EIO;
171}
172
173static u32 mii_address_cmd(int phy_id, int idx, u16 op)
174{
175 return (phy_id & 0x1f) << 11 | (idx & 0x1f) << 6 | op;
176}
177
178static int __smsc95xx_mdio_read(struct usbnet *dev, int phy_id, int idx,
179 int in_pm)
180{
181 u32 val, addr;
182 int ret;
183
184 mutex_lock(&dev->phy_mutex);
185
186 /* confirm MII not busy */
187 ret = __smsc95xx_phy_wait_not_busy(dev, in_pm);
188 if (ret < 0) {
189 netdev_warn(dev->net, "%s: MII is busy\n", __func__);
190 goto done;
191 }
192
193 /* set the address, index & direction (read from PHY) */
194 addr = mii_address_cmd(phy_id, idx, MII_READ_ | MII_BUSY_);
195 ret = __smsc95xx_write_reg(dev, MII_ADDR, addr, in_pm);
196 if (ret < 0) {
197 netdev_warn(dev->net, "Error writing MII_ADDR\n");
198 goto done;
199 }
200
201 ret = __smsc95xx_phy_wait_not_busy(dev, in_pm);
202 if (ret < 0) {
203 netdev_warn(dev->net, "Timed out reading MII reg %02X\n", idx);
204 goto done;
205 }
206
207 ret = __smsc95xx_read_reg(dev, MII_DATA, &val, in_pm);
208 if (ret < 0) {
209 netdev_warn(dev->net, "Error reading MII_DATA\n");
210 goto done;
211 }
212
213 ret = (u16)(val & 0xFFFF);
214
215done:
216 mutex_unlock(&dev->phy_mutex);
217 return ret;
218}
219
220static void __smsc95xx_mdio_write(struct usbnet *dev, int phy_id,
221 int idx, int regval, int in_pm)
222{
223 u32 val, addr;
224 int ret;
225
226 mutex_lock(&dev->phy_mutex);
227
228 /* confirm MII not busy */
229 ret = __smsc95xx_phy_wait_not_busy(dev, in_pm);
230 if (ret < 0) {
231 netdev_warn(dev->net, "%s: MII is busy\n", __func__);
232 goto done;
233 }
234
235 val = regval;
236 ret = __smsc95xx_write_reg(dev, MII_DATA, val, in_pm);
237 if (ret < 0) {
238 netdev_warn(dev->net, "Error writing MII_DATA\n");
239 goto done;
240 }
241
242 /* set the address, index & direction (write to PHY) */
243 addr = mii_address_cmd(phy_id, idx, MII_WRITE_ | MII_BUSY_);
244 ret = __smsc95xx_write_reg(dev, MII_ADDR, addr, in_pm);
245 if (ret < 0) {
246 netdev_warn(dev->net, "Error writing MII_ADDR\n");
247 goto done;
248 }
249
250 ret = __smsc95xx_phy_wait_not_busy(dev, in_pm);
251 if (ret < 0) {
252 netdev_warn(dev->net, "Timed out writing MII reg %02X\n", idx);
253 goto done;
254 }
255
256done:
257 mutex_unlock(&dev->phy_mutex);
258}
259
260static int smsc95xx_mdio_read_nopm(struct usbnet *dev, int idx)
261{
262 struct smsc95xx_priv *pdata = dev->driver_priv;
263
264 return __smsc95xx_mdio_read(dev, pdata->phydev->mdio.addr, idx, 1);
265}
266
267static void smsc95xx_mdio_write_nopm(struct usbnet *dev, int idx, int regval)
268{
269 struct smsc95xx_priv *pdata = dev->driver_priv;
270
271 __smsc95xx_mdio_write(dev, pdata->phydev->mdio.addr, idx, regval, 1);
272}
273
274static int smsc95xx_mdiobus_read(struct mii_bus *bus, int phy_id, int idx)
275{
276 struct usbnet *dev = bus->priv;
277
278 return __smsc95xx_mdio_read(dev, phy_id, idx, 0);
279}
280
281static int smsc95xx_mdiobus_write(struct mii_bus *bus, int phy_id, int idx,
282 u16 regval)
283{
284 struct usbnet *dev = bus->priv;
285
286 __smsc95xx_mdio_write(dev, phy_id, idx, regval, 0);
287 return 0;
288}
289
290static int __must_check smsc95xx_wait_eeprom(struct usbnet *dev)
291{
292 unsigned long start_time = jiffies;
293 u32 val;
294 int ret;
295
296 do {
297 ret = smsc95xx_read_reg(dev, E2P_CMD, &val);
298 if (ret < 0) {
299 netdev_warn(dev->net, "Error reading E2P_CMD\n");
300 return ret;
301 }
302
303 if (!(val & E2P_CMD_BUSY_) || (val & E2P_CMD_TIMEOUT_))
304 break;
305 udelay(40);
306 } while (!time_after(jiffies, start_time + HZ));
307
308 if (val & (E2P_CMD_TIMEOUT_ | E2P_CMD_BUSY_)) {
309 netdev_warn(dev->net, "EEPROM read operation timeout\n");
310 return -EIO;
311 }
312
313 return 0;
314}
315
316static int __must_check smsc95xx_eeprom_confirm_not_busy(struct usbnet *dev)
317{
318 unsigned long start_time = jiffies;
319 u32 val;
320 int ret;
321
322 do {
323 ret = smsc95xx_read_reg(dev, E2P_CMD, &val);
324 if (ret < 0) {
325 netdev_warn(dev->net, "Error reading E2P_CMD\n");
326 return ret;
327 }
328
329 if (!(val & E2P_CMD_BUSY_))
330 return 0;
331
332 udelay(40);
333 } while (!time_after(jiffies, start_time + HZ));
334
335 netdev_warn(dev->net, "EEPROM is busy\n");
336 return -EIO;
337}
338
339static int smsc95xx_read_eeprom(struct usbnet *dev, u32 offset, u32 length,
340 u8 *data)
341{
342 u32 val;
343 int i, ret;
344
345 BUG_ON(!dev);
346 BUG_ON(!data);
347
348 ret = smsc95xx_eeprom_confirm_not_busy(dev);
349 if (ret)
350 return ret;
351
352 for (i = 0; i < length; i++) {
353 val = E2P_CMD_BUSY_ | E2P_CMD_READ_ | (offset & E2P_CMD_ADDR_);
354 ret = smsc95xx_write_reg(dev, E2P_CMD, val);
355 if (ret < 0) {
356 netdev_warn(dev->net, "Error writing E2P_CMD\n");
357 return ret;
358 }
359
360 ret = smsc95xx_wait_eeprom(dev);
361 if (ret < 0)
362 return ret;
363
364 ret = smsc95xx_read_reg(dev, E2P_DATA, &val);
365 if (ret < 0) {
366 netdev_warn(dev->net, "Error reading E2P_DATA\n");
367 return ret;
368 }
369
370 data[i] = val & 0xFF;
371 offset++;
372 }
373
374 return 0;
375}
376
377static int smsc95xx_write_eeprom(struct usbnet *dev, u32 offset, u32 length,
378 u8 *data)
379{
380 u32 val;
381 int i, ret;
382
383 BUG_ON(!dev);
384 BUG_ON(!data);
385
386 ret = smsc95xx_eeprom_confirm_not_busy(dev);
387 if (ret)
388 return ret;
389
390 /* Issue write/erase enable command */
391 val = E2P_CMD_BUSY_ | E2P_CMD_EWEN_;
392 ret = smsc95xx_write_reg(dev, E2P_CMD, val);
393 if (ret < 0) {
394 netdev_warn(dev->net, "Error writing E2P_DATA\n");
395 return ret;
396 }
397
398 ret = smsc95xx_wait_eeprom(dev);
399 if (ret < 0)
400 return ret;
401
402 for (i = 0; i < length; i++) {
403
404 /* Fill data register */
405 val = data[i];
406 ret = smsc95xx_write_reg(dev, E2P_DATA, val);
407 if (ret < 0) {
408 netdev_warn(dev->net, "Error writing E2P_DATA\n");
409 return ret;
410 }
411
412 /* Send "write" command */
413 val = E2P_CMD_BUSY_ | E2P_CMD_WRITE_ | (offset & E2P_CMD_ADDR_);
414 ret = smsc95xx_write_reg(dev, E2P_CMD, val);
415 if (ret < 0) {
416 netdev_warn(dev->net, "Error writing E2P_CMD\n");
417 return ret;
418 }
419
420 ret = smsc95xx_wait_eeprom(dev);
421 if (ret < 0)
422 return ret;
423
424 offset++;
425 }
426
427 return 0;
428}
429
430static int __must_check smsc95xx_write_reg_async(struct usbnet *dev, u16 index,
431 u32 data)
432{
433 const u16 size = 4;
434 u32 buf;
435 int ret;
436
437 buf = data;
438 cpu_to_le32s(&buf);
439
440 ret = usbnet_write_cmd_async(dev, USB_VENDOR_REQUEST_WRITE_REGISTER,
441 USB_DIR_OUT | USB_TYPE_VENDOR |
442 USB_RECIP_DEVICE,
443 0, index, &buf, size);
444 if (ret < 0)
445 netdev_warn(dev->net, "Error write async cmd, sts=%d\n",
446 ret);
447 return ret;
448}
449
450/* returns hash bit number for given MAC address
451 * example:
452 * 01 00 5E 00 00 01 -> returns bit number 31 */
453static unsigned int smsc95xx_hash(char addr[ETH_ALEN])
454{
455 return (ether_crc(ETH_ALEN, addr) >> 26) & 0x3f;
456}
457
458static void smsc95xx_set_multicast(struct net_device *netdev)
459{
460 struct usbnet *dev = netdev_priv(netdev);
461 struct smsc95xx_priv *pdata = dev->driver_priv;
462 unsigned long flags;
463 int ret;
464
465 pdata->hash_hi = 0;
466 pdata->hash_lo = 0;
467
468 spin_lock_irqsave(&pdata->mac_cr_lock, flags);
469
470 if (dev->net->flags & IFF_PROMISC) {
471 netif_dbg(dev, drv, dev->net, "promiscuous mode enabled\n");
472 pdata->mac_cr |= MAC_CR_PRMS_;
473 pdata->mac_cr &= ~(MAC_CR_MCPAS_ | MAC_CR_HPFILT_);
474 } else if (dev->net->flags & IFF_ALLMULTI) {
475 netif_dbg(dev, drv, dev->net, "receive all multicast enabled\n");
476 pdata->mac_cr |= MAC_CR_MCPAS_;
477 pdata->mac_cr &= ~(MAC_CR_PRMS_ | MAC_CR_HPFILT_);
478 } else if (!netdev_mc_empty(dev->net)) {
479 struct netdev_hw_addr *ha;
480
481 pdata->mac_cr |= MAC_CR_HPFILT_;
482 pdata->mac_cr &= ~(MAC_CR_PRMS_ | MAC_CR_MCPAS_);
483
484 netdev_for_each_mc_addr(ha, netdev) {
485 u32 bitnum = smsc95xx_hash(ha->addr);
486 u32 mask = 0x01 << (bitnum & 0x1F);
487 if (bitnum & 0x20)
488 pdata->hash_hi |= mask;
489 else
490 pdata->hash_lo |= mask;
491 }
492
493 netif_dbg(dev, drv, dev->net, "HASHH=0x%08X, HASHL=0x%08X\n",
494 pdata->hash_hi, pdata->hash_lo);
495 } else {
496 netif_dbg(dev, drv, dev->net, "receive own packets only\n");
497 pdata->mac_cr &=
498 ~(MAC_CR_PRMS_ | MAC_CR_MCPAS_ | MAC_CR_HPFILT_);
499 }
500
501 spin_unlock_irqrestore(&pdata->mac_cr_lock, flags);
502
503 /* Initiate async writes, as we can't wait for completion here */
504 ret = smsc95xx_write_reg_async(dev, HASHH, pdata->hash_hi);
505 if (ret < 0)
506 netdev_warn(dev->net, "failed to initiate async write to HASHH\n");
507
508 ret = smsc95xx_write_reg_async(dev, HASHL, pdata->hash_lo);
509 if (ret < 0)
510 netdev_warn(dev->net, "failed to initiate async write to HASHL\n");
511
512 ret = smsc95xx_write_reg_async(dev, MAC_CR, pdata->mac_cr);
513 if (ret < 0)
514 netdev_warn(dev->net, "failed to initiate async write to MAC_CR\n");
515}
516
517static int smsc95xx_phy_update_flowcontrol(struct usbnet *dev)
518{
519 u32 flow = 0, afc_cfg;
520 struct smsc95xx_priv *pdata = dev->driver_priv;
521 bool tx_pause, rx_pause;
522
523 int ret = smsc95xx_read_reg(dev, AFC_CFG, &afc_cfg);
524 if (ret < 0)
525 return ret;
526
527 if (pdata->phydev->duplex == DUPLEX_FULL) {
528 phy_get_pause(pdata->phydev, &tx_pause, &rx_pause);
529
530 if (rx_pause)
531 flow = 0xFFFF0002;
532
533 if (tx_pause) {
534 afc_cfg |= 0xF;
535 flow |= 0xFFFF0000;
536 } else {
537 afc_cfg &= ~0xF;
538 }
539
540 netif_dbg(dev, link, dev->net, "rx pause %s, tx pause %s\n",
541 rx_pause ? "enabled" : "disabled",
542 tx_pause ? "enabled" : "disabled");
543 } else {
544 netif_dbg(dev, link, dev->net, "half duplex\n");
545 afc_cfg |= 0xF;
546 }
547
548 ret = smsc95xx_write_reg(dev, FLOW, flow);
549 if (ret < 0)
550 return ret;
551
552 return smsc95xx_write_reg(dev, AFC_CFG, afc_cfg);
553}
554
555static int smsc95xx_link_reset(struct usbnet *dev)
556{
557 struct smsc95xx_priv *pdata = dev->driver_priv;
558 unsigned long flags;
559 int ret;
560
561 ret = smsc95xx_write_reg(dev, INT_STS, INT_STS_CLEAR_ALL_);
562 if (ret < 0)
563 return ret;
564
565 spin_lock_irqsave(&pdata->mac_cr_lock, flags);
566 if (pdata->phydev->duplex != DUPLEX_FULL) {
567 pdata->mac_cr &= ~MAC_CR_FDPX_;
568 pdata->mac_cr |= MAC_CR_RCVOWN_;
569 } else {
570 pdata->mac_cr &= ~MAC_CR_RCVOWN_;
571 pdata->mac_cr |= MAC_CR_FDPX_;
572 }
573 spin_unlock_irqrestore(&pdata->mac_cr_lock, flags);
574
575 ret = smsc95xx_write_reg(dev, MAC_CR, pdata->mac_cr);
576 if (ret < 0)
577 return ret;
578
579 ret = smsc95xx_phy_update_flowcontrol(dev);
580 if (ret < 0)
581 netdev_warn(dev->net, "Error updating PHY flow control\n");
582
583 return ret;
584}
585
586static void smsc95xx_status(struct usbnet *dev, struct urb *urb)
587{
588 u32 intdata;
589
590 if (urb->actual_length != 4) {
591 netdev_warn(dev->net, "unexpected urb length %d\n",
592 urb->actual_length);
593 return;
594 }
595
596 intdata = get_unaligned_le32(urb->transfer_buffer);
597 netif_dbg(dev, link, dev->net, "intdata: 0x%08X\n", intdata);
598
599 if (intdata & INT_ENP_PHY_INT_)
600 usbnet_defer_kevent(dev, EVENT_LINK_RESET);
601 else
602 netdev_warn(dev->net, "unexpected interrupt, intdata=0x%08X\n",
603 intdata);
604}
605
606/* Enable or disable Tx & Rx checksum offload engines */
607static int smsc95xx_set_features(struct net_device *netdev,
608 netdev_features_t features)
609{
610 struct usbnet *dev = netdev_priv(netdev);
611 u32 read_buf;
612 int ret;
613
614 ret = smsc95xx_read_reg(dev, COE_CR, &read_buf);
615 if (ret < 0)
616 return ret;
617
618 if (features & NETIF_F_IP_CSUM)
619 read_buf |= Tx_COE_EN_;
620 else
621 read_buf &= ~Tx_COE_EN_;
622
623 if (features & NETIF_F_RXCSUM)
624 read_buf |= Rx_COE_EN_;
625 else
626 read_buf &= ~Rx_COE_EN_;
627
628 ret = smsc95xx_write_reg(dev, COE_CR, read_buf);
629 if (ret < 0)
630 return ret;
631
632 netif_dbg(dev, hw, dev->net, "COE_CR = 0x%08x\n", read_buf);
633 return 0;
634}
635
636static int smsc95xx_ethtool_get_eeprom_len(struct net_device *net)
637{
638 return MAX_EEPROM_SIZE;
639}
640
641static int smsc95xx_ethtool_get_eeprom(struct net_device *netdev,
642 struct ethtool_eeprom *ee, u8 *data)
643{
644 struct usbnet *dev = netdev_priv(netdev);
645
646 ee->magic = LAN95XX_EEPROM_MAGIC;
647
648 return smsc95xx_read_eeprom(dev, ee->offset, ee->len, data);
649}
650
651static int smsc95xx_ethtool_set_eeprom(struct net_device *netdev,
652 struct ethtool_eeprom *ee, u8 *data)
653{
654 struct usbnet *dev = netdev_priv(netdev);
655
656 if (ee->magic != LAN95XX_EEPROM_MAGIC) {
657 netdev_warn(dev->net, "EEPROM: magic value mismatch, magic = 0x%x\n",
658 ee->magic);
659 return -EINVAL;
660 }
661
662 return smsc95xx_write_eeprom(dev, ee->offset, ee->len, data);
663}
664
665static int smsc95xx_ethtool_getregslen(struct net_device *netdev)
666{
667 /* all smsc95xx registers */
668 return COE_CR - ID_REV + sizeof(u32);
669}
670
671static void
672smsc95xx_ethtool_getregs(struct net_device *netdev, struct ethtool_regs *regs,
673 void *buf)
674{
675 struct usbnet *dev = netdev_priv(netdev);
676 unsigned int i, j;
677 int retval;
678 u32 *data = buf;
679
680 retval = smsc95xx_read_reg(dev, ID_REV, ®s->version);
681 if (retval < 0) {
682 netdev_warn(netdev, "REGS: cannot read ID_REV\n");
683 return;
684 }
685
686 for (i = ID_REV, j = 0; i <= COE_CR; i += (sizeof(u32)), j++) {
687 retval = smsc95xx_read_reg(dev, i, &data[j]);
688 if (retval < 0) {
689 netdev_warn(netdev, "REGS: cannot read reg[%x]\n", i);
690 return;
691 }
692 }
693}
694
695static void smsc95xx_ethtool_get_wol(struct net_device *net,
696 struct ethtool_wolinfo *wolinfo)
697{
698 struct usbnet *dev = netdev_priv(net);
699 struct smsc95xx_priv *pdata = dev->driver_priv;
700
701 wolinfo->supported = SUPPORTED_WAKE;
702 wolinfo->wolopts = pdata->wolopts;
703}
704
705static int smsc95xx_ethtool_set_wol(struct net_device *net,
706 struct ethtool_wolinfo *wolinfo)
707{
708 struct usbnet *dev = netdev_priv(net);
709 struct smsc95xx_priv *pdata = dev->driver_priv;
710 int ret;
711
712 if (wolinfo->wolopts & ~SUPPORTED_WAKE)
713 return -EINVAL;
714
715 pdata->wolopts = wolinfo->wolopts & SUPPORTED_WAKE;
716
717 ret = device_set_wakeup_enable(&dev->udev->dev, pdata->wolopts);
718 if (ret < 0)
719 netdev_warn(dev->net, "device_set_wakeup_enable error %d\n", ret);
720
721 return ret;
722}
723
724static u32 smsc95xx_get_link(struct net_device *net)
725{
726 phy_read_status(net->phydev);
727 return net->phydev->link;
728}
729
730static const struct ethtool_ops smsc95xx_ethtool_ops = {
731 .get_link = smsc95xx_get_link,
732 .nway_reset = phy_ethtool_nway_reset,
733 .get_drvinfo = usbnet_get_drvinfo,
734 .get_msglevel = usbnet_get_msglevel,
735 .set_msglevel = usbnet_set_msglevel,
736 .get_eeprom_len = smsc95xx_ethtool_get_eeprom_len,
737 .get_eeprom = smsc95xx_ethtool_get_eeprom,
738 .set_eeprom = smsc95xx_ethtool_set_eeprom,
739 .get_regs_len = smsc95xx_ethtool_getregslen,
740 .get_regs = smsc95xx_ethtool_getregs,
741 .get_wol = smsc95xx_ethtool_get_wol,
742 .set_wol = smsc95xx_ethtool_set_wol,
743 .get_link_ksettings = phy_ethtool_get_link_ksettings,
744 .set_link_ksettings = phy_ethtool_set_link_ksettings,
745 .get_ts_info = ethtool_op_get_ts_info,
746};
747
748static int smsc95xx_ioctl(struct net_device *netdev, struct ifreq *rq, int cmd)
749{
750 if (!netif_running(netdev))
751 return -EINVAL;
752
753 return phy_mii_ioctl(netdev->phydev, rq, cmd);
754}
755
756static void smsc95xx_init_mac_address(struct usbnet *dev)
757{
758 /* maybe the boot loader passed the MAC address in devicetree */
759 if (!eth_platform_get_mac_address(&dev->udev->dev,
760 dev->net->dev_addr)) {
761 if (is_valid_ether_addr(dev->net->dev_addr)) {
762 /* device tree values are valid so use them */
763 netif_dbg(dev, ifup, dev->net, "MAC address read from the device tree\n");
764 return;
765 }
766 }
767
768 /* try reading mac address from EEPROM */
769 if (smsc95xx_read_eeprom(dev, EEPROM_MAC_OFFSET, ETH_ALEN,
770 dev->net->dev_addr) == 0) {
771 if (is_valid_ether_addr(dev->net->dev_addr)) {
772 /* eeprom values are valid so use them */
773 netif_dbg(dev, ifup, dev->net, "MAC address read from EEPROM\n");
774 return;
775 }
776 }
777
778 /* no useful static MAC address found. generate a random one */
779 eth_hw_addr_random(dev->net);
780 netif_dbg(dev, ifup, dev->net, "MAC address set to eth_random_addr\n");
781}
782
783static int smsc95xx_set_mac_address(struct usbnet *dev)
784{
785 u32 addr_lo = dev->net->dev_addr[0] | dev->net->dev_addr[1] << 8 |
786 dev->net->dev_addr[2] << 16 | dev->net->dev_addr[3] << 24;
787 u32 addr_hi = dev->net->dev_addr[4] | dev->net->dev_addr[5] << 8;
788 int ret;
789
790 ret = smsc95xx_write_reg(dev, ADDRL, addr_lo);
791 if (ret < 0)
792 return ret;
793
794 return smsc95xx_write_reg(dev, ADDRH, addr_hi);
795}
796
797/* starts the TX path */
798static int smsc95xx_start_tx_path(struct usbnet *dev)
799{
800 struct smsc95xx_priv *pdata = dev->driver_priv;
801 unsigned long flags;
802 int ret;
803
804 /* Enable Tx at MAC */
805 spin_lock_irqsave(&pdata->mac_cr_lock, flags);
806 pdata->mac_cr |= MAC_CR_TXEN_;
807 spin_unlock_irqrestore(&pdata->mac_cr_lock, flags);
808
809 ret = smsc95xx_write_reg(dev, MAC_CR, pdata->mac_cr);
810 if (ret < 0)
811 return ret;
812
813 /* Enable Tx at SCSRs */
814 return smsc95xx_write_reg(dev, TX_CFG, TX_CFG_ON_);
815}
816
817/* Starts the Receive path */
818static int smsc95xx_start_rx_path(struct usbnet *dev, int in_pm)
819{
820 struct smsc95xx_priv *pdata = dev->driver_priv;
821 unsigned long flags;
822
823 spin_lock_irqsave(&pdata->mac_cr_lock, flags);
824 pdata->mac_cr |= MAC_CR_RXEN_;
825 spin_unlock_irqrestore(&pdata->mac_cr_lock, flags);
826
827 return __smsc95xx_write_reg(dev, MAC_CR, pdata->mac_cr, in_pm);
828}
829
830static int smsc95xx_reset(struct usbnet *dev)
831{
832 struct smsc95xx_priv *pdata = dev->driver_priv;
833 u32 read_buf, write_buf, burst_cap;
834 int ret = 0, timeout;
835
836 netif_dbg(dev, ifup, dev->net, "entering smsc95xx_reset\n");
837
838 ret = smsc95xx_write_reg(dev, HW_CFG, HW_CFG_LRST_);
839 if (ret < 0)
840 return ret;
841
842 timeout = 0;
843 do {
844 msleep(10);
845 ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
846 if (ret < 0)
847 return ret;
848 timeout++;
849 } while ((read_buf & HW_CFG_LRST_) && (timeout < 100));
850
851 if (timeout >= 100) {
852 netdev_warn(dev->net, "timeout waiting for completion of Lite Reset\n");
853 return ret;
854 }
855
856 ret = smsc95xx_write_reg(dev, PM_CTRL, PM_CTL_PHY_RST_);
857 if (ret < 0)
858 return ret;
859
860 timeout = 0;
861 do {
862 msleep(10);
863 ret = smsc95xx_read_reg(dev, PM_CTRL, &read_buf);
864 if (ret < 0)
865 return ret;
866 timeout++;
867 } while ((read_buf & PM_CTL_PHY_RST_) && (timeout < 100));
868
869 if (timeout >= 100) {
870 netdev_warn(dev->net, "timeout waiting for PHY Reset\n");
871 return ret;
872 }
873
874 ret = smsc95xx_set_mac_address(dev);
875 if (ret < 0)
876 return ret;
877
878 netif_dbg(dev, ifup, dev->net, "MAC Address: %pM\n",
879 dev->net->dev_addr);
880
881 ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
882 if (ret < 0)
883 return ret;
884
885 netif_dbg(dev, ifup, dev->net, "Read Value from HW_CFG : 0x%08x\n",
886 read_buf);
887
888 read_buf |= HW_CFG_BIR_;
889
890 ret = smsc95xx_write_reg(dev, HW_CFG, read_buf);
891 if (ret < 0)
892 return ret;
893
894 ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
895 if (ret < 0)
896 return ret;
897
898 netif_dbg(dev, ifup, dev->net,
899 "Read Value from HW_CFG after writing HW_CFG_BIR_: 0x%08x\n",
900 read_buf);
901
902 if (!turbo_mode) {
903 burst_cap = 0;
904 dev->rx_urb_size = MAX_SINGLE_PACKET_SIZE;
905 } else if (dev->udev->speed == USB_SPEED_HIGH) {
906 burst_cap = DEFAULT_HS_BURST_CAP_SIZE / HS_USB_PKT_SIZE;
907 dev->rx_urb_size = DEFAULT_HS_BURST_CAP_SIZE;
908 } else {
909 burst_cap = DEFAULT_FS_BURST_CAP_SIZE / FS_USB_PKT_SIZE;
910 dev->rx_urb_size = DEFAULT_FS_BURST_CAP_SIZE;
911 }
912
913 netif_dbg(dev, ifup, dev->net, "rx_urb_size=%ld\n",
914 (ulong)dev->rx_urb_size);
915
916 ret = smsc95xx_write_reg(dev, BURST_CAP, burst_cap);
917 if (ret < 0)
918 return ret;
919
920 ret = smsc95xx_read_reg(dev, BURST_CAP, &read_buf);
921 if (ret < 0)
922 return ret;
923
924 netif_dbg(dev, ifup, dev->net,
925 "Read Value from BURST_CAP after writing: 0x%08x\n",
926 read_buf);
927
928 ret = smsc95xx_write_reg(dev, BULK_IN_DLY, DEFAULT_BULK_IN_DELAY);
929 if (ret < 0)
930 return ret;
931
932 ret = smsc95xx_read_reg(dev, BULK_IN_DLY, &read_buf);
933 if (ret < 0)
934 return ret;
935
936 netif_dbg(dev, ifup, dev->net,
937 "Read Value from BULK_IN_DLY after writing: 0x%08x\n",
938 read_buf);
939
940 ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
941 if (ret < 0)
942 return ret;
943
944 netif_dbg(dev, ifup, dev->net, "Read Value from HW_CFG: 0x%08x\n",
945 read_buf);
946
947 if (turbo_mode)
948 read_buf |= (HW_CFG_MEF_ | HW_CFG_BCE_);
949
950 read_buf &= ~HW_CFG_RXDOFF_;
951
952 /* set Rx data offset=2, Make IP header aligns on word boundary. */
953 read_buf |= NET_IP_ALIGN << 9;
954
955 ret = smsc95xx_write_reg(dev, HW_CFG, read_buf);
956 if (ret < 0)
957 return ret;
958
959 ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
960 if (ret < 0)
961 return ret;
962
963 netif_dbg(dev, ifup, dev->net,
964 "Read Value from HW_CFG after writing: 0x%08x\n", read_buf);
965
966 ret = smsc95xx_write_reg(dev, INT_STS, INT_STS_CLEAR_ALL_);
967 if (ret < 0)
968 return ret;
969
970 ret = smsc95xx_read_reg(dev, ID_REV, &read_buf);
971 if (ret < 0)
972 return ret;
973 netif_dbg(dev, ifup, dev->net, "ID_REV = 0x%08x\n", read_buf);
974
975 /* Configure GPIO pins as LED outputs */
976 write_buf = LED_GPIO_CFG_SPD_LED | LED_GPIO_CFG_LNK_LED |
977 LED_GPIO_CFG_FDX_LED;
978 ret = smsc95xx_write_reg(dev, LED_GPIO_CFG, write_buf);
979 if (ret < 0)
980 return ret;
981
982 /* Init Tx */
983 ret = smsc95xx_write_reg(dev, FLOW, 0);
984 if (ret < 0)
985 return ret;
986
987 ret = smsc95xx_write_reg(dev, AFC_CFG, AFC_CFG_DEFAULT);
988 if (ret < 0)
989 return ret;
990
991 /* Don't need mac_cr_lock during initialisation */
992 ret = smsc95xx_read_reg(dev, MAC_CR, &pdata->mac_cr);
993 if (ret < 0)
994 return ret;
995
996 /* Init Rx */
997 /* Set Vlan */
998 ret = smsc95xx_write_reg(dev, VLAN1, (u32)ETH_P_8021Q);
999 if (ret < 0)
1000 return ret;
1001
1002 /* Enable or disable checksum offload engines */
1003 ret = smsc95xx_set_features(dev->net, dev->net->features);
1004 if (ret < 0) {
1005 netdev_warn(dev->net, "Failed to set checksum offload features\n");
1006 return ret;
1007 }
1008
1009 smsc95xx_set_multicast(dev->net);
1010
1011 ret = smsc95xx_read_reg(dev, INT_EP_CTL, &read_buf);
1012 if (ret < 0)
1013 return ret;
1014
1015 /* enable PHY interrupts */
1016 read_buf |= INT_EP_CTL_PHY_INT_;
1017
1018 ret = smsc95xx_write_reg(dev, INT_EP_CTL, read_buf);
1019 if (ret < 0)
1020 return ret;
1021
1022 ret = smsc95xx_start_tx_path(dev);
1023 if (ret < 0) {
1024 netdev_warn(dev->net, "Failed to start TX path\n");
1025 return ret;
1026 }
1027
1028 ret = smsc95xx_start_rx_path(dev, 0);
1029 if (ret < 0) {
1030 netdev_warn(dev->net, "Failed to start RX path\n");
1031 return ret;
1032 }
1033
1034 netif_dbg(dev, ifup, dev->net, "smsc95xx_reset, return 0\n");
1035 return 0;
1036}
1037
1038static const struct net_device_ops smsc95xx_netdev_ops = {
1039 .ndo_open = usbnet_open,
1040 .ndo_stop = usbnet_stop,
1041 .ndo_start_xmit = usbnet_start_xmit,
1042 .ndo_tx_timeout = usbnet_tx_timeout,
1043 .ndo_change_mtu = usbnet_change_mtu,
1044 .ndo_get_stats64 = dev_get_tstats64,
1045 .ndo_set_mac_address = eth_mac_addr,
1046 .ndo_validate_addr = eth_validate_addr,
1047 .ndo_do_ioctl = smsc95xx_ioctl,
1048 .ndo_set_rx_mode = smsc95xx_set_multicast,
1049 .ndo_set_features = smsc95xx_set_features,
1050};
1051
1052static int smsc95xx_bind(struct usbnet *dev, struct usb_interface *intf)
1053{
1054 struct smsc95xx_priv *pdata;
1055 bool is_internal_phy;
1056 u32 val;
1057 int ret;
1058
1059 printk(KERN_INFO SMSC_CHIPNAME " v" SMSC_DRIVER_VERSION "\n");
1060
1061 ret = usbnet_get_endpoints(dev, intf);
1062 if (ret < 0) {
1063 netdev_warn(dev->net, "usbnet_get_endpoints failed: %d\n", ret);
1064 return ret;
1065 }
1066
1067 pdata = kzalloc(sizeof(*pdata), GFP_KERNEL);
1068 if (!pdata)
1069 return -ENOMEM;
1070
1071 dev->driver_priv = pdata;
1072
1073 spin_lock_init(&pdata->mac_cr_lock);
1074
1075 /* LAN95xx devices do not alter the computed checksum of 0 to 0xffff.
1076 * RFC 2460, ipv6 UDP calculated checksum yields a result of zero must
1077 * be changed to 0xffff. RFC 768, ipv4 UDP computed checksum is zero,
1078 * it is transmitted as all ones. The zero transmitted checksum means
1079 * transmitter generated no checksum. Hence, enable csum offload only
1080 * for ipv4 packets.
1081 */
1082 if (DEFAULT_TX_CSUM_ENABLE)
1083 dev->net->features |= NETIF_F_IP_CSUM;
1084 if (DEFAULT_RX_CSUM_ENABLE)
1085 dev->net->features |= NETIF_F_RXCSUM;
1086
1087 dev->net->hw_features = NETIF_F_IP_CSUM | NETIF_F_RXCSUM;
1088 set_bit(EVENT_NO_IP_ALIGN, &dev->flags);
1089
1090 smsc95xx_init_mac_address(dev);
1091
1092 /* Init all registers */
1093 ret = smsc95xx_reset(dev);
1094 if (ret)
1095 goto free_pdata;
1096
1097 pdata->mdiobus = mdiobus_alloc();
1098 if (!pdata->mdiobus) {
1099 ret = -ENOMEM;
1100 goto free_pdata;
1101 }
1102
1103 ret = smsc95xx_read_reg(dev, HW_CFG, &val);
1104 if (ret < 0)
1105 goto free_mdio;
1106
1107 is_internal_phy = !(val & HW_CFG_PSEL_);
1108 if (is_internal_phy)
1109 pdata->mdiobus->phy_mask = ~(1u << SMSC95XX_INTERNAL_PHY_ID);
1110
1111 pdata->mdiobus->priv = dev;
1112 pdata->mdiobus->read = smsc95xx_mdiobus_read;
1113 pdata->mdiobus->write = smsc95xx_mdiobus_write;
1114 pdata->mdiobus->name = "smsc95xx-mdiobus";
1115 pdata->mdiobus->parent = &dev->udev->dev;
1116
1117 snprintf(pdata->mdiobus->id, ARRAY_SIZE(pdata->mdiobus->id),
1118 "usb-%03d:%03d", dev->udev->bus->busnum, dev->udev->devnum);
1119
1120 ret = mdiobus_register(pdata->mdiobus);
1121 if (ret) {
1122 netdev_err(dev->net, "Could not register MDIO bus\n");
1123 goto free_mdio;
1124 }
1125
1126 pdata->phydev = phy_find_first(pdata->mdiobus);
1127 if (!pdata->phydev) {
1128 netdev_err(dev->net, "no PHY found\n");
1129 ret = -ENODEV;
1130 goto unregister_mdio;
1131 }
1132
1133 pdata->phydev->is_internal = is_internal_phy;
1134
1135 /* detect device revision as different features may be available */
1136 ret = smsc95xx_read_reg(dev, ID_REV, &val);
1137 if (ret < 0)
1138 goto unregister_mdio;
1139
1140 val >>= 16;
1141 if ((val == ID_REV_CHIP_ID_9500A_) || (val == ID_REV_CHIP_ID_9530_) ||
1142 (val == ID_REV_CHIP_ID_89530_) || (val == ID_REV_CHIP_ID_9730_))
1143 pdata->features = (FEATURE_8_WAKEUP_FILTERS |
1144 FEATURE_PHY_NLP_CROSSOVER |
1145 FEATURE_REMOTE_WAKEUP);
1146 else if (val == ID_REV_CHIP_ID_9512_)
1147 pdata->features = FEATURE_8_WAKEUP_FILTERS;
1148
1149 dev->net->netdev_ops = &smsc95xx_netdev_ops;
1150 dev->net->ethtool_ops = &smsc95xx_ethtool_ops;
1151 dev->net->flags |= IFF_MULTICAST;
1152 dev->net->hard_header_len += SMSC95XX_TX_OVERHEAD_CSUM;
1153 dev->net->min_mtu = ETH_MIN_MTU;
1154 dev->net->max_mtu = ETH_DATA_LEN;
1155 dev->hard_mtu = dev->net->mtu + dev->net->hard_header_len;
1156 return 0;
1157
1158unregister_mdio:
1159 mdiobus_unregister(pdata->mdiobus);
1160
1161free_mdio:
1162 mdiobus_free(pdata->mdiobus);
1163
1164free_pdata:
1165 kfree(pdata);
1166 return ret;
1167}
1168
1169static void smsc95xx_unbind(struct usbnet *dev, struct usb_interface *intf)
1170{
1171 struct smsc95xx_priv *pdata = dev->driver_priv;
1172
1173 mdiobus_unregister(pdata->mdiobus);
1174 mdiobus_free(pdata->mdiobus);
1175 netif_dbg(dev, ifdown, dev->net, "free pdata\n");
1176 kfree(pdata);
1177}
1178
1179static void smsc95xx_handle_link_change(struct net_device *net)
1180{
1181 struct usbnet *dev = netdev_priv(net);
1182
1183 phy_print_status(net->phydev);
1184 usbnet_defer_kevent(dev, EVENT_LINK_CHANGE);
1185}
1186
1187static int smsc95xx_start_phy(struct usbnet *dev)
1188{
1189 struct smsc95xx_priv *pdata = dev->driver_priv;
1190 struct net_device *net = dev->net;
1191 int ret;
1192
1193 ret = smsc95xx_reset(dev);
1194 if (ret < 0)
1195 return ret;
1196
1197 ret = phy_connect_direct(net, pdata->phydev,
1198 &smsc95xx_handle_link_change,
1199 PHY_INTERFACE_MODE_MII);
1200 if (ret) {
1201 netdev_err(net, "can't attach PHY to %s\n", pdata->mdiobus->id);
1202 return ret;
1203 }
1204
1205 phy_attached_info(net->phydev);
1206 phy_start(net->phydev);
1207 return 0;
1208}
1209
1210static int smsc95xx_disconnect_phy(struct usbnet *dev)
1211{
1212 phy_stop(dev->net->phydev);
1213 phy_disconnect(dev->net->phydev);
1214 return 0;
1215}
1216
1217static u32 smsc_crc(const u8 *buffer, size_t len, int filter)
1218{
1219 u32 crc = bitrev16(crc16(0xFFFF, buffer, len));
1220 return crc << ((filter % 2) * 16);
1221}
1222
1223static int smsc95xx_enable_phy_wakeup_interrupts(struct usbnet *dev, u16 mask)
1224{
1225 int ret;
1226
1227 netdev_dbg(dev->net, "enabling PHY wakeup interrupts\n");
1228
1229 /* read to clear */
1230 ret = smsc95xx_mdio_read_nopm(dev, PHY_INT_SRC);
1231 if (ret < 0)
1232 return ret;
1233
1234 /* enable interrupt source */
1235 ret = smsc95xx_mdio_read_nopm(dev, PHY_INT_MASK);
1236 if (ret < 0)
1237 return ret;
1238
1239 ret |= mask;
1240
1241 smsc95xx_mdio_write_nopm(dev, PHY_INT_MASK, ret);
1242
1243 return 0;
1244}
1245
1246static int smsc95xx_link_ok_nopm(struct usbnet *dev)
1247{
1248 int ret;
1249
1250 /* first, a dummy read, needed to latch some MII phys */
1251 ret = smsc95xx_mdio_read_nopm(dev, MII_BMSR);
1252 if (ret < 0)
1253 return ret;
1254
1255 ret = smsc95xx_mdio_read_nopm(dev, MII_BMSR);
1256 if (ret < 0)
1257 return ret;
1258
1259 return !!(ret & BMSR_LSTATUS);
1260}
1261
1262static int smsc95xx_enter_suspend0(struct usbnet *dev)
1263{
1264 struct smsc95xx_priv *pdata = dev->driver_priv;
1265 u32 val;
1266 int ret;
1267
1268 ret = smsc95xx_read_reg_nopm(dev, PM_CTRL, &val);
1269 if (ret < 0)
1270 return ret;
1271
1272 val &= (~(PM_CTL_SUS_MODE_ | PM_CTL_WUPS_ | PM_CTL_PHY_RST_));
1273 val |= PM_CTL_SUS_MODE_0;
1274
1275 ret = smsc95xx_write_reg_nopm(dev, PM_CTRL, val);
1276 if (ret < 0)
1277 return ret;
1278
1279 /* clear wol status */
1280 val &= ~PM_CTL_WUPS_;
1281 val |= PM_CTL_WUPS_WOL_;
1282
1283 /* enable energy detection */
1284 if (pdata->wolopts & WAKE_PHY)
1285 val |= PM_CTL_WUPS_ED_;
1286
1287 ret = smsc95xx_write_reg_nopm(dev, PM_CTRL, val);
1288 if (ret < 0)
1289 return ret;
1290
1291 /* read back PM_CTRL */
1292 ret = smsc95xx_read_reg_nopm(dev, PM_CTRL, &val);
1293 if (ret < 0)
1294 return ret;
1295
1296 pdata->suspend_flags |= SUSPEND_SUSPEND0;
1297
1298 return 0;
1299}
1300
1301static int smsc95xx_enter_suspend1(struct usbnet *dev)
1302{
1303 struct smsc95xx_priv *pdata = dev->driver_priv;
1304 u32 val;
1305 int ret;
1306
1307 /* reconfigure link pulse detection timing for
1308 * compatibility with non-standard link partners
1309 */
1310 if (pdata->features & FEATURE_PHY_NLP_CROSSOVER)
1311 smsc95xx_mdio_write_nopm(dev, PHY_EDPD_CONFIG,
1312 PHY_EDPD_CONFIG_DEFAULT);
1313
1314 /* enable energy detect power-down mode */
1315 ret = smsc95xx_mdio_read_nopm(dev, PHY_MODE_CTRL_STS);
1316 if (ret < 0)
1317 return ret;
1318
1319 ret |= MODE_CTRL_STS_EDPWRDOWN_;
1320
1321 smsc95xx_mdio_write_nopm(dev, PHY_MODE_CTRL_STS, ret);
1322
1323 /* enter SUSPEND1 mode */
1324 ret = smsc95xx_read_reg_nopm(dev, PM_CTRL, &val);
1325 if (ret < 0)
1326 return ret;
1327
1328 val &= ~(PM_CTL_SUS_MODE_ | PM_CTL_WUPS_ | PM_CTL_PHY_RST_);
1329 val |= PM_CTL_SUS_MODE_1;
1330
1331 ret = smsc95xx_write_reg_nopm(dev, PM_CTRL, val);
1332 if (ret < 0)
1333 return ret;
1334
1335 /* clear wol status, enable energy detection */
1336 val &= ~PM_CTL_WUPS_;
1337 val |= (PM_CTL_WUPS_ED_ | PM_CTL_ED_EN_);
1338
1339 ret = smsc95xx_write_reg_nopm(dev, PM_CTRL, val);
1340 if (ret < 0)
1341 return ret;
1342
1343 pdata->suspend_flags |= SUSPEND_SUSPEND1;
1344
1345 return 0;
1346}
1347
1348static int smsc95xx_enter_suspend2(struct usbnet *dev)
1349{
1350 struct smsc95xx_priv *pdata = dev->driver_priv;
1351 u32 val;
1352 int ret;
1353
1354 ret = smsc95xx_read_reg_nopm(dev, PM_CTRL, &val);
1355 if (ret < 0)
1356 return ret;
1357
1358 val &= ~(PM_CTL_SUS_MODE_ | PM_CTL_WUPS_ | PM_CTL_PHY_RST_);
1359 val |= PM_CTL_SUS_MODE_2;
1360
1361 ret = smsc95xx_write_reg_nopm(dev, PM_CTRL, val);
1362 if (ret < 0)
1363 return ret;
1364
1365 pdata->suspend_flags |= SUSPEND_SUSPEND2;
1366
1367 return 0;
1368}
1369
1370static int smsc95xx_enter_suspend3(struct usbnet *dev)
1371{
1372 struct smsc95xx_priv *pdata = dev->driver_priv;
1373 u32 val;
1374 int ret;
1375
1376 ret = smsc95xx_read_reg_nopm(dev, RX_FIFO_INF, &val);
1377 if (ret < 0)
1378 return ret;
1379
1380 if (val & RX_FIFO_INF_USED_) {
1381 netdev_info(dev->net, "rx fifo not empty in autosuspend\n");
1382 return -EBUSY;
1383 }
1384
1385 ret = smsc95xx_read_reg_nopm(dev, PM_CTRL, &val);
1386 if (ret < 0)
1387 return ret;
1388
1389 val &= ~(PM_CTL_SUS_MODE_ | PM_CTL_WUPS_ | PM_CTL_PHY_RST_);
1390 val |= PM_CTL_SUS_MODE_3 | PM_CTL_RES_CLR_WKP_STS;
1391
1392 ret = smsc95xx_write_reg_nopm(dev, PM_CTRL, val);
1393 if (ret < 0)
1394 return ret;
1395
1396 /* clear wol status */
1397 val &= ~PM_CTL_WUPS_;
1398 val |= PM_CTL_WUPS_WOL_;
1399
1400 ret = smsc95xx_write_reg_nopm(dev, PM_CTRL, val);
1401 if (ret < 0)
1402 return ret;
1403
1404 pdata->suspend_flags |= SUSPEND_SUSPEND3;
1405
1406 return 0;
1407}
1408
1409static int smsc95xx_autosuspend(struct usbnet *dev, u32 link_up)
1410{
1411 struct smsc95xx_priv *pdata = dev->driver_priv;
1412 int ret;
1413
1414 if (!netif_running(dev->net)) {
1415 /* interface is ifconfig down so fully power down hw */
1416 netdev_dbg(dev->net, "autosuspend entering SUSPEND2\n");
1417 return smsc95xx_enter_suspend2(dev);
1418 }
1419
1420 if (!link_up) {
1421 /* link is down so enter EDPD mode, but only if device can
1422 * reliably resume from it. This check should be redundant
1423 * as current FEATURE_REMOTE_WAKEUP parts also support
1424 * FEATURE_PHY_NLP_CROSSOVER but it's included for clarity */
1425 if (!(pdata->features & FEATURE_PHY_NLP_CROSSOVER)) {
1426 netdev_warn(dev->net, "EDPD not supported\n");
1427 return -EBUSY;
1428 }
1429
1430 netdev_dbg(dev->net, "autosuspend entering SUSPEND1\n");
1431
1432 /* enable PHY wakeup events for if cable is attached */
1433 ret = smsc95xx_enable_phy_wakeup_interrupts(dev,
1434 PHY_INT_MASK_ANEG_COMP_);
1435 if (ret < 0) {
1436 netdev_warn(dev->net, "error enabling PHY wakeup ints\n");
1437 return ret;
1438 }
1439
1440 netdev_info(dev->net, "entering SUSPEND1 mode\n");
1441 return smsc95xx_enter_suspend1(dev);
1442 }
1443
1444 /* enable PHY wakeup events so we remote wakeup if cable is pulled */
1445 ret = smsc95xx_enable_phy_wakeup_interrupts(dev,
1446 PHY_INT_MASK_LINK_DOWN_);
1447 if (ret < 0) {
1448 netdev_warn(dev->net, "error enabling PHY wakeup ints\n");
1449 return ret;
1450 }
1451
1452 netdev_dbg(dev->net, "autosuspend entering SUSPEND3\n");
1453 return smsc95xx_enter_suspend3(dev);
1454}
1455
1456static int smsc95xx_suspend(struct usb_interface *intf, pm_message_t message)
1457{
1458 struct usbnet *dev = usb_get_intfdata(intf);
1459 struct smsc95xx_priv *pdata = dev->driver_priv;
1460 u32 val, link_up;
1461 int ret;
1462
1463 ret = usbnet_suspend(intf, message);
1464 if (ret < 0) {
1465 netdev_warn(dev->net, "usbnet_suspend error\n");
1466 return ret;
1467 }
1468
1469 if (pdata->suspend_flags) {
1470 netdev_warn(dev->net, "error during last resume\n");
1471 pdata->suspend_flags = 0;
1472 }
1473
1474 /* determine if link is up using only _nopm functions */
1475 link_up = smsc95xx_link_ok_nopm(dev);
1476
1477 if (message.event == PM_EVENT_AUTO_SUSPEND &&
1478 (pdata->features & FEATURE_REMOTE_WAKEUP)) {
1479 ret = smsc95xx_autosuspend(dev, link_up);
1480 goto done;
1481 }
1482
1483 /* if we get this far we're not autosuspending */
1484 /* if no wol options set, or if link is down and we're not waking on
1485 * PHY activity, enter lowest power SUSPEND2 mode
1486 */
1487 if (!(pdata->wolopts & SUPPORTED_WAKE) ||
1488 !(link_up || (pdata->wolopts & WAKE_PHY))) {
1489 netdev_info(dev->net, "entering SUSPEND2 mode\n");
1490
1491 /* disable energy detect (link up) & wake up events */
1492 ret = smsc95xx_read_reg_nopm(dev, WUCSR, &val);
1493 if (ret < 0)
1494 goto done;
1495
1496 val &= ~(WUCSR_MPEN_ | WUCSR_WAKE_EN_);
1497
1498 ret = smsc95xx_write_reg_nopm(dev, WUCSR, val);
1499 if (ret < 0)
1500 goto done;
1501
1502 ret = smsc95xx_read_reg_nopm(dev, PM_CTRL, &val);
1503 if (ret < 0)
1504 goto done;
1505
1506 val &= ~(PM_CTL_ED_EN_ | PM_CTL_WOL_EN_);
1507
1508 ret = smsc95xx_write_reg_nopm(dev, PM_CTRL, val);
1509 if (ret < 0)
1510 goto done;
1511
1512 ret = smsc95xx_enter_suspend2(dev);
1513 goto done;
1514 }
1515
1516 if (pdata->wolopts & WAKE_PHY) {
1517 ret = smsc95xx_enable_phy_wakeup_interrupts(dev,
1518 (PHY_INT_MASK_ANEG_COMP_ | PHY_INT_MASK_LINK_DOWN_));
1519 if (ret < 0) {
1520 netdev_warn(dev->net, "error enabling PHY wakeup ints\n");
1521 goto done;
1522 }
1523
1524 /* if link is down then configure EDPD and enter SUSPEND1,
1525 * otherwise enter SUSPEND0 below
1526 */
1527 if (!link_up) {
1528 netdev_info(dev->net, "entering SUSPEND1 mode\n");
1529 ret = smsc95xx_enter_suspend1(dev);
1530 goto done;
1531 }
1532 }
1533
1534 if (pdata->wolopts & (WAKE_BCAST | WAKE_MCAST | WAKE_ARP | WAKE_UCAST)) {
1535 u32 *filter_mask = kcalloc(32, sizeof(u32), GFP_KERNEL);
1536 u32 command[2];
1537 u32 offset[2];
1538 u32 crc[4];
1539 int wuff_filter_count =
1540 (pdata->features & FEATURE_8_WAKEUP_FILTERS) ?
1541 LAN9500A_WUFF_NUM : LAN9500_WUFF_NUM;
1542 int i, filter = 0;
1543
1544 if (!filter_mask) {
1545 netdev_warn(dev->net, "Unable to allocate filter_mask\n");
1546 ret = -ENOMEM;
1547 goto done;
1548 }
1549
1550 memset(command, 0, sizeof(command));
1551 memset(offset, 0, sizeof(offset));
1552 memset(crc, 0, sizeof(crc));
1553
1554 if (pdata->wolopts & WAKE_BCAST) {
1555 const u8 bcast[] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
1556 netdev_info(dev->net, "enabling broadcast detection\n");
1557 filter_mask[filter * 4] = 0x003F;
1558 filter_mask[filter * 4 + 1] = 0x00;
1559 filter_mask[filter * 4 + 2] = 0x00;
1560 filter_mask[filter * 4 + 3] = 0x00;
1561 command[filter/4] |= 0x05UL << ((filter % 4) * 8);
1562 offset[filter/4] |= 0x00 << ((filter % 4) * 8);
1563 crc[filter/2] |= smsc_crc(bcast, 6, filter);
1564 filter++;
1565 }
1566
1567 if (pdata->wolopts & WAKE_MCAST) {
1568 const u8 mcast[] = {0x01, 0x00, 0x5E};
1569 netdev_info(dev->net, "enabling multicast detection\n");
1570 filter_mask[filter * 4] = 0x0007;
1571 filter_mask[filter * 4 + 1] = 0x00;
1572 filter_mask[filter * 4 + 2] = 0x00;
1573 filter_mask[filter * 4 + 3] = 0x00;
1574 command[filter/4] |= 0x09UL << ((filter % 4) * 8);
1575 offset[filter/4] |= 0x00 << ((filter % 4) * 8);
1576 crc[filter/2] |= smsc_crc(mcast, 3, filter);
1577 filter++;
1578 }
1579
1580 if (pdata->wolopts & WAKE_ARP) {
1581 const u8 arp[] = {0x08, 0x06};
1582 netdev_info(dev->net, "enabling ARP detection\n");
1583 filter_mask[filter * 4] = 0x0003;
1584 filter_mask[filter * 4 + 1] = 0x00;
1585 filter_mask[filter * 4 + 2] = 0x00;
1586 filter_mask[filter * 4 + 3] = 0x00;
1587 command[filter/4] |= 0x05UL << ((filter % 4) * 8);
1588 offset[filter/4] |= 0x0C << ((filter % 4) * 8);
1589 crc[filter/2] |= smsc_crc(arp, 2, filter);
1590 filter++;
1591 }
1592
1593 if (pdata->wolopts & WAKE_UCAST) {
1594 netdev_info(dev->net, "enabling unicast detection\n");
1595 filter_mask[filter * 4] = 0x003F;
1596 filter_mask[filter * 4 + 1] = 0x00;
1597 filter_mask[filter * 4 + 2] = 0x00;
1598 filter_mask[filter * 4 + 3] = 0x00;
1599 command[filter/4] |= 0x01UL << ((filter % 4) * 8);
1600 offset[filter/4] |= 0x00 << ((filter % 4) * 8);
1601 crc[filter/2] |= smsc_crc(dev->net->dev_addr, ETH_ALEN, filter);
1602 filter++;
1603 }
1604
1605 for (i = 0; i < (wuff_filter_count * 4); i++) {
1606 ret = smsc95xx_write_reg_nopm(dev, WUFF, filter_mask[i]);
1607 if (ret < 0) {
1608 kfree(filter_mask);
1609 goto done;
1610 }
1611 }
1612 kfree(filter_mask);
1613
1614 for (i = 0; i < (wuff_filter_count / 4); i++) {
1615 ret = smsc95xx_write_reg_nopm(dev, WUFF, command[i]);
1616 if (ret < 0)
1617 goto done;
1618 }
1619
1620 for (i = 0; i < (wuff_filter_count / 4); i++) {
1621 ret = smsc95xx_write_reg_nopm(dev, WUFF, offset[i]);
1622 if (ret < 0)
1623 goto done;
1624 }
1625
1626 for (i = 0; i < (wuff_filter_count / 2); i++) {
1627 ret = smsc95xx_write_reg_nopm(dev, WUFF, crc[i]);
1628 if (ret < 0)
1629 goto done;
1630 }
1631
1632 /* clear any pending pattern match packet status */
1633 ret = smsc95xx_read_reg_nopm(dev, WUCSR, &val);
1634 if (ret < 0)
1635 goto done;
1636
1637 val |= WUCSR_WUFR_;
1638
1639 ret = smsc95xx_write_reg_nopm(dev, WUCSR, val);
1640 if (ret < 0)
1641 goto done;
1642 }
1643
1644 if (pdata->wolopts & WAKE_MAGIC) {
1645 /* clear any pending magic packet status */
1646 ret = smsc95xx_read_reg_nopm(dev, WUCSR, &val);
1647 if (ret < 0)
1648 goto done;
1649
1650 val |= WUCSR_MPR_;
1651
1652 ret = smsc95xx_write_reg_nopm(dev, WUCSR, val);
1653 if (ret < 0)
1654 goto done;
1655 }
1656
1657 /* enable/disable wakeup sources */
1658 ret = smsc95xx_read_reg_nopm(dev, WUCSR, &val);
1659 if (ret < 0)
1660 goto done;
1661
1662 if (pdata->wolopts & (WAKE_BCAST | WAKE_MCAST | WAKE_ARP | WAKE_UCAST)) {
1663 netdev_info(dev->net, "enabling pattern match wakeup\n");
1664 val |= WUCSR_WAKE_EN_;
1665 } else {
1666 netdev_info(dev->net, "disabling pattern match wakeup\n");
1667 val &= ~WUCSR_WAKE_EN_;
1668 }
1669
1670 if (pdata->wolopts & WAKE_MAGIC) {
1671 netdev_info(dev->net, "enabling magic packet wakeup\n");
1672 val |= WUCSR_MPEN_;
1673 } else {
1674 netdev_info(dev->net, "disabling magic packet wakeup\n");
1675 val &= ~WUCSR_MPEN_;
1676 }
1677
1678 ret = smsc95xx_write_reg_nopm(dev, WUCSR, val);
1679 if (ret < 0)
1680 goto done;
1681
1682 /* enable wol wakeup source */
1683 ret = smsc95xx_read_reg_nopm(dev, PM_CTRL, &val);
1684 if (ret < 0)
1685 goto done;
1686
1687 val |= PM_CTL_WOL_EN_;
1688
1689 /* phy energy detect wakeup source */
1690 if (pdata->wolopts & WAKE_PHY)
1691 val |= PM_CTL_ED_EN_;
1692
1693 ret = smsc95xx_write_reg_nopm(dev, PM_CTRL, val);
1694 if (ret < 0)
1695 goto done;
1696
1697 /* enable receiver to enable frame reception */
1698 smsc95xx_start_rx_path(dev, 1);
1699
1700 /* some wol options are enabled, so enter SUSPEND0 */
1701 netdev_info(dev->net, "entering SUSPEND0 mode\n");
1702 ret = smsc95xx_enter_suspend0(dev);
1703
1704done:
1705 /*
1706 * TODO: resume() might need to handle the suspend failure
1707 * in system sleep
1708 */
1709 if (ret && PMSG_IS_AUTO(message))
1710 usbnet_resume(intf);
1711
1712 return ret;
1713}
1714
1715static int smsc95xx_resume(struct usb_interface *intf)
1716{
1717 struct usbnet *dev = usb_get_intfdata(intf);
1718 struct smsc95xx_priv *pdata;
1719 u8 suspend_flags;
1720 int ret;
1721 u32 val;
1722
1723 BUG_ON(!dev);
1724 pdata = dev->driver_priv;
1725 suspend_flags = pdata->suspend_flags;
1726
1727 netdev_dbg(dev->net, "resume suspend_flags=0x%02x\n", suspend_flags);
1728
1729 /* do this first to ensure it's cleared even in error case */
1730 pdata->suspend_flags = 0;
1731
1732 if (suspend_flags & SUSPEND_ALLMODES) {
1733 /* clear wake-up sources */
1734 ret = smsc95xx_read_reg_nopm(dev, WUCSR, &val);
1735 if (ret < 0)
1736 return ret;
1737
1738 val &= ~(WUCSR_WAKE_EN_ | WUCSR_MPEN_);
1739
1740 ret = smsc95xx_write_reg_nopm(dev, WUCSR, val);
1741 if (ret < 0)
1742 return ret;
1743
1744 /* clear wake-up status */
1745 ret = smsc95xx_read_reg_nopm(dev, PM_CTRL, &val);
1746 if (ret < 0)
1747 return ret;
1748
1749 val &= ~PM_CTL_WOL_EN_;
1750 val |= PM_CTL_WUPS_;
1751
1752 ret = smsc95xx_write_reg_nopm(dev, PM_CTRL, val);
1753 if (ret < 0)
1754 return ret;
1755 }
1756
1757 ret = usbnet_resume(intf);
1758 if (ret < 0)
1759 netdev_warn(dev->net, "usbnet_resume error\n");
1760
1761 phy_init_hw(pdata->phydev);
1762 return ret;
1763}
1764
1765static int smsc95xx_reset_resume(struct usb_interface *intf)
1766{
1767 struct usbnet *dev = usb_get_intfdata(intf);
1768 int ret;
1769
1770 ret = smsc95xx_reset(dev);
1771 if (ret < 0)
1772 return ret;
1773
1774 return smsc95xx_resume(intf);
1775}
1776
1777static void smsc95xx_rx_csum_offload(struct sk_buff *skb)
1778{
1779 skb->csum = *(u16 *)(skb_tail_pointer(skb) - 2);
1780 skb->ip_summed = CHECKSUM_COMPLETE;
1781 skb_trim(skb, skb->len - 2);
1782}
1783
1784static int smsc95xx_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
1785{
1786 /* This check is no longer done by usbnet */
1787 if (skb->len < dev->net->hard_header_len)
1788 return 0;
1789
1790 while (skb->len > 0) {
1791 u32 header, align_count;
1792 struct sk_buff *ax_skb;
1793 unsigned char *packet;
1794 u16 size;
1795
1796 header = get_unaligned_le32(skb->data);
1797 skb_pull(skb, 4 + NET_IP_ALIGN);
1798 packet = skb->data;
1799
1800 /* get the packet length */
1801 size = (u16)((header & RX_STS_FL_) >> 16);
1802 align_count = (4 - ((size + NET_IP_ALIGN) % 4)) % 4;
1803
1804 if (unlikely(header & RX_STS_ES_)) {
1805 netif_dbg(dev, rx_err, dev->net,
1806 "Error header=0x%08x\n", header);
1807 dev->net->stats.rx_errors++;
1808 dev->net->stats.rx_dropped++;
1809
1810 if (header & RX_STS_CRC_) {
1811 dev->net->stats.rx_crc_errors++;
1812 } else {
1813 if (header & (RX_STS_TL_ | RX_STS_RF_))
1814 dev->net->stats.rx_frame_errors++;
1815
1816 if ((header & RX_STS_LE_) &&
1817 (!(header & RX_STS_FT_)))
1818 dev->net->stats.rx_length_errors++;
1819 }
1820 } else {
1821 /* ETH_FRAME_LEN + 4(CRC) + 2(COE) + 4(Vlan) */
1822 if (unlikely(size > (ETH_FRAME_LEN + 12))) {
1823 netif_dbg(dev, rx_err, dev->net,
1824 "size err header=0x%08x\n", header);
1825 return 0;
1826 }
1827
1828 /* last frame in this batch */
1829 if (skb->len == size) {
1830 if (dev->net->features & NETIF_F_RXCSUM)
1831 smsc95xx_rx_csum_offload(skb);
1832 skb_trim(skb, skb->len - 4); /* remove fcs */
1833 skb->truesize = size + sizeof(struct sk_buff);
1834
1835 return 1;
1836 }
1837
1838 ax_skb = skb_clone(skb, GFP_ATOMIC);
1839 if (unlikely(!ax_skb)) {
1840 netdev_warn(dev->net, "Error allocating skb\n");
1841 return 0;
1842 }
1843
1844 ax_skb->len = size;
1845 ax_skb->data = packet;
1846 skb_set_tail_pointer(ax_skb, size);
1847
1848 if (dev->net->features & NETIF_F_RXCSUM)
1849 smsc95xx_rx_csum_offload(ax_skb);
1850 skb_trim(ax_skb, ax_skb->len - 4); /* remove fcs */
1851 ax_skb->truesize = size + sizeof(struct sk_buff);
1852
1853 usbnet_skb_return(dev, ax_skb);
1854 }
1855
1856 skb_pull(skb, size);
1857
1858 /* padding bytes before the next frame starts */
1859 if (skb->len)
1860 skb_pull(skb, align_count);
1861 }
1862
1863 return 1;
1864}
1865
1866static u32 smsc95xx_calc_csum_preamble(struct sk_buff *skb)
1867{
1868 u16 low_16 = (u16)skb_checksum_start_offset(skb);
1869 u16 high_16 = low_16 + skb->csum_offset;
1870 return (high_16 << 16) | low_16;
1871}
1872
1873/* The TX CSUM won't work if the checksum lies in the last 4 bytes of the
1874 * transmission. This is fairly unlikely, only seems to trigger with some
1875 * short TCP ACK packets sent.
1876 *
1877 * Note, this calculation should probably check for the alignment of the
1878 * data as well, but a straight check for csum being in the last four bytes
1879 * of the packet should be ok for now.
1880 */
1881static bool smsc95xx_can_tx_checksum(struct sk_buff *skb)
1882{
1883 unsigned int len = skb->len - skb_checksum_start_offset(skb);
1884
1885 if (skb->len <= 45)
1886 return false;
1887 return skb->csum_offset < (len - (4 + 1));
1888}
1889
1890static struct sk_buff *smsc95xx_tx_fixup(struct usbnet *dev,
1891 struct sk_buff *skb, gfp_t flags)
1892{
1893 bool csum = skb->ip_summed == CHECKSUM_PARTIAL;
1894 int overhead = csum ? SMSC95XX_TX_OVERHEAD_CSUM : SMSC95XX_TX_OVERHEAD;
1895 u32 tx_cmd_a, tx_cmd_b;
1896 void *ptr;
1897
1898 /* We do not advertise SG, so skbs should be already linearized */
1899 BUG_ON(skb_shinfo(skb)->nr_frags);
1900
1901 /* Make writable and expand header space by overhead if required */
1902 if (skb_cow_head(skb, overhead)) {
1903 /* Must deallocate here as returning NULL to indicate error
1904 * means the skb won't be deallocated in the caller.
1905 */
1906 dev_kfree_skb_any(skb);
1907 return NULL;
1908 }
1909
1910 tx_cmd_b = (u32)skb->len;
1911 tx_cmd_a = tx_cmd_b | TX_CMD_A_FIRST_SEG_ | TX_CMD_A_LAST_SEG_;
1912
1913 if (csum) {
1914 if (!smsc95xx_can_tx_checksum(skb)) {
1915 /* workaround - hardware tx checksum does not work
1916 * properly with extremely small packets */
1917 long csstart = skb_checksum_start_offset(skb);
1918 __wsum calc = csum_partial(skb->data + csstart,
1919 skb->len - csstart, 0);
1920 *((__sum16 *)(skb->data + csstart
1921 + skb->csum_offset)) = csum_fold(calc);
1922
1923 csum = false;
1924 } else {
1925 u32 csum_preamble = smsc95xx_calc_csum_preamble(skb);
1926 ptr = skb_push(skb, 4);
1927 put_unaligned_le32(csum_preamble, ptr);
1928
1929 tx_cmd_a += 4;
1930 tx_cmd_b += 4;
1931 tx_cmd_b |= TX_CMD_B_CSUM_ENABLE;
1932 }
1933 }
1934
1935 ptr = skb_push(skb, 8);
1936 put_unaligned_le32(tx_cmd_a, ptr);
1937 put_unaligned_le32(tx_cmd_b, ptr+4);
1938
1939 return skb;
1940}
1941
1942static int smsc95xx_manage_power(struct usbnet *dev, int on)
1943{
1944 struct smsc95xx_priv *pdata = dev->driver_priv;
1945
1946 dev->intf->needs_remote_wakeup = on;
1947
1948 if (pdata->features & FEATURE_REMOTE_WAKEUP)
1949 return 0;
1950
1951 /* this chip revision isn't capable of remote wakeup */
1952 netdev_info(dev->net, "hardware isn't capable of remote wakeup\n");
1953
1954 if (on)
1955 usb_autopm_get_interface_no_resume(dev->intf);
1956 else
1957 usb_autopm_put_interface(dev->intf);
1958
1959 return 0;
1960}
1961
1962static const struct driver_info smsc95xx_info = {
1963 .description = "smsc95xx USB 2.0 Ethernet",
1964 .bind = smsc95xx_bind,
1965 .unbind = smsc95xx_unbind,
1966 .link_reset = smsc95xx_link_reset,
1967 .reset = smsc95xx_start_phy,
1968 .stop = smsc95xx_disconnect_phy,
1969 .rx_fixup = smsc95xx_rx_fixup,
1970 .tx_fixup = smsc95xx_tx_fixup,
1971 .status = smsc95xx_status,
1972 .manage_power = smsc95xx_manage_power,
1973 .flags = FLAG_ETHER | FLAG_SEND_ZLP | FLAG_LINK_INTR,
1974};
1975
1976static const struct usb_device_id products[] = {
1977 {
1978 /* SMSC9500 USB Ethernet Device */
1979 USB_DEVICE(0x0424, 0x9500),
1980 .driver_info = (unsigned long) &smsc95xx_info,
1981 },
1982 {
1983 /* SMSC9505 USB Ethernet Device */
1984 USB_DEVICE(0x0424, 0x9505),
1985 .driver_info = (unsigned long) &smsc95xx_info,
1986 },
1987 {
1988 /* SMSC9500A USB Ethernet Device */
1989 USB_DEVICE(0x0424, 0x9E00),
1990 .driver_info = (unsigned long) &smsc95xx_info,
1991 },
1992 {
1993 /* SMSC9505A USB Ethernet Device */
1994 USB_DEVICE(0x0424, 0x9E01),
1995 .driver_info = (unsigned long) &smsc95xx_info,
1996 },
1997 {
1998 /* SMSC9512/9514 USB Hub & Ethernet Device */
1999 USB_DEVICE(0x0424, 0xec00),
2000 .driver_info = (unsigned long) &smsc95xx_info,
2001 },
2002 {
2003 /* SMSC9500 USB Ethernet Device (SAL10) */
2004 USB_DEVICE(0x0424, 0x9900),
2005 .driver_info = (unsigned long) &smsc95xx_info,
2006 },
2007 {
2008 /* SMSC9505 USB Ethernet Device (SAL10) */
2009 USB_DEVICE(0x0424, 0x9901),
2010 .driver_info = (unsigned long) &smsc95xx_info,
2011 },
2012 {
2013 /* SMSC9500A USB Ethernet Device (SAL10) */
2014 USB_DEVICE(0x0424, 0x9902),
2015 .driver_info = (unsigned long) &smsc95xx_info,
2016 },
2017 {
2018 /* SMSC9505A USB Ethernet Device (SAL10) */
2019 USB_DEVICE(0x0424, 0x9903),
2020 .driver_info = (unsigned long) &smsc95xx_info,
2021 },
2022 {
2023 /* SMSC9512/9514 USB Hub & Ethernet Device (SAL10) */
2024 USB_DEVICE(0x0424, 0x9904),
2025 .driver_info = (unsigned long) &smsc95xx_info,
2026 },
2027 {
2028 /* SMSC9500A USB Ethernet Device (HAL) */
2029 USB_DEVICE(0x0424, 0x9905),
2030 .driver_info = (unsigned long) &smsc95xx_info,
2031 },
2032 {
2033 /* SMSC9505A USB Ethernet Device (HAL) */
2034 USB_DEVICE(0x0424, 0x9906),
2035 .driver_info = (unsigned long) &smsc95xx_info,
2036 },
2037 {
2038 /* SMSC9500 USB Ethernet Device (Alternate ID) */
2039 USB_DEVICE(0x0424, 0x9907),
2040 .driver_info = (unsigned long) &smsc95xx_info,
2041 },
2042 {
2043 /* SMSC9500A USB Ethernet Device (Alternate ID) */
2044 USB_DEVICE(0x0424, 0x9908),
2045 .driver_info = (unsigned long) &smsc95xx_info,
2046 },
2047 {
2048 /* SMSC9512/9514 USB Hub & Ethernet Device (Alternate ID) */
2049 USB_DEVICE(0x0424, 0x9909),
2050 .driver_info = (unsigned long) &smsc95xx_info,
2051 },
2052 {
2053 /* SMSC LAN9530 USB Ethernet Device */
2054 USB_DEVICE(0x0424, 0x9530),
2055 .driver_info = (unsigned long) &smsc95xx_info,
2056 },
2057 {
2058 /* SMSC LAN9730 USB Ethernet Device */
2059 USB_DEVICE(0x0424, 0x9730),
2060 .driver_info = (unsigned long) &smsc95xx_info,
2061 },
2062 {
2063 /* SMSC LAN89530 USB Ethernet Device */
2064 USB_DEVICE(0x0424, 0x9E08),
2065 .driver_info = (unsigned long) &smsc95xx_info,
2066 },
2067 { }, /* END */
2068};
2069MODULE_DEVICE_TABLE(usb, products);
2070
2071static struct usb_driver smsc95xx_driver = {
2072 .name = "smsc95xx",
2073 .id_table = products,
2074 .probe = usbnet_probe,
2075 .suspend = smsc95xx_suspend,
2076 .resume = smsc95xx_resume,
2077 .reset_resume = smsc95xx_reset_resume,
2078 .disconnect = usbnet_disconnect,
2079 .disable_hub_initiated_lpm = 1,
2080 .supports_autosuspend = 1,
2081};
2082
2083module_usb_driver(smsc95xx_driver);
2084
2085MODULE_AUTHOR("Nancy Lin");
2086MODULE_AUTHOR("Steve Glendinning <steve.glendinning@shawell.net>");
2087MODULE_DESCRIPTION("SMSC95XX USB 2.0 Ethernet Devices");
2088MODULE_LICENSE("GPL");