1 /*
2 * Davicom DM9620 USB 2.0 10/100Mbps ethernet devices
3 *
4 * Peter Korsgaard <jacmet@sunsite.dk>
5 *
6 * This file is licensed under the terms of the GNU General Public License
7 * version 2. This program is licensed "as is" without any warranty of any
8 * kind, whether express or implied.
9 * V1.0 - ftp fail fixed
10 * V1.1 - model name checking, & ether plug function enhancement [0x4f, 0x20]
11 * V1.2 - init tx/rx checksum
12 * - fix dm_write_shared_word(), bug fix
13 * - fix 10 Mbps link at power saving mode fail
14 * V1.3 - Support kernel 2.6.31
15 * V1.4 - Support eeprom write of ethtool
16 * Support DM9685
17 * Transmit Check Sum Control by Optopn (Source Code Default: Disable)
18 * Recieve Drop Check Sum Error Packet Disable as chip default
19 * V1.5 - Support RK2818 (Debug the Register Function)
20 * V1.6 - Solve compiler issue for Linux 2.6.35
21 * V1.7 - Enable MAC Layer Flow Control and define debug_message for linux version update.
22 * V1.8 - Enable PHY Layer Flow Control, clear debug code, setup default phy_id value is 1.
23 * Update dm9620_mdio_read and dm9620_mdio_write.
24 * Fix bug of ethtool eeprom write
25 * V1.9 - Fixed "deverr" line 367 error in Linux 2.6.38
26 * V2.0 - Fixed "dm9620_set_multicast" function CRC bug.
27 * V2.1 - Add 802.3az for dm9621a
28 * V2.2 - Add PID=0x1269 support CDC mode.
29 * V2.3 - Add PID=0x0269 support CDC mode.
30 * V2.41 - Support Linux 3.6.9
31 * V2.42 - Work to V2.42 according to "DM9620 BulkOut �ɤB����.doc"
32 * V2.43 - Special suport for DM9621A in the table 'products'
33 * V2.45 - Fix the function TxStyle(), correct to be (len%2) from (len%1). 20131211.
34 */
35
36 //#define DEBUG
37 #define LNX_DM9620_VER_STR "V2.45"
38
39
40 #include <linux/module.h>
41 #include <linux/sched.h>
42 #include <linux/stddef.h>
43 #include <linux/init.h>
44 #include <linux/netdevice.h>
45 #include <linux/etherdevice.h>
46 #include <linux/ethtool.h>
47 #include <linux/mii.h>
48 #include <linux/usb.h>
49 #include <linux/crc32.h>
50 #include <linux/usb/usbnet.h>
51 #include <linux/ctype.h>
52 #include <linux/skbuff.h>
53 #include <linux/version.h> // new v1.3
54
55 /* datasheet:
56 http://www.davicom.com.tw
57 */
58
59 /* control requests */
60 #define DM_READ_REGS 0x00
61 #define DM_WRITE_REGS 0x01
62 #define DM_READ_MEMS 0x02
63 #define DM_WRITE_REG 0x03
64 #define DM_WRITE_MEMS 0x05
65 #define DM_WRITE_MEM 0x07
66
67 /* registers */
68 #define DM_NET_CTRL 0x00
69 #define DM_RX_CTRL 0x05
70 #define DM_FLOW_CTRL 0x0a
71 #define DM_SHARED_CTRL 0x0b
72 #define DM_SHARED_ADDR 0x0c
73 #define DM_SHARED_DATA 0x0d /* low + high */
74 #define DM_EE_PHY_L 0x0d
75 #define DM_EE_PHY_H 0x0e
76 #define DM_WAKEUP_CTRL 0x0f
77 #define DM_PHY_ADDR 0x10 /* 6 bytes */
78 #define DM_MCAST_ADDR 0x16 /* 8 bytes */
79 #define DM_GPR_CTRL 0x1e
80 #define DM_GPR_DATA 0x1f
81 #define DM_PID 0x2a
82 #define DM_XPHY_CTRL 0x2e
83 #define DM_TX_CRC_CTRL 0x31
84 #define DM_RX_CRC_CTRL 0x32
85 #define DM_SMIREG 0x91
86 #define USB_CTRL 0xf4
87 #define PHY_SPEC_CFG 20
88 #define DM_TXRX_M 0x5C
89
90 #define MD96XX_EEPROM_MAGIC 0x9620
91 #define DM_MAX_MCAST 64
92 #define DM_MCAST_SIZE 8
93 #define DM_EEPROM_LEN 256
94 #define DM_TX_OVERHEAD 2 /* 2 byte header */
95 #define DM_RX_OVERHEAD_9601 7 /* 3 byte header + 4 byte crc tail */
96 #define DM_RX_OVERHEAD 8 /* 4 byte header + 4 byte crc tail */
97 #define DM_TIMEOUT 1000
98 #define DM_MODE9620 0x80
99 #define DM_TX_CS_EN 0 /* Transmit Check Sum Control */
100 #define DM9620_PHY_ID 1 /* Stone add For kernel read phy register */
101
102 struct dm96xx_priv {
103 //int flag_fail_count; // EVER RX-DBG
104 int flg_txdbg; // NOW TX-DBG
105 u8 mode_9620;
106 u8 tx_fix_mod;
107 };
108 #if defined(DEBUG)
109 #if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,33)
110 #define dm9620_print(__dev, format, args...) netdev_dbg((__dev)->net, format, ##args)
111 #define dm9620_err(__dev, format, args...) netdev_err((__dev)->net, format, ##args)
112 #else if LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,33)
113 #define dm9620_print(dev, format, args...) devdbg(dev, format, ##args)
114 #define dm9620_err(dev, format, args...) deverr(dev, format, ##args)
115 #endif
116 #else
117 #define dm9620_print(dev, format, args...) printk(format, ##args)
118 #define dm9620_err(dev, format, args...) printk(format, ##args)
119 #endif
dm_read(struct usbnet * dev,u8 reg,u16 length,void * data)120 static int dm_read(struct usbnet *dev, u8 reg, u16 length, void *data)
121 {
122 // dm9620_print(dev, "dm_read() reg=0x%02x length=%d", reg, length);
123 return usb_control_msg(dev->udev,
124 usb_rcvctrlpipe(dev->udev, 0),
125 DM_READ_REGS,
126 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
127 0, reg, data, length, USB_CTRL_SET_TIMEOUT); //USB_CTRL_SET_TIMEOUT V.S. USB_CTRL_GET_TIMEOUT
128 }
129
dm_read_reg(struct usbnet * dev,u8 reg,u8 * value)130 static int dm_read_reg(struct usbnet *dev, u8 reg, u8 *value)
131 {
132 u16 *tmpwPtr;
133 int ret;
134 tmpwPtr= kmalloc (2, GFP_ATOMIC);
135 if (!tmpwPtr)
136 {
137 printk("+++++++++++ JJ5 dm_read_reg() Error: can not kmalloc!\n"); //usbnet_suspend (intf, message);
138 return 0;
139 }
140
141 ret = dm_read(dev, reg, 2, tmpwPtr); // usb_submit_urb v.s. usb_control_msg
142 *value= (u8)(*tmpwPtr & 0xff);
143
144 kfree (tmpwPtr);
145 return ret;
146 }
147
dm_write(struct usbnet * dev,u8 reg,u16 length,void * data)148 static int dm_write(struct usbnet *dev, u8 reg, u16 length, void *data)
149 {
150 // dm9620_print(dev, "dm_write() reg=0x%02x, length=%d", reg, length);
151 return usb_control_msg(dev->udev,
152 usb_sndctrlpipe(dev->udev, 0),
153 DM_WRITE_REGS,
154 USB_DIR_OUT | USB_TYPE_VENDOR |USB_RECIP_DEVICE,
155 0, reg, data, length, USB_CTRL_SET_TIMEOUT);
156 }
157
dm_write_reg(struct usbnet * dev,u8 reg,u8 value)158 static int dm_write_reg(struct usbnet *dev, u8 reg, u8 value)
159 {
160 // dm9620_print(dev , "dm_write_reg() reg=0x%02x, value=0x%02x", reg, value);
161 return usb_control_msg(dev->udev,
162 usb_sndctrlpipe(dev->udev, 0),
163 DM_WRITE_REG,
164 USB_DIR_OUT | USB_TYPE_VENDOR |USB_RECIP_DEVICE,
165 value, reg, NULL, 0, USB_CTRL_SET_TIMEOUT);
166 }
167
dm_write_async_callback(struct urb * urb)168 static void dm_write_async_callback(struct urb *urb)
169 {
170 struct usb_ctrlrequest *req = (struct usb_ctrlrequest *)urb->context;
171
172 if (urb->status < 0)
173 printk(KERN_DEBUG "dm_write_async_callback() failed with %d\n",
174 urb->status);
175
176 kfree(req);
177 usb_free_urb(urb);
178 }
179
dm_write_async_helper(struct usbnet * dev,u8 reg,u8 value,u16 length,void * data)180 static void dm_write_async_helper(struct usbnet *dev, u8 reg, u8 value,
181 u16 length, void *data)
182 {
183 struct usb_ctrlrequest *req;
184 struct urb *urb;
185 int status;
186
187 urb = usb_alloc_urb(0, GFP_ATOMIC);
188 if (!urb) {
189 dm9620_err(dev, "Error allocating URB in dm_write_async_helper!");
190 return;
191 }
192
193 req = kmalloc(sizeof(struct usb_ctrlrequest), GFP_ATOMIC);
194 if (!req) {
195 dm9620_err(dev, "Failed to allocate memory for control request");
196 usb_free_urb(urb);
197 return;
198 }
199
200 req->bRequestType = USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE;
201 req->bRequest = length ? DM_WRITE_REGS : DM_WRITE_REG;
202 req->wValue = cpu_to_le16(value);
203 req->wIndex = cpu_to_le16(reg);
204 req->wLength = cpu_to_le16(length);
205
206 usb_fill_control_urb(urb, dev->udev,
207 usb_sndctrlpipe(dev->udev, 0),
208 (void *)req, data, length,
209 dm_write_async_callback, req);
210
211 status = usb_submit_urb(urb, GFP_ATOMIC);
212 if (status < 0) {
213 dm9620_err(dev, "Error submitting the control message: status=%d",
214 status);
215 kfree(req);
216 usb_free_urb(urb);
217 }
218 }
219
dm_write_async(struct usbnet * dev,u8 reg,u16 length,void * data)220 static void dm_write_async(struct usbnet *dev, u8 reg, u16 length, void *data)
221 {
222 // dm9620_print(dev, "dm_write_async() reg=0x%02x length=%d", reg, length);
223 dm_write_async_helper(dev, reg, 0, length, data);
224 }
225
dm_write_reg_async(struct usbnet * dev,u8 reg,u8 value)226 static void dm_write_reg_async(struct usbnet *dev, u8 reg, u8 value)
227 {
228 // dm9620_print(dev, "dm_write_reg_async() reg=0x%02x value=0x%02x",
229 // reg, value);
230
231 dm_write_async_helper(dev, reg, value, 0, NULL);
232 }
233
dm_read_shared_word(struct usbnet * dev,int phy,u8 reg,__le16 * value)234 static int dm_read_shared_word(struct usbnet *dev, int phy, u8 reg, __le16 *value)
235 {
236 int ret, i;
237 u16 *tmpwPtr1;
238
239 mutex_lock(&dev->phy_mutex);
240
241 dm_write_reg(dev, DM_SHARED_ADDR, phy ? (reg | 0x40) : reg);
242 dm_write_reg(dev, DM_SHARED_CTRL, phy ? 0xc : 0x4);
243
244 for (i = 0; i < DM_TIMEOUT; i++) {
245 u8 tmp;
246
247 udelay(1);
248 ret = dm_read_reg(dev, DM_SHARED_CTRL, &tmp);
249 if (ret < 0)
250 goto out;
251
252 /* ready */
253 if ((tmp & 1) == 0)
254 break;
255 }
256
257 if (i == DM_TIMEOUT) {
258 dm9620_err(dev, "%s read timed out!", phy ? "phy" : "eeprom");
259 ret = -EIO;
260 goto out;
261 }
262
263 dm_write_reg(dev, DM_SHARED_CTRL, 0x0);
264 // ret = dm_read(dev, DM_SHARED_DATA, 2, value);
265 //Stone add
266 tmpwPtr1= kmalloc (2, GFP_ATOMIC);
267 if (!tmpwPtr1)
268 {
269 printk("+++++++++++ JJ5 dm_read_reg() Error: can not kmalloc!\n"); //usbnet_suspend (intf, message);
270 return 0;
271 }
272
273 ret = dm_read(dev, DM_SHARED_DATA, 2, tmpwPtr1); // usb_submit_urb v.s. usb_control_msg
274 *value= (u16)(*tmpwPtr1 & 0xffff);
275
276 kfree (tmpwPtr1);
277
278 // dm9620_print(dev, "read shared %d 0x%02x returned 0x%04x, %d",
279 // phy, reg, *value, ret);
280
281 out:
282 mutex_unlock(&dev->phy_mutex);
283 return ret;
284 }
285
dm_write_shared_word(struct usbnet * dev,int phy,u8 reg,__le16 value)286 static int dm_write_shared_word(struct usbnet *dev, int phy, u8 reg, __le16 value)
287 {
288 int ret, i;
289
290 mutex_lock(&dev->phy_mutex);
291
292 ret = dm_write(dev, DM_SHARED_DATA, 2, &value);
293 if (ret < 0)
294 goto out;
295
296 dm_write_reg(dev, DM_SHARED_ADDR, phy ? (reg | 0x40) : reg);
297 if (!phy) dm_write_reg(dev, DM_SHARED_CTRL, 0x10);
298 dm_write_reg(dev, DM_SHARED_CTRL, phy ? 0x0a : 0x12);
299 dm_write_reg(dev, DM_SHARED_CTRL, 0x10);
300
301 for (i = 0; i < DM_TIMEOUT; i++) {
302 u8 tmp;
303
304 udelay(1);
305 ret = dm_read_reg(dev, DM_SHARED_CTRL, &tmp);
306 if (ret < 0)
307 goto out;
308
309 /* ready */
310 if ((tmp & 1) == 0)
311 break;
312 }
313
314 if (i == DM_TIMEOUT) {
315 dm9620_err(dev,"%s write timed out!", phy ? "phy" : "eeprom");
316 ret = -EIO;
317 goto out;
318 }
319
320 dm_write_reg(dev, DM_SHARED_CTRL, 0x0);
321
322 out:
323 mutex_unlock(&dev->phy_mutex);
324 return ret;
325 }
326
327
dm_write_eeprom_word(struct usbnet * dev,int phy,u8 offset,u8 value)328 static int dm_write_eeprom_word(struct usbnet *dev, int phy, u8 offset, u8 value)
329 {
330 int ret, i;
331 u8 reg,dloc,tmp_H,tmp_L;
332 __le16 eeword;
333
334 //devwarn(dev, " offset =0x%x value = 0x%x ", offset,value);
335
336 /* hank: from offset to determin eeprom word register location,reg */
337 reg = (offset >> 1)&0xff;
338
339 /* hank: high/low byte by odd/even of offset */
340 dloc = (offset & 0x01)? DM_EE_PHY_H:DM_EE_PHY_L;
341
342 /* retrieve high and low byte from the corresponding reg*/
343 ret=dm_read_shared_word(dev,0,reg,&eeword);
344 //devwarn(dev, " reg =0x%x dloc = 0x%x eeword = 0x%4x", reg,dloc,eeword);
345 //printk(" reg =0x%x dloc = 0x%x eeword = 0x%4x\n", reg,dloc,eeword);
346
347 tmp_H = (eeword & 0xff);
348 tmp_L = (eeword >> 8);
349
350 printk("tmp_L =0x%2x tmp_H =0x%2x eeword = 0x%4x\n", tmp_L,tmp_H,eeword);
351 /* determine new high and low byte */
352
353 if (offset & 0x01) {
354 tmp_L = value; } else {
355 tmp_H = value; }
356
357 //printk("updated new: tmp_L =0x%2x tmp_H =0x%2x\n", tmp_L,tmp_H);
358
359 mutex_lock(&dev->phy_mutex);
360
361
362 /* hank: write low byte data first to eeprom reg */
363 // dm_write(dev, (offset & 0x01)? DM_EE_PHY_H:DM_EE_PHY_L, 1, &value);
364 dm_write(dev,DM_EE_PHY_L, 1, &tmp_H);
365 /* high byte will be zero */
366 //(offset & 0x01)? (value = eeword << 8):(value = eeword >> 8);
367
368 /* write the not modified 8 bits back to its origional high/low byte reg */
369 dm_write(dev,DM_EE_PHY_H, 1, &tmp_L);
370 if (ret < 0)
371 goto out;
372
373 /* hank : write word location to reg 0x0c */
374 ret = dm_write_reg(dev, DM_SHARED_ADDR, reg);
375
376 if (!phy) dm_write_reg(dev, DM_SHARED_CTRL, 0x10);
377 dm_write_reg(dev, DM_SHARED_CTRL, 0x12);
378 dm_write_reg(dev, DM_SHARED_CTRL, 0x10);
379
380 for (i = 0; i < DM_TIMEOUT; i++) {
381 u8 tmp;
382
383 udelay(1);
384 ret = dm_read_reg(dev, DM_SHARED_CTRL, &tmp);
385 if (ret < 0)
386 goto out;
387
388 /* ready */
389 if ((tmp & 1) == 0)
390 break;
391 }
392
393 if (i == DM_TIMEOUT) {
394 dm9620_err(dev, "%s write timed out!", phy ? "phy" : "eeprom");
395 ret = -EIO;
396 goto out;
397 }
398
399 //dm_write_reg(dev, DM_SHARED_CTRL, 0x0);
400
401 out:
402 mutex_unlock(&dev->phy_mutex);
403 return ret;
404 }
405
dm_read_eeprom_word(struct usbnet * dev,u8 offset,void * value)406 static int dm_read_eeprom_word(struct usbnet *dev, u8 offset, void *value)
407 {
408 return dm_read_shared_word(dev, 0, offset, value);
409 }
410
411
dm9620_set_eeprom(struct net_device * net,struct ethtool_eeprom * eeprom,u8 * data)412 static int dm9620_set_eeprom(struct net_device *net,struct ethtool_eeprom *eeprom, u8 *data)
413 {
414 struct usbnet *dev = netdev_priv(net);
415
416 dm9620_print(dev, "EEPROM: magic value, magic = 0x%x offset =0x%x data = 0x%x ",eeprom->magic, eeprom->offset,*data);
417 if (eeprom->magic != MD96XX_EEPROM_MAGIC) {
418 dm9620_print(dev, "EEPROM: magic value mismatch, magic = 0x%x",
419 eeprom->magic);
420 return -EINVAL;
421 }
422
423 if(dm_write_eeprom_word(dev, 0, eeprom->offset, *data) < 0)
424 return -EINVAL;
425
426 return 0;
427 }
428
dm9620_get_eeprom_len(struct net_device * dev)429 static int dm9620_get_eeprom_len(struct net_device *dev)
430 {
431 return DM_EEPROM_LEN;
432 }
433
dm9620_get_eeprom(struct net_device * net,struct ethtool_eeprom * eeprom,u8 * data)434 static int dm9620_get_eeprom(struct net_device *net,
435 struct ethtool_eeprom *eeprom, u8 * data)
436 {
437 struct usbnet *dev = netdev_priv(net);
438 __le16 *ebuf = (__le16 *) data;
439 int i;
440
441 /* access is 16bit */
442 if ((eeprom->offset % 2) || (eeprom->len % 2))
443 return -EINVAL;
444
445 for (i = 0; i < eeprom->len / 2; i++) {
446 if (dm_read_eeprom_word(dev, eeprom->offset / 2 + i,
447 &ebuf[i]) < 0)
448 return -EINVAL;
449 }
450 return 0;
451 }
452
dm9620_mdio_read(struct net_device * netdev,int phy_id,int loc)453 static int dm9620_mdio_read(struct net_device *netdev, int phy_id, int loc)
454 {
455 struct usbnet *dev = netdev_priv(netdev);
456
457 __le16 res;
458
459 dm_read_shared_word(dev, phy_id, loc, &res);
460
461 // dm9620_print(dev, "dm9620_mdio_read() phy_id=0x%02x, loc=0x%02x, returns=0x%04x",
462 // phy_id, loc, le16_to_cpu(res));
463 return le16_to_cpu(res);
464 }
465
dm9620_mdio_write(struct net_device * netdev,int phy_id,int loc,int val)466 static void dm9620_mdio_write(struct net_device *netdev, int phy_id, int loc,
467 int val)
468 {
469 struct usbnet *dev = netdev_priv(netdev);
470 __le16 res = cpu_to_le16(val);
471 int mdio_val;
472
473 // dm9620_print(dev, "dm9620_mdio_write() phy_id=0x%02x, loc=0x%02x, val=0x%04x",
474 // phy_id, loc, val);
475
476 dm_write_shared_word(dev, phy_id, loc, res);
477 mdelay(1);
478 mdio_val = dm9620_mdio_read(netdev, phy_id, loc);
479
480 }
481
dm9620_get_drvinfo(struct net_device * net,struct ethtool_drvinfo * info)482 static void dm9620_get_drvinfo(struct net_device *net,
483 struct ethtool_drvinfo *info)
484 {
485 /* Inherit standard device info */
486 usbnet_get_drvinfo(net, info);
487 info->eedump_len = DM_EEPROM_LEN;
488 }
489
dm9620_get_link(struct net_device * net)490 static u32 dm9620_get_link(struct net_device *net)
491 {
492 struct usbnet *dev = netdev_priv(net);
493
494 return mii_link_ok(&dev->mii);
495 }
496
dm9620_ioctl(struct net_device * net,struct ifreq * rq,int cmd)497 static int dm9620_ioctl(struct net_device *net, struct ifreq *rq, int cmd)
498 {
499 struct usbnet *dev = netdev_priv(net);
500
501 return generic_mii_ioctl(&dev->mii, if_mii(rq), cmd, NULL);
502 }
503
504
505 #define DM_LINKEN (1<<5)
506 #define DM_MAGICEN (1<<3)
507 #define DM_LINKST (1<<2)
508 #define DM_MAGICST (1<<0)
509
510 static void
dm9620_get_wol(struct net_device * net,struct ethtool_wolinfo * wolinfo)511 dm9620_get_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
512 {
513 struct usbnet *dev = netdev_priv(net);
514 u8 opt;
515
516 if (dm_read_reg(dev, DM_WAKEUP_CTRL, &opt) < 0) {
517 wolinfo->supported = 0;
518 wolinfo->wolopts = 0;
519 return;
520 }
521 wolinfo->supported = WAKE_PHY | WAKE_MAGIC;
522 wolinfo->wolopts = 0;
523
524 if (opt & DM_LINKEN)
525 wolinfo->wolopts |= WAKE_PHY;
526 if (opt & DM_MAGICEN)
527 wolinfo->wolopts |= WAKE_MAGIC;
528 }
529
530
531 static int
dm9620_set_wol(struct net_device * net,struct ethtool_wolinfo * wolinfo)532 dm9620_set_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
533 {
534 struct usbnet *dev = netdev_priv(net);
535 u8 opt = 0;
536
537 if (wolinfo->wolopts & WAKE_PHY)
538 opt |= DM_LINKEN;
539 if (wolinfo->wolopts & WAKE_MAGIC)
540 opt |= DM_MAGICEN;
541
542 dm_write_reg(dev, DM_NET_CTRL, 0x48); // enable WAKEEN
543
544 // dm_write_reg(dev, 0x92, 0x3f); //keep clock on Hank Jun 30
545
546 return dm_write_reg(dev, DM_WAKEUP_CTRL, opt);
547 }
548
549 static struct ethtool_ops dm9620_ethtool_ops = {
550 .get_drvinfo = dm9620_get_drvinfo,
551 .get_link = dm9620_get_link,
552 .get_msglevel = usbnet_get_msglevel,
553 .set_msglevel = usbnet_set_msglevel,
554 .get_eeprom_len = dm9620_get_eeprom_len,
555 .get_eeprom = dm9620_get_eeprom,
556 .set_eeprom = dm9620_set_eeprom,
557 .get_settings = usbnet_get_settings,
558 .set_settings = usbnet_set_settings,
559 .nway_reset = usbnet_nway_reset,
560 .get_wol = dm9620_get_wol,
561 .set_wol = dm9620_set_wol,
562 };
563
dm9620_set_multicast(struct net_device * net)564 static void dm9620_set_multicast(struct net_device *net)
565 {
566 struct usbnet *dev = netdev_priv(net);
567 /* We use the 20 byte dev->data for our 8 byte filter buffer
568 * to avoid allocating memory that is tricky to free later */
569 u8 *hashes = (u8 *) & dev->data;
570 u8 rx_ctl = 0x31;
571
572 memset(hashes, 0x00, DM_MCAST_SIZE);
573 hashes[DM_MCAST_SIZE - 1] |= 0x80; /* broadcast address */
574
575 if (net->flags & IFF_PROMISC) {
576 rx_ctl |= 0x02;
577 #if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,33)
578 } else if (net->flags & IFF_ALLMULTI || netdev_mc_count(net) > DM_MAX_MCAST) {
579 rx_ctl |= 0x8;
580 } else if (!netdev_mc_empty(net)) {
581 struct netdev_hw_addr *ha;
582
583 netdev_for_each_mc_addr(ha, net) {
584 u32 crc = crc32_le(~0, ha->addr, ETH_ALEN) & 0x3f;
585 hashes[crc>>3] |= 1 << (crc & 0x7);
586 }
587 #elif LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,33)
588 } else if (net->flags & IFF_ALLMULTI || net->mc_count > DM_MAX_MCAST) {
589 rx_ctl |= 0x08;
590 } else if (net->mc_count) {
591 struct dev_mc_list *mc_list = net->mc_list;
592 int i;
593
594 for (i = 0; i < net->mc_count; i++, mc_list = mc_list->next) {
595 u32 crc = crc32_le(~0, mc_list->dmi_addr, ETH_ALEN) & 0x3f;
596 hashes[crc>>3] |= 1 << (crc & 0x7);
597 }
598 #endif
599 }
600
601 dm_write_async(dev, DM_MCAST_ADDR, DM_MCAST_SIZE, hashes);
602 dm_write_reg_async(dev, DM_RX_CTRL, rx_ctl);
603 }
604
605
__dm9620_set_mac_address(struct usbnet * dev)606 static void __dm9620_set_mac_address(struct usbnet *dev)
607 {
608 dm_write_async(dev, DM_PHY_ADDR, ETH_ALEN, dev->net->dev_addr);
609 }
610
dm9620_set_mac_address(struct net_device * net,void * p)611 static int dm9620_set_mac_address(struct net_device *net, void *p)
612 {
613 struct sockaddr *addr = p;
614 struct usbnet *dev = netdev_priv(net);
615 int i;
616
617 #if 1
618 printk("[dm96] Set mac addr %pM\n", addr->sa_data); // %x:%x:...
619 printk("[dm96] ");
620 for (i=0; i<net->addr_len; i++)
621 printk("[%02x] ", addr->sa_data[i]);
622 printk("\n");
623 #endif
624
625 if (!is_valid_ether_addr(addr->sa_data)) {
626 dev_err(&net->dev, "not setting invalid mac address %pM\n",
627 addr->sa_data);
628 return -EINVAL;
629 }
630
631 memcpy(net->dev_addr, addr->sa_data, net->addr_len);
632 __dm9620_set_mac_address(dev);
633
634 return 0;
635 }
636
637 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,31)
638
639 static const struct net_device_ops vm_netdev_ops= { // new kernel 2.6.31 (20091217JJ)
640
641 .ndo_open = usbnet_open,
642 .ndo_stop = usbnet_stop,
643 .ndo_start_xmit = usbnet_start_xmit,
644 .ndo_tx_timeout = usbnet_tx_timeout,
645 .ndo_change_mtu = usbnet_change_mtu,
646 .ndo_validate_addr = eth_validate_addr,
647 .ndo_do_ioctl = dm9620_ioctl,
648 #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)
649 .ndo_set_rx_mode = dm9620_set_multicast,
650 #else
651 .ndo_set_multicast_list = dm9620_set_multicast,
652 #endif
653 .ndo_set_mac_address = dm9620_set_mac_address,
654 };
655 #endif
656
dm9620_bind(struct usbnet * dev,struct usb_interface * intf)657 static int dm9620_bind(struct usbnet *dev, struct usb_interface *intf)
658 {
659 u16 *tmpwPtr2;
660 int ret,mdio_val,i;
661 struct dm96xx_priv* priv;
662 u8 temp;
663 u8 tmp;
664
665 ret = usbnet_get_endpoints(dev, intf);
666 if (ret)
667 goto out;
668
669 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,31)
670 dev->net->netdev_ops = &vm_netdev_ops; // new kernel 2.6.31 (20091217JJ)
671 dev->net->ethtool_ops = &dm9620_ethtool_ops;
672 #else
673 dev->net->do_ioctl = dm9620_ioctl;
674 dev->net->set_multicast_list = dm9620_set_multicast;
675 dev->net->ethtool_ops = &dm9620_ethtool_ops;
676 #endif
677 dev->net->hard_header_len += DM_TX_OVERHEAD;
678 dev->hard_mtu = dev->net->mtu + dev->net->hard_header_len;
679 dev->rx_urb_size = dev->net->mtu + ETH_HLEN + DM_RX_OVERHEAD+1; // ftp fail fixed
680 dev->rx_urb_size = (dev->rx_urb_size > 2048) ? dev->rx_urb_size : 2048;
681
682 dev->mii.dev = dev->net;
683 dev->mii.mdio_read = dm9620_mdio_read;
684 dev->mii.mdio_write = dm9620_mdio_write;
685 dev->mii.phy_id_mask = 0x1f;
686 dev->mii.reg_num_mask = 0x1f;
687 dev->mii.phy_id = DM9620_PHY_ID;
688
689 printk("[dm962] Linux Driver = %s\n", LNX_DM9620_VER_STR);
690 //JJ1
691 if ( (ret= dm_read_reg(dev, 0x29, &tmp)) >=0)
692 printk("++++++[dm962]+++++ dm_read_reg() 0x29 0x%02x\n",tmp);
693 else
694 printk("++++++[dm962]+++++ dm_read_reg() 0x29 fail-func-return %d\n", ret);
695
696 if ( (ret= dm_read_reg(dev, 0x28, &tmp)) >=0)
697 printk("++++++[dm962]+++++ dm_read_reg() 0x28 0x%02x\n",tmp);
698 else
699 printk("++++++[dm962]+++++ dm_read_reg() 0x28 fail-func-return %d\n", ret);
700
701 if ( (ret= dm_read_reg(dev, 0x2b, &tmp)) >=0)
702 printk("++++++[dm962]+++++ dm_read_reg() 0x2b 0x%02x\n",tmp);
703 else
704 printk("++++++[dm962]+++++ dm_read_reg() 0x2b fail-func-return %d\n", ret);
705 if ( (ret= dm_read_reg(dev, 0x2a, &tmp)) >=0)
706 printk("++++++[dm962]+++++ dm_read_reg() 0x2a 0x%02x\n",tmp);
707 else
708 printk("++++++[dm962]+++++ dm_read_reg() 0x2a fail-func-return %d\n", ret);
709
710 //JJ3
711 if ( (ret= dm_read_reg(dev, 0xF2, &tmp)) >=0)
712 printk("++++++[dm962]+++++ dm_read_reg() 0xF2 0x%02x\n",tmp);
713 else
714 printk("++++++[dm962]+++++ dm_read_reg() 0xF2 fail-func-return %d\n", ret);
715
716 printk("++++++[dm962]+++++ [Analysis.2] 0xF2, D[7] %d %s\n", tmp>>7, (tmp&(1<<7))? "Err: RX Unexpected condition": "OK" );
717 printk("++++++[dm962]+++++ [Analysis.2] 0xF2, D[6] %d %s\n", (tmp>>6)&1, (tmp&(1<<6))? "Err: Host Suspend condition": "OK" );
718 printk("++++++[dm962]+++++ [Analysis.2] 0xF2, D[5] %d %s\n", (tmp>>5)&1, (tmp&(1<<5))? "EP1: Data Ready": "EP1: Empty" );
719 printk("++++++[dm962]+++++ [Analysis.2] 0xF2, D[3] %d %s\n", (tmp>>3)&1, (tmp&(1<<3))? "Err: Bulk out condition": "OK" );
720
721 printk("++++++[dm962]+++++ [Analysis.2] 0xF2, D[2] %d %s\n", (tmp>>2)&1, (tmp&(1<<2))? "Err: TX Buffer full": "OK" );
722 printk("++++++[dm962]+++++ [Analysis.2] 0xF2, D[1] %d %s\n", (tmp>>1)&1, (tmp&(1<<1))? "Warn: TX buffer Almost full": "OK" );
723 printk("++++++[dm962]+++++ [Analysis.2] 0xF2, D[0] %d %s\n", (tmp>>0)&1, (tmp&(1<<0))? "Status: TX buffer has pkts": "Status: TX buffer 0 pkts" );
724
725 /* reset */
726 dm_write_reg(dev, DM_NET_CTRL, 1);
727 udelay(20);
728 //Stone add Enable "MAC layer" Flow Control, TX Pause Packet Enable and
729 dm_write_reg(dev, DM_FLOW_CTRL, 0x29);
730 //Stone add Enable "PHY layer" Flow Control support (phy register 0x04 bit 10)
731 temp = dm9620_mdio_read(dev->net, dev->mii.phy_id, 0x04);
732 dm9620_mdio_write(dev->net, dev->mii.phy_id, 0x04, temp | 0x400);
733
734
735 /* Add V1.1, Enable auto link while plug in RJ45, Hank July 20, 2009*/
736 dm_write_reg(dev, USB_CTRL, 0x20);
737 /* read MAC */
738 if (dm_read(dev, DM_PHY_ADDR, ETH_ALEN, dev->net->dev_addr) < 0) {
739 printk(KERN_ERR "Error reading MAC address\n");
740 ret = -ENODEV;
741 goto out;
742 }
743
744 #if 1
745 printk("[dm96] Chk mac addr %pM\n", dev->net->dev_addr); // %x:%x...
746 printk("[dm96] ");
747 for (i=0; i<ETH_ALEN; i++)
748 printk("[%02x] ", dev->net->dev_addr[i]);
749 printk("\n");
750 #endif
751
752 /* read SMI mode register */
753 priv = dev->driver_priv = kmalloc(sizeof(struct dm96xx_priv), GFP_ATOMIC);
754 if (!priv) {
755 dm9620_err(dev,"Failed to allocate memory for dm96xx_priv");
756 ret = -ENOMEM;
757 goto out;
758 }
759
760 /* work-around for 9620 mode */
761 dm_read_reg(dev, 0x5c, &temp);
762 priv->tx_fix_mod = temp;
763 printk(KERN_WARNING "[dm96] 9620 tx_fix_mod (DM9_NREV= %d)\n", priv->tx_fix_mod);
764
765 printk("[dm96] Fixme: work around for 9620 mode\n");
766 printk("[dm96] Add tx_fixup() debug...\n");
767 dm_write_reg(dev, DM_MCAST_ADDR, 0); // clear data bus to 0s
768 dm_read_reg(dev, DM_MCAST_ADDR, &temp); // clear data bus to 0s
769 ret = dm_read_reg(dev, DM_SMIREG, &temp); // Must clear data bus before we can read the 'MODE9620' bit
770
771 priv->flg_txdbg= 0; //->flag_fail_count= 0;
772 if (ret<0) {
773 printk(KERN_ERR "[dm96] Error read SMI register\n");
774 }
775 else priv->mode_9620 = temp & DM_MODE9620;
776
777 printk(KERN_WARNING "[dm96] 9620 Mode = %d\n", priv->mode_9620);
778
779 dm_read_reg(dev, DM_TXRX_M, &temp); // Need to check the Chipset version (register 0x5c is 0x02?)
780 if (temp == 0x02)
781 {
782 dm_read_reg(dev, 0x3f, &temp);
783 temp |= 0x80;
784 dm_write_reg(dev, 0x3f, temp);
785 }
786
787 //Stone add for check Product ID == 0x1269
788 tmpwPtr2= kmalloc (2, GFP_ATOMIC);
789 if (!tmpwPtr2)
790 {
791 printk("+++++++++++ JJ5 dm_read_reg() Error: can not kmalloc!\n"); //usbnet_suspend (intf, message);
792 return 0;
793 }
794 ret =dm_read(dev, DM_PID, 2, tmpwPtr2);
795
796 if (*tmpwPtr2 == 0x1269)
797 dm_write_reg(dev, DM_SMIREG, 0xa0);
798
799 if (*tmpwPtr2 == 0x0269)
800 dm_write_reg(dev, DM_SMIREG, 0xa0);
801
802 kfree (tmpwPtr2);
803
804 /* power up phy */
805 dm_write_reg(dev, DM_GPR_CTRL, 1);
806 dm_write_reg(dev, DM_GPR_DATA, 0);
807
808 /* Init tx/rx checksum */
809 #if DM_TX_CS_EN
810 dm_write_reg(dev, DM_TX_CRC_CTRL, 7);
811 #endif
812 dm_write_reg(dev, DM_RX_CRC_CTRL, 2);
813
814 /* receive broadcast packets */
815 dm9620_set_multicast(dev->net);
816 dm9620_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET);
817
818 /* Hank add, work for comapubility issue (10M Power control) */
819
820 dm9620_mdio_write(dev->net, dev->mii.phy_id, PHY_SPEC_CFG, 0x800);
821 mdio_val = dm9620_mdio_read(dev->net, dev->mii.phy_id, PHY_SPEC_CFG);
822
823 dm9620_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
824 ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP);
825 mii_nway_restart(&dev->mii);
826
827 out:
828 return ret;
829 }
830
dm9620_unbind(struct usbnet * dev,struct usb_interface * intf)831 void dm9620_unbind(struct usbnet *dev, struct usb_interface *intf)
832 {
833 struct dm96xx_priv* priv= dev->driver_priv;
834 printk("dm9620_unbind():\n");
835
836 //printk("flag_fail_count %lu\n", (long unsigned int)priv->flag_fail_count);
837 printk("flg_txdbg %lu\n", (long unsigned int)priv->flg_txdbg);
838 kfree(dev->driver_priv); // displayed dev->.. above, then can free dev
839
840 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,31)
841 printk("rx_length_errors %lu\n",dev->net->stats.rx_length_errors);
842 printk("rx_over_errors %lu\n",dev->net->stats.rx_over_errors );
843 printk("rx_crc_errors %lu\n",dev->net->stats.rx_crc_errors );
844 printk("rx_frame_errors %lu\n",dev->net->stats.rx_frame_errors );
845 printk("rx_fifo_errors %lu\n",dev->net->stats.rx_fifo_errors );
846 printk("rx_missed_errors %lu\n",dev->net->stats.rx_missed_errors);
847 #else
848 printk("rx_length_errors %lu\n",dev->stats.rx_length_errors);
849 printk("rx_over_errors %lu\n",dev->stats.rx_over_errors );
850 printk("rx_crc_errors %lu\n",dev->stats.rx_crc_errors );
851 printk("rx_frame_errors %lu\n",dev->stats.rx_frame_errors );
852 printk("rx_fifo_errors %lu\n",dev->stats.rx_fifo_errors );
853 printk("rx_missed_errors %lu\n",dev->stats.rx_missed_errors);
854 #endif
855
856
857 }
858
dm9620_rx_fixup(struct usbnet * dev,struct sk_buff * skb)859 static int dm9620_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
860 {
861 u8 status;
862 int len;
863 struct dm96xx_priv* priv = (struct dm96xx_priv *)dev->driver_priv;
864
865 /* 9620 format:
866 b0: rx status
867 b1: packet length (incl crc) low
868 b2: packet length (incl crc) high
869 b3..n-4: packet data
870 bn-3..bn: ethernet crc
871 */
872
873 /* 9620 format:
874 one additional byte then 9620 :
875 rx_flag in the first pos
876 */
877
878 if (unlikely(skb->len < DM_RX_OVERHEAD_9601)) { // 20090623
879 dev_err(&dev->udev->dev, "unexpected tiny rx frame\n");
880 return 0;
881 }
882
883 if (priv->mode_9620) {
884 /* mode 9620 */
885
886 if (unlikely(skb->len < DM_RX_OVERHEAD)) { // 20090623
887 dev_err(&dev->udev->dev, "unexpected tiny rx frame\n");
888 return 0;
889 }
890
891 // if (skb->data[0]!=0x01)
892 // priv->flag_fail_count++;
893
894 status = skb->data[1];
895 len = (skb->data[2] | (skb->data[3] << 8)) - 4;
896
897 if (unlikely(status & 0xbf)) {
898 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,31)
899 if (status & 0x01) dev->net->stats.rx_fifo_errors++;
900 if (status & 0x02) dev->net->stats.rx_crc_errors++;
901 if (status & 0x04) dev->net->stats.rx_frame_errors++;
902 if (status & 0x20) dev->net->stats.rx_missed_errors++;
903 if (status & 0x90) dev->net->stats.rx_length_errors++;
904 #else
905 if (status & 0x01) dev->stats.rx_fifo_errors++;
906 if (status & 0x02) dev->stats.rx_crc_errors++;
907 if (status & 0x04) dev->stats.rx_frame_errors++;
908 if (status & 0x20) dev->stats.rx_missed_errors++;
909 if (status & 0x90) dev->stats.rx_length_errors++;
910 #endif
911 return 0;
912 }
913
914 skb_pull(skb, 4);
915 skb_trim(skb, len);
916
917 }
918 else { /* mode 9620 (original driver code) */
919 status = skb->data[0];
920 len = (skb->data[1] | (skb->data[2] << 8)) - 4;
921
922 if (unlikely(status & 0xbf)) {
923 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,31)
924 if (status & 0x01) dev->net->stats.rx_fifo_errors++;
925 if (status & 0x02) dev->net->stats.rx_crc_errors++;
926 if (status & 0x04) dev->net->stats.rx_frame_errors++;
927 if (status & 0x20) dev->net->stats.rx_missed_errors++;
928 if (status & 0x90) dev->net->stats.rx_length_errors++;
929 #else
930 if (status & 0x01) dev->stats.rx_fifo_errors++;
931 if (status & 0x02) dev->stats.rx_crc_errors++;
932 if (status & 0x04) dev->stats.rx_frame_errors++;
933 if (status & 0x20) dev->stats.rx_missed_errors++;
934 if (status & 0x90) dev->stats.rx_length_errors++;
935 #endif
936 return 0;
937 }
938
939 skb_pull(skb, 3);
940 skb_trim(skb, len);
941 }
942
943 return 1;
944 } // 'priv'
945
946 #define TX_LEN_E (1<<0) //EVEN, No action
947 #define TX_LEN_O (1<<1) //ODD, Odd to even workaround
948 #define TX_LEN_F (1<<2) //FULL, Full payload workaround
TxStyle(int len,unsigned full_payload)949 u8 TxStyle(int len, unsigned full_payload){
950 u8 s= (len%2)? TX_LEN_O: TX_LEN_E;
951 len= ((len+1)/2)*2;
952 len += 2;
953 if ((len % full_payload)==0)
954 s |= TX_LEN_F;
955 return s;
956 }
TxExpend(struct dm96xx_priv * priv,u8 ts,struct sk_buff * skb,gfp_t flags)957 struct sk_buff *TxExpend(struct dm96xx_priv* priv, u8 ts, struct sk_buff *skb, gfp_t flags)
958 {
959 int newheadroom= 2, newtailroom= 0;
960 if (ts&TX_LEN_O) newtailroom++;
961 if (ts&TX_LEN_F) newtailroom += 2;
962 if (skb_headroom(skb) >= newheadroom) newheadroom= 0; // head no need expend
963 if (skb_tailroom(skb) >= newtailroom) newtailroom= 0; // tail no need expend
964 if (newheadroom || newtailroom){
965 struct sk_buff *skb2;
966 skb2 = skb_copy_expand(skb, newheadroom, newtailroom, flags);
967 dev_kfree_skb_any(skb);
968 skb = skb2;
969 if (!skb){
970 printk("[dm96-TxRound].%d expend copy fail, for head, tail= %d, %d\n", priv->flg_txdbg++, newheadroom, newtailroom);
971 return NULL;
972 }
973 printk("[dm96-TxRound].%d expend copy OK, for head, tail= %d, %d\n", priv->flg_txdbg++, newheadroom, newtailroom);
974 }
975 return skb;
976 }
dm9620_tx_fixup(struct usbnet * dev,struct sk_buff * skb,gfp_t flags)977 static struct sk_buff *dm9620_tx_fixup(struct usbnet *dev, struct sk_buff *skb,
978 gfp_t flags)
979 {
980 int len;
981 int newheadroom, newtailroom;
982 struct dm96xx_priv* priv = (struct dm96xx_priv *)dev->driver_priv;
983
984 /* format:
985 b0: packet length low
986 b1: packet length high
987 b3..n: packet data
988 */
989
990 len = skb->len;
991
992 if (priv->tx_fix_mod<3)
993 {
994 /*
995 if (skb_headroom(skb) < DM_TX_OVERHEAD) {
996 struct sk_buff *skb2;
997 skb2 = skb_copy_expand(skb, DM_TX_OVERHEAD, 0, flags);
998 dev_kfree_skb_any(skb);
999 skb = skb2;
1000 if (!skb)
1001 return NULL;
1002 }
1003
1004 __skb_push(skb, DM_TX_OVERHEAD);
1005
1006 if ((skb->len % dev->maxpacket) == 0)
1007 len++;
1008 */
1009 //;DM9620-E4,E5, and E6
1010 /* usbnet adds padding 1 byte if odd len */
1011 /* usbnet adds padding 2 bytes if length is a multiple of packet size
1012 if so, adjust length value in header */
1013 u8 TS= TxStyle(len, dev->maxpacket); //
1014 if (!(skb= TxExpend(priv, TS, skb, flags))) return NULL; //
1015
1016 if (TS & TX_LEN_F) len += 2;
1017
1018 newheadroom= 2; //2
1019 newtailroom= 0; //0, 1, 2, or 3
1020 if (TS & TX_LEN_O) newtailroom++;
1021 if (TS & TX_LEN_F) newtailroom += 2;
1022
1023 if (TS & TX_LEN_O) printk("[dm96-TxRound].%d for LEN_ODD tail_room +1, rslt add %d\n", priv->flg_txdbg, newtailroom);
1024 if (TS & TX_LEN_F) printk("[dm96-TxRound].%d for LEN_PLOAD tail_room +2, rslt add %d\n", priv->flg_txdbg, newtailroom);
1025 if (TS & TX_LEN_F) printk("[dm96-TxRound].%d for LEN_PLOAD data_len +2, len from %d to %d\n", priv->flg_txdbg, len-2, len);
1026 if (TS & (TX_LEN_O|TX_LEN_F)) priv->flg_txdbg++;
1027
1028 __skb_push(skb, newheadroom); //2 bytes,for data[0],data[1]
1029 __skb_put(skb, newtailroom); //0, 1, 2, or 3 bytes (for tailer),
1030 //Note: 0, NOTHING
1031 //Note: 1, Odd to even WORKAROUND.
1032 //Note: 2 or 3, the condition is full payload,
1033 // This is the add more two bytes WORKAROUND
1034 // for bulkout and buffLen.
1035 }
1036 else
1037 {
1038 //;DM9620-E7
1039 if (skb_headroom(skb) < DM_TX_OVERHEAD) {
1040 struct sk_buff *skb2;
1041 skb2 = skb_copy_expand(skb, DM_TX_OVERHEAD, 0, flags);
1042 dev_kfree_skb_any(skb);
1043 skb = skb2;
1044 if (!skb)
1045 return NULL;
1046 }
1047
1048 newheadroom= 2; //2
1049 __skb_push(skb, newheadroom); //2 bytes, for data[0],data[1]
1050 }
1051
1052
1053 skb->data[0] = len;
1054 skb->data[1] = len >> 8;
1055
1056 /* hank, recalcute checksum of TCP */
1057
1058
1059 return skb;
1060 } // 'kb'
1061
dm9620_status(struct usbnet * dev,struct urb * urb)1062 static void dm9620_status(struct usbnet *dev, struct urb *urb)
1063 {
1064 int link;
1065 u8 *buf;
1066
1067 /* format:
1068 b0: net status
1069 b1: tx status 1
1070 b2: tx status 2
1071 b3: rx status
1072 b4: rx overflow
1073 b5: rx count
1074 b6: tx count
1075 b7: gpr
1076 */
1077
1078 if (urb->actual_length < 8)
1079 return;
1080
1081 buf = urb->transfer_buffer;
1082
1083 link = !!(buf[0] & 0x40);
1084 if (netif_carrier_ok(dev->net) != link) {
1085 if (link) {
1086 netif_carrier_on(dev->net);
1087 usbnet_defer_kevent (dev, EVENT_LINK_RESET);
1088 }
1089 else
1090 netif_carrier_off(dev->net);
1091 dm9620_print(dev, "Link Status is: %d", link);
1092 }
1093 }
1094
dm9620_link_reset(struct usbnet * dev)1095 static int dm9620_link_reset(struct usbnet *dev)
1096 {
1097 struct ethtool_cmd ecmd;
1098 mii_check_media(&dev->mii, 1, 1);
1099 mii_ethtool_gset(&dev->mii, &ecmd);
1100 /* hank add*/
1101 dm9620_mdio_write(dev->net, dev->mii.phy_id, PHY_SPEC_CFG, 0x800);
1102 dm9620_print(dev, "link_reset() speed: %d duplex: %d",
1103 ecmd.speed, ecmd.duplex);
1104
1105 return 0;
1106 }
1107
1108 static const struct driver_info dm9620_info = {
1109 .description = "Davicom DM9620 USB Ethernet",
1110 .flags = FLAG_ETHER,
1111 .bind = dm9620_bind,
1112 .rx_fixup = dm9620_rx_fixup,
1113 .tx_fixup = dm9620_tx_fixup,
1114 .status = dm9620_status,
1115 .link_reset = dm9620_link_reset,
1116 .reset = dm9620_link_reset,
1117 .unbind = dm9620_unbind,
1118 };
1119
1120 static const struct usb_device_id products[] = {
1121 {
1122 USB_DEVICE(0x07aa, 0x9601), /* Corega FEther USB-TXC */
1123 .driver_info = (unsigned long)&dm9620_info,
1124 },
1125 {
1126 USB_DEVICE(0x0a46, 0x9601), /* Davicom USB-100 */
1127 .driver_info = (unsigned long)&dm9620_info,
1128 },
1129 {
1130 USB_DEVICE(0x0a46, 0x6688), /* ZT6688 USB NIC */
1131 .driver_info = (unsigned long)&dm9620_info,
1132 },
1133 {
1134 USB_DEVICE(0x0a46, 0x0268), /* ShanTou ST268 USB NIC */
1135 .driver_info = (unsigned long)&dm9620_info,
1136 },
1137 {
1138 USB_DEVICE(0x0a46, 0x8515), /* ADMtek ADM8515 USB NIC */
1139 .driver_info = (unsigned long)&dm9620_info,
1140 },
1141 {
1142 USB_DEVICE(0x0a47, 0x9601), /* Hirose USB-100 */
1143 .driver_info = (unsigned long)&dm9620_info,
1144 },
1145 {
1146 USB_DEVICE(0x0a46, 0x9620), /* Davicom 9620 */
1147 .driver_info = (unsigned long)&dm9620_info,
1148 },
1149 {
1150 USB_DEVICE(0x0a46, 0x9621), /* Davicom 9621 */
1151 .driver_info = (unsigned long)&dm9620_info,
1152 },
1153 {
1154 USB_DEVICE(0x0a46, 0x9622), /* Davicom 9622 */
1155 .driver_info = (unsigned long)&dm9620_info,
1156 },
1157 {
1158 USB_DEVICE(0x0fe6, 0x8101), /* Davicom 9601 USB to Fast Ethernet Adapter */
1159 .driver_info = (unsigned long)&dm9620_info,
1160 },
1161 {
1162 USB_DEVICE(0x0a46, 0x1269), /* Davicom 9621A CDC */
1163 .driver_info = (unsigned long)&dm9620_info,
1164 },
1165 {
1166 USB_DEVICE(0x0a46, 0x0269), /* Davicom 9620A CDC */
1167 .driver_info = (unsigned long)&dm9620_info,
1168 },
1169 //+
1170 //VID.00
1171 //0.0000 0000 0000
1172 {
1173 USB_DEVICE(0x0000, 0x9620), /* Davicom 9620 */
1174 .driver_info = (unsigned long)&dm9620_info,
1175 },
1176 {
1177 USB_DEVICE(0x0000, 0x0269), /* Davicom 9620A CDC */
1178 .driver_info = (unsigned long)&dm9620_info,
1179 },
1180 {
1181 USB_DEVICE(0x0000, 0x9621), /* Davicom 9621 */
1182 .driver_info = (unsigned long)&dm9620_info,
1183 },
1184 {
1185 USB_DEVICE(0x0000, 0x1269), /* Davicom 9621A CDC */
1186 .driver_info = (unsigned long)&dm9620_info,
1187 },
1188 //1.0000 0000 0010
1189 //2.0000 0000 0100
1190 //3.0000 0000 0110
1191 //4.0000 0100 0000
1192 //5.0000 0100 0010
1193 //6.0000 0100 0100
1194 //7.0000 0100 0110
1195 {
1196 USB_DEVICE(0x0002, 0x9621), /* Davicom 9621 */
1197 .driver_info = (unsigned long)&dm9620_info,
1198 },
1199 {
1200 USB_DEVICE(0x0002, 0x1269), /* Davicom 9621A CDC */
1201 .driver_info = (unsigned long)&dm9620_info,
1202 },
1203 {
1204 USB_DEVICE(0x0004, 0x9621), /* Davicom 9621 */
1205 .driver_info = (unsigned long)&dm9620_info,
1206 },
1207 {
1208 USB_DEVICE(0x0004, 0x1269), /* Davicom 9621A CDC */
1209 .driver_info = (unsigned long)&dm9620_info,
1210 },
1211 {
1212 USB_DEVICE(0x0006, 0x9621), /* Davicom 9621 */
1213 .driver_info = (unsigned long)&dm9620_info,
1214 },
1215 {
1216 USB_DEVICE(0x0006, 0x1269), /* Davicom 9621A CDC */
1217 .driver_info = (unsigned long)&dm9620_info,
1218 },
1219 {
1220 USB_DEVICE(0x0040, 0x9621), /* Davicom 9621 */
1221 .driver_info = (unsigned long)&dm9620_info,
1222 },
1223 {
1224 USB_DEVICE(0x0040, 0x1269), /* Davicom 9621A CDC */
1225 .driver_info = (unsigned long)&dm9620_info,
1226 },
1227 {
1228 USB_DEVICE(0x0042, 0x9621), /* Davicom 9621 */
1229 .driver_info = (unsigned long)&dm9620_info,
1230 },
1231 {
1232 USB_DEVICE(0x0042, 0x1269), /* Davicom 9621A CDC */
1233 .driver_info = (unsigned long)&dm9620_info,
1234 },
1235 {
1236 USB_DEVICE(0x0044, 0x9621), /* Davicom 9621 */
1237 .driver_info = (unsigned long)&dm9620_info,
1238 },
1239 {
1240 USB_DEVICE(0x0044, 0x1269), /* Davicom 9621A CDC */
1241 .driver_info = (unsigned long)&dm9620_info,
1242 },
1243 //7.0000 0100 0110 (0A46)
1244 {
1245 USB_DEVICE(0x0046, 0x9621), /* Davicom 9621 */
1246 .driver_info = (unsigned long)&dm9620_info,
1247 },
1248 {
1249 USB_DEVICE(0x0046, 0x1269), /* Davicom 9621A CDC */
1250 .driver_info = (unsigned long)&dm9620_info,
1251 },
1252 // ..
1253
1254 //8.0010 0000 0000
1255 //9.0010 0000 0010
1256 //A.0010 0000 0100
1257 //B.0010 0000 0110
1258 //C.0010 0100 0000
1259 //D.0010 0100 0010
1260 //E.0010 0100 0100
1261 //F.0010 0100 0110
1262 {
1263 USB_DEVICE(0x0200, 0x9621), /* Davicom 9621 */
1264 .driver_info = (unsigned long)&dm9620_info,
1265 },
1266 {
1267 USB_DEVICE(0x0200, 0x1269), /* Davicom 9621A CDC */
1268 .driver_info = (unsigned long)&dm9620_info,
1269 },
1270 {
1271 USB_DEVICE(0x0202, 0x9621), /* Davicom 9621 */
1272 .driver_info = (unsigned long)&dm9620_info,
1273 },
1274 {
1275 USB_DEVICE(0x0202, 0x1269), /* Davicom 9621A CDC */
1276 .driver_info = (unsigned long)&dm9620_info,
1277 },
1278 {
1279 USB_DEVICE(0x0204, 0x9621), /* Davicom 9621 */
1280 .driver_info = (unsigned long)&dm9620_info,
1281 },
1282 {
1283 USB_DEVICE(0x0204, 0x1269), /* Davicom 9621A CDC */
1284 .driver_info = (unsigned long)&dm9620_info,
1285 },
1286 {
1287 USB_DEVICE(0x0206, 0x9621), /* Davicom 9621 */
1288 .driver_info = (unsigned long)&dm9620_info,
1289 },
1290 {
1291 USB_DEVICE(0x0206, 0x1269), /* Davicom 9621A CDC */
1292 .driver_info = (unsigned long)&dm9620_info,
1293 },
1294 {
1295 USB_DEVICE(0x0240, 0x9621), /* Davicom 9621 */
1296 .driver_info = (unsigned long)&dm9620_info,
1297 },
1298 {
1299 USB_DEVICE(0x0240, 0x1269), /* Davicom 9621A CDC */
1300 .driver_info = (unsigned long)&dm9620_info,
1301 },
1302 {
1303 USB_DEVICE(0x0242, 0x9621), /* Davicom 9621 */
1304 .driver_info = (unsigned long)&dm9620_info,
1305 },
1306 {
1307 USB_DEVICE(0x0242, 0x1269), /* Davicom 9621A CDC */
1308 .driver_info = (unsigned long)&dm9620_info,
1309 },
1310 {
1311 USB_DEVICE(0x0244, 0x9621), /* Davicom 9621 */
1312 .driver_info = (unsigned long)&dm9620_info,
1313 },
1314 {
1315 USB_DEVICE(0x0244, 0x1269), /* Davicom 9621A CDC */
1316 .driver_info = (unsigned long)&dm9620_info,
1317 },
1318 //F.0010 0100 0110 (0A46)
1319 {
1320 USB_DEVICE(0x0246, 0x9621), /* Davicom 9621 */
1321 .driver_info = (unsigned long)&dm9620_info,
1322 },
1323 {
1324 USB_DEVICE(0x0246, 0x1269), /* Davicom 9621A CDC */
1325 .driver_info = (unsigned long)&dm9620_info,
1326 },
1327 // ..
1328
1329 //10.1000 0000 0000
1330 //11.1000 0000 0010
1331 //12.1000 0000 0100
1332 //13.1000 0000 0110
1333 //14.1000 0100 0000
1334 //15.1000 0100 0010
1335 //16.1000 0100 0100
1336 //17.1000 0100 0110
1337 {
1338 USB_DEVICE(0x0800, 0x9621), /* Davicom 9621 */
1339 .driver_info = (unsigned long)&dm9620_info,
1340 },
1341 {
1342 USB_DEVICE(0x0800, 0x1269), /* Davicom 9621A CDC */
1343 .driver_info = (unsigned long)&dm9620_info,
1344 },
1345 {
1346 USB_DEVICE(0x0802, 0x9621), /* Davicom 9621 */
1347 .driver_info = (unsigned long)&dm9620_info,
1348 },
1349 {
1350 USB_DEVICE(0x0802, 0x1269), /* Davicom 9621A CDC */
1351 .driver_info = (unsigned long)&dm9620_info,
1352 },
1353 {
1354 USB_DEVICE(0x0804, 0x9621), /* Davicom 9621 */
1355 .driver_info = (unsigned long)&dm9620_info,
1356 },
1357 {
1358 USB_DEVICE(0x0804, 0x1269), /* Davicom 9621A CDC */
1359 .driver_info = (unsigned long)&dm9620_info,
1360 },
1361 {
1362 USB_DEVICE(0x0806, 0x9621), /* Davicom 9621 */
1363 .driver_info = (unsigned long)&dm9620_info,
1364 },
1365 {
1366 USB_DEVICE(0x0806, 0x1269), /* Davicom 9621A CDC */
1367 .driver_info = (unsigned long)&dm9620_info,
1368 },
1369 {
1370 USB_DEVICE(0x0840, 0x9621), /* Davicom 9621 */
1371 .driver_info = (unsigned long)&dm9620_info,
1372 },
1373 {
1374 USB_DEVICE(0x0840, 0x1269), /* Davicom 9621A CDC */
1375 .driver_info = (unsigned long)&dm9620_info,
1376 },
1377 {
1378 USB_DEVICE(0x0842, 0x9621), /* Davicom 9621 */
1379 .driver_info = (unsigned long)&dm9620_info,
1380 },
1381 {
1382 USB_DEVICE(0x0842, 0x1269), /* Davicom 9621A CDC */
1383 .driver_info = (unsigned long)&dm9620_info,
1384 },
1385 {
1386 USB_DEVICE(0x0844, 0x9621), /* Davicom 9621 */
1387 .driver_info = (unsigned long)&dm9620_info,
1388 },
1389 {
1390 USB_DEVICE(0x0844, 0x1269), /* Davicom 9621A CDC */
1391 .driver_info = (unsigned long)&dm9620_info,
1392 },
1393 //17.1010 0100 0110 (0A46)
1394 {
1395 USB_DEVICE(0x0846, 0x9621), /* Davicom 9621 */
1396 .driver_info = (unsigned long)&dm9620_info,
1397 },
1398 {
1399 USB_DEVICE(0x0846, 0x1269), /* Davicom 9621A CDC */
1400 .driver_info = (unsigned long)&dm9620_info,
1401 },
1402 // ..
1403
1404 //18.1010 0000 0000
1405 //19.1010 0000 0010
1406 //1A.1010 0000 0100
1407 //1B.1010 0000 0110
1408 //1C.1010 0100 0000
1409 //1D.1010 0100 0010
1410 //1E.1010 0100 0100
1411 {
1412 USB_DEVICE(0x0A00, 0x9621), /* Davicom 9621 */
1413 .driver_info = (unsigned long)&dm9620_info,
1414 },
1415 {
1416 USB_DEVICE(0x0A00, 0x1269), /* Davicom 9621A CDC */
1417 .driver_info = (unsigned long)&dm9620_info,
1418 },
1419 {
1420 USB_DEVICE(0x0A02, 0x9621), /* Davicom 9621 */
1421 .driver_info = (unsigned long)&dm9620_info,
1422 },
1423 {
1424 USB_DEVICE(0x0A02, 0x1269), /* Davicom 9621A CDC */
1425 .driver_info = (unsigned long)&dm9620_info,
1426 },
1427 {
1428 USB_DEVICE(0x0A04, 0x9621), /* Davicom 9621 */
1429 .driver_info = (unsigned long)&dm9620_info,
1430 },
1431 {
1432 USB_DEVICE(0x0A04, 0x1269), /* Davicom 9621A CDC */
1433 .driver_info = (unsigned long)&dm9620_info,
1434 },
1435 {
1436 USB_DEVICE(0x0A06, 0x9621), /* Davicom 9621 */
1437 .driver_info = (unsigned long)&dm9620_info,
1438 },
1439 {
1440 USB_DEVICE(0x0A06, 0x1269), /* Davicom 9621A CDC */
1441 .driver_info = (unsigned long)&dm9620_info,
1442 },
1443 {
1444 USB_DEVICE(0x0A40, 0x9621), /* Davicom 9621 */
1445 .driver_info = (unsigned long)&dm9620_info,
1446 },
1447 {
1448 USB_DEVICE(0x0A40, 0x1269), /* Davicom 9621A CDC */
1449 .driver_info = (unsigned long)&dm9620_info,
1450 },
1451 {
1452 USB_DEVICE(0x0A42, 0x9621), /* Davicom 9621 */
1453 .driver_info = (unsigned long)&dm9620_info,
1454 },
1455 {
1456 USB_DEVICE(0x0A42, 0x1269), /* Davicom 9621A CDC */
1457 .driver_info = (unsigned long)&dm9620_info,
1458 },
1459 {
1460 USB_DEVICE(0x0A44, 0x9621), /* Davicom 9621 */
1461 .driver_info = (unsigned long)&dm9620_info,
1462 },
1463 {
1464 USB_DEVICE(0x0A44, 0x1269), /* Davicom 9621A CDC */
1465 .driver_info = (unsigned long)&dm9620_info,
1466 },
1467 //1F.1010 0100 0110 (0A46)
1468 // .Original Default.
1469 //+
1470 //1268, 1200
1471 {
1472 USB_DEVICE(0x0000, 0x1268), /* Davicom 9621A CDC */
1473 .driver_info = (unsigned long)&dm9620_info,
1474 },
1475 {
1476 USB_DEVICE(0x0000, 0x1200), /* Davicom 9620A CDC */
1477 .driver_info = (unsigned long)&dm9620_info,
1478 },
1479 {
1480 USB_DEVICE(0x0000, 0x1220), /* Davicom 9620A CDC, 1220 test mode */
1481 .driver_info = (unsigned long)&dm9620_info,
1482 },
1483 {}, // END
1484 };
1485
1486 MODULE_DEVICE_TABLE(usb, products);
1487
1488 static struct usb_driver dm9620_driver = {
1489 .name = "dm9620",
1490 .id_table = products,
1491 .probe = usbnet_probe,
1492 .disconnect = usbnet_disconnect,
1493 .suspend = usbnet_suspend,
1494 .resume = usbnet_resume,
1495 };
1496
1497
1498
1499
dm9620_init(void)1500 static int __init dm9620_init(void)
1501 {
1502 return usb_register(&dm9620_driver);
1503 }
1504
dm9620_exit(void)1505 static void __exit dm9620_exit(void)
1506 {
1507 usb_deregister(&dm9620_driver);
1508 }
1509
1510 module_init(dm9620_init);
1511 module_exit(dm9620_exit);
1512
1513 MODULE_AUTHOR("Peter Korsgaard <jacmet@sunsite.dk>");
1514 MODULE_DESCRIPTION("Davicom DM9620 USB 2.0 ethernet devices");
1515 MODULE_LICENSE("GPL");
1516
1517