Linux Audio

Check our new training course

Loading...
v3.15
  1/*
  2 * ASIX AX8817X based USB 2.0 Ethernet Devices
  3 * Copyright (C) 2003-2006 David Hollis <dhollis@davehollis.com>
  4 * Copyright (C) 2005 Phil Chang <pchang23@sbcglobal.net>
  5 * Copyright (C) 2006 James Painter <jamie.painter@iname.com>
  6 * Copyright (c) 2002-2003 TiVo Inc.
  7 *
  8 * This program is free software; you can redistribute it and/or modify
  9 * it under the terms of the GNU General Public License as published by
 10 * the Free Software Foundation; either version 2 of the License, or
 11 * (at your option) any later version.
 12 *
 13 * This program is distributed in the hope that it will be useful,
 14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 16 * GNU General Public License for more details.
 17 *
 18 * You should have received a copy of the GNU General Public License
 19 * along with this program; if not, see <http://www.gnu.org/licenses/>.
 20 */
 21
 22#include "asix.h"
 23
 24int asix_read_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
 25		  u16 size, void *data)
 26{
 27	int ret;
 28	ret = usbnet_read_cmd(dev, cmd,
 29			       USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 30			       value, index, data, size);
 
 
 
 
 
 
 
 
 
 
 
 
 31
 32	if (ret != size && ret >= 0)
 33		return -EINVAL;
 34	return ret;
 35}
 36
 37int asix_write_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
 38		   u16 size, void *data)
 39{
 40	return usbnet_write_cmd(dev, cmd,
 41				USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 42				value, index, data, size);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 43}
 44
 45void asix_write_cmd_async(struct usbnet *dev, u8 cmd, u16 value, u16 index,
 46			  u16 size, void *data)
 47{
 48	usbnet_write_cmd_async(dev, cmd,
 49			       USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 50			       value, index, data, size);
 51}
 52
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 53int asix_rx_fixup_internal(struct usbnet *dev, struct sk_buff *skb,
 54			   struct asix_rx_fixup_info *rx)
 55{
 56	int offset = 0;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 57
 58	while (offset + sizeof(u16) <= skb->len) {
 59		u16 remaining = 0;
 60		unsigned char *data;
 61
 62		if (!rx->size) {
 63			if ((skb->len - offset == sizeof(u16)) ||
 64			    rx->split_head) {
 65				if(!rx->split_head) {
 66					rx->header = get_unaligned_le16(
 67							skb->data + offset);
 68					rx->split_head = true;
 69					offset += sizeof(u16);
 70					break;
 71				} else {
 72					rx->header |= (get_unaligned_le16(
 73							skb->data + offset)
 74							<< 16);
 75					rx->split_head = false;
 76					offset += sizeof(u16);
 77				}
 78			} else {
 79				rx->header = get_unaligned_le32(skb->data +
 80								offset);
 81				offset += sizeof(u32);
 82			}
 83
 84			/* get the packet length */
 85			rx->size = (u16) (rx->header & 0x7ff);
 86			if (rx->size != ((~rx->header >> 16) & 0x7ff)) {
 87				netdev_err(dev->net, "asix_rx_fixup() Bad Header Length 0x%x, offset %d\n",
 88					   rx->header, offset);
 89				rx->size = 0;
 90				return 0;
 91			}
 92			rx->ax_skb = netdev_alloc_skb_ip_align(dev->net,
 93							       rx->size);
 94			if (!rx->ax_skb)
 
 95				return 0;
 96		}
 97
 98		if (rx->size > dev->net->mtu + ETH_HLEN + VLAN_HLEN) {
 99			netdev_err(dev->net, "asix_rx_fixup() Bad RX Length %d\n",
100				   rx->size);
101			kfree_skb(rx->ax_skb);
102			rx->ax_skb = NULL;
103			rx->size = 0U;
104
105			return 0;
106		}
107
108		if (rx->size > skb->len - offset) {
109			remaining = rx->size - (skb->len - offset);
110			rx->size = skb->len - offset;
 
 
 
111		}
112
113		data = skb_put(rx->ax_skb, rx->size);
114		memcpy(data, skb->data + offset, rx->size);
115		if (!remaining)
116			usbnet_skb_return(dev, rx->ax_skb);
 
 
 
 
117
118		offset += (rx->size + 1) & 0xfffe;
119		rx->size = remaining;
120	}
121
122	if (skb->len != offset) {
123		netdev_err(dev->net, "asix_rx_fixup() Bad SKB Length %d, %d\n",
124			   skb->len, offset);
 
125		return 0;
126	}
127
128	return 1;
129}
130
131int asix_rx_fixup_common(struct usbnet *dev, struct sk_buff *skb)
132{
133	struct asix_common_private *dp = dev->driver_priv;
134	struct asix_rx_fixup_info *rx = &dp->rx_fixup_info;
135
136	return asix_rx_fixup_internal(dev, skb, rx);
137}
138
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
139struct sk_buff *asix_tx_fixup(struct usbnet *dev, struct sk_buff *skb,
140			      gfp_t flags)
141{
142	int padlen;
143	int headroom = skb_headroom(skb);
144	int tailroom = skb_tailroom(skb);
145	u32 packet_len;
146	u32 padbytes = 0xffff0000;
147
148	padlen = ((skb->len + 4) & (dev->maxpacket - 1)) ? 0 : 4;
149
150	/* We need to push 4 bytes in front of frame (packet_len)
151	 * and maybe add 4 bytes after the end (if padlen is 4)
152	 *
153	 * Avoid skb_copy_expand() expensive call, using following rules :
154	 * - We are allowed to push 4 bytes in headroom if skb_header_cloned()
155	 *   is false (and if we have 4 bytes of headroom)
156	 * - We are allowed to put 4 bytes at tail if skb_cloned()
157	 *   is false (and if we have 4 bytes of tailroom)
158	 *
159	 * TCP packets for example are cloned, but skb_header_release()
160	 * was called in tcp stack, allowing us to use headroom for our needs.
161	 */
162	if (!skb_header_cloned(skb) &&
163	    !(padlen && skb_cloned(skb)) &&
164	    headroom + tailroom >= 4 + padlen) {
165		/* following should not happen, but better be safe */
166		if (headroom < 4 ||
167		    tailroom < padlen) {
168			skb->data = memmove(skb->head + 4, skb->data, skb->len);
169			skb_set_tail_pointer(skb, skb->len);
170		}
171	} else {
172		struct sk_buff *skb2;
173
174		skb2 = skb_copy_expand(skb, 4, padlen, flags);
175		dev_kfree_skb_any(skb);
176		skb = skb2;
177		if (!skb)
178			return NULL;
179	}
180
181	packet_len = ((skb->len ^ 0x0000ffff) << 16) + skb->len;
182	skb_push(skb, 4);
183	cpu_to_le32s(&packet_len);
184	skb_copy_to_linear_data(skb, &packet_len, sizeof(packet_len));
185
186	if (padlen) {
187		cpu_to_le32s(&padbytes);
188		memcpy(skb_tail_pointer(skb), &padbytes, sizeof(padbytes));
189		skb_put(skb, sizeof(padbytes));
190	}
 
 
191	return skb;
192}
193
194int asix_set_sw_mii(struct usbnet *dev)
195{
196	int ret;
197	ret = asix_write_cmd(dev, AX_CMD_SET_SW_MII, 0x0000, 0, 0, NULL);
 
198	if (ret < 0)
199		netdev_err(dev->net, "Failed to enable software MII access\n");
200	return ret;
201}
202
203int asix_set_hw_mii(struct usbnet *dev)
204{
205	int ret;
206	ret = asix_write_cmd(dev, AX_CMD_SET_HW_MII, 0x0000, 0, 0, NULL);
207	if (ret < 0)
208		netdev_err(dev->net, "Failed to enable hardware MII access\n");
209	return ret;
210}
211
212int asix_read_phy_addr(struct usbnet *dev, int internal)
213{
214	int offset = (internal ? 1 : 0);
215	u8 buf[2];
216	int ret = asix_read_cmd(dev, AX_CMD_READ_PHY_ID, 0, 0, 2, buf);
217
218	netdev_dbg(dev->net, "asix_get_phy_addr()\n");
219
220	if (ret < 0) {
221		netdev_err(dev->net, "Error reading PHYID register: %02x\n", ret);
222		goto out;
223	}
224	netdev_dbg(dev->net, "asix_get_phy_addr() returning 0x%04x\n",
225		   *((__le16 *)buf));
226	ret = buf[offset];
227
228out:
229	return ret;
230}
231
232int asix_get_phy_addr(struct usbnet *dev)
233{
234	/* return the address of the internal phy */
235	return asix_read_phy_addr(dev, 1);
236}
237
238
239int asix_sw_reset(struct usbnet *dev, u8 flags)
240{
241	int ret;
242
243        ret = asix_write_cmd(dev, AX_CMD_SW_RESET, flags, 0, 0, NULL);
244	if (ret < 0)
245		netdev_err(dev->net, "Failed to send software reset: %02x\n", ret);
246
247	return ret;
248}
249
250u16 asix_read_rx_ctl(struct usbnet *dev)
251{
252	__le16 v;
253	int ret = asix_read_cmd(dev, AX_CMD_READ_RX_CTL, 0, 0, 2, &v);
254
255	if (ret < 0) {
256		netdev_err(dev->net, "Error reading RX_CTL register: %02x\n", ret);
257		goto out;
258	}
259	ret = le16_to_cpu(v);
260out:
261	return ret;
262}
263
264int asix_write_rx_ctl(struct usbnet *dev, u16 mode)
265{
266	int ret;
267
268	netdev_dbg(dev->net, "asix_write_rx_ctl() - mode = 0x%04x\n", mode);
269	ret = asix_write_cmd(dev, AX_CMD_WRITE_RX_CTL, mode, 0, 0, NULL);
270	if (ret < 0)
271		netdev_err(dev->net, "Failed to write RX_CTL mode to 0x%04x: %02x\n",
272			   mode, ret);
273
274	return ret;
275}
276
277u16 asix_read_medium_status(struct usbnet *dev)
278{
279	__le16 v;
280	int ret = asix_read_cmd(dev, AX_CMD_READ_MEDIUM_STATUS, 0, 0, 2, &v);
 
281
282	if (ret < 0) {
283		netdev_err(dev->net, "Error reading Medium Status register: %02x\n",
284			   ret);
285		return ret;	/* TODO: callers not checking for error ret */
286	}
287
288	return le16_to_cpu(v);
289
290}
291
292int asix_write_medium_mode(struct usbnet *dev, u16 mode)
293{
294	int ret;
295
296	netdev_dbg(dev->net, "asix_write_medium_mode() - mode = 0x%04x\n", mode);
297	ret = asix_write_cmd(dev, AX_CMD_WRITE_MEDIUM_MODE, mode, 0, 0, NULL);
 
298	if (ret < 0)
299		netdev_err(dev->net, "Failed to write Medium Mode mode to 0x%04x: %02x\n",
300			   mode, ret);
301
302	return ret;
303}
304
305int asix_write_gpio(struct usbnet *dev, u16 value, int sleep)
306{
307	int ret;
308
309	netdev_dbg(dev->net, "asix_write_gpio() - value = 0x%04x\n", value);
310	ret = asix_write_cmd(dev, AX_CMD_WRITE_GPIOS, value, 0, 0, NULL);
311	if (ret < 0)
312		netdev_err(dev->net, "Failed to write GPIO value 0x%04x: %02x\n",
313			   value, ret);
314
315	if (sleep)
316		msleep(sleep);
317
318	return ret;
319}
320
321/*
322 * AX88772 & AX88178 have a 16-bit RX_CTL value
323 */
324void asix_set_multicast(struct net_device *net)
325{
326	struct usbnet *dev = netdev_priv(net);
327	struct asix_data *data = (struct asix_data *)&dev->data;
328	u16 rx_ctl = AX_DEFAULT_RX_CTL;
329
330	if (net->flags & IFF_PROMISC) {
331		rx_ctl |= AX_RX_CTL_PRO;
332	} else if (net->flags & IFF_ALLMULTI ||
333		   netdev_mc_count(net) > AX_MAX_MCAST) {
334		rx_ctl |= AX_RX_CTL_AMALL;
335	} else if (netdev_mc_empty(net)) {
336		/* just broadcast and directed */
337	} else {
338		/* We use the 20 byte dev->data
339		 * for our 8 byte filter buffer
340		 * to avoid allocating memory that
341		 * is tricky to free later */
342		struct netdev_hw_addr *ha;
343		u32 crc_bits;
344
345		memset(data->multi_filter, 0, AX_MCAST_FILTER_SIZE);
346
347		/* Build the multicast hash filter. */
348		netdev_for_each_mc_addr(ha, net) {
349			crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
350			data->multi_filter[crc_bits >> 3] |=
351			    1 << (crc_bits & 7);
352		}
353
354		asix_write_cmd_async(dev, AX_CMD_WRITE_MULTI_FILTER, 0, 0,
355				   AX_MCAST_FILTER_SIZE, data->multi_filter);
356
357		rx_ctl |= AX_RX_CTL_AM;
358	}
359
360	asix_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL);
361}
362
363int asix_mdio_read(struct net_device *netdev, int phy_id, int loc)
364{
365	struct usbnet *dev = netdev_priv(netdev);
366	__le16 res;
 
 
 
367
368	mutex_lock(&dev->phy_mutex);
369	asix_set_sw_mii(dev);
 
 
 
 
 
 
 
 
 
 
 
 
370	asix_read_cmd(dev, AX_CMD_READ_MII_REG, phy_id,
371				(__u16)loc, 2, &res);
372	asix_set_hw_mii(dev);
373	mutex_unlock(&dev->phy_mutex);
374
375	netdev_dbg(dev->net, "asix_mdio_read() phy_id=0x%02x, loc=0x%02x, returns=0x%04x\n",
376		   phy_id, loc, le16_to_cpu(res));
377
378	return le16_to_cpu(res);
379}
380
381void asix_mdio_write(struct net_device *netdev, int phy_id, int loc, int val)
382{
383	struct usbnet *dev = netdev_priv(netdev);
384	__le16 res = cpu_to_le16(val);
 
 
 
385
386	netdev_dbg(dev->net, "asix_mdio_write() phy_id=0x%02x, loc=0x%02x, val=0x%04x\n",
387		   phy_id, loc, val);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
388	mutex_lock(&dev->phy_mutex);
389	asix_set_sw_mii(dev);
390	asix_write_cmd(dev, AX_CMD_WRITE_MII_REG, phy_id, (__u16)loc, 2, &res);
391	asix_set_hw_mii(dev);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
392	mutex_unlock(&dev->phy_mutex);
393}
394
395void asix_get_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
396{
397	struct usbnet *dev = netdev_priv(net);
398	u8 opt;
399
400	if (asix_read_cmd(dev, AX_CMD_READ_MONITOR_MODE, 0, 0, 1, &opt) < 0) {
 
401		wolinfo->supported = 0;
402		wolinfo->wolopts = 0;
403		return;
404	}
405	wolinfo->supported = WAKE_PHY | WAKE_MAGIC;
406	wolinfo->wolopts = 0;
407	if (opt & AX_MONITOR_LINK)
408		wolinfo->wolopts |= WAKE_PHY;
409	if (opt & AX_MONITOR_MAGIC)
410		wolinfo->wolopts |= WAKE_MAGIC;
411}
412
413int asix_set_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
414{
415	struct usbnet *dev = netdev_priv(net);
416	u8 opt = 0;
417
418	if (wolinfo->wolopts & WAKE_PHY)
419		opt |= AX_MONITOR_LINK;
420	if (wolinfo->wolopts & WAKE_MAGIC)
421		opt |= AX_MONITOR_MAGIC;
422
423	if (asix_write_cmd(dev, AX_CMD_WRITE_MONITOR_MODE,
424			      opt, 0, 0, NULL) < 0)
425		return -EINVAL;
426
427	return 0;
428}
429
430int asix_get_eeprom_len(struct net_device *net)
431{
432	return AX_EEPROM_LEN;
433}
434
435int asix_get_eeprom(struct net_device *net, struct ethtool_eeprom *eeprom,
436		    u8 *data)
437{
438	struct usbnet *dev = netdev_priv(net);
439	u16 *eeprom_buff;
440	int first_word, last_word;
441	int i;
442
443	if (eeprom->len == 0)
444		return -EINVAL;
445
446	eeprom->magic = AX_EEPROM_MAGIC;
447
448	first_word = eeprom->offset >> 1;
449	last_word = (eeprom->offset + eeprom->len - 1) >> 1;
450
451	eeprom_buff = kmalloc(sizeof(u16) * (last_word - first_word + 1),
452			      GFP_KERNEL);
453	if (!eeprom_buff)
454		return -ENOMEM;
455
456	/* ax8817x returns 2 bytes from eeprom on read */
457	for (i = first_word; i <= last_word; i++) {
458		if (asix_read_cmd(dev, AX_CMD_READ_EEPROM, i, 0, 2,
459				  &(eeprom_buff[i - first_word])) < 0) {
460			kfree(eeprom_buff);
461			return -EIO;
462		}
463	}
464
465	memcpy(data, (u8 *)eeprom_buff + (eeprom->offset & 1), eeprom->len);
466	kfree(eeprom_buff);
467	return 0;
468}
469
470int asix_set_eeprom(struct net_device *net, struct ethtool_eeprom *eeprom,
471		    u8 *data)
472{
473	struct usbnet *dev = netdev_priv(net);
474	u16 *eeprom_buff;
475	int first_word, last_word;
476	int i;
477	int ret;
478
479	netdev_dbg(net, "write EEPROM len %d, offset %d, magic 0x%x\n",
480		   eeprom->len, eeprom->offset, eeprom->magic);
481
482	if (eeprom->len == 0)
483		return -EINVAL;
484
485	if (eeprom->magic != AX_EEPROM_MAGIC)
486		return -EINVAL;
487
488	first_word = eeprom->offset >> 1;
489	last_word = (eeprom->offset + eeprom->len - 1) >> 1;
490
491	eeprom_buff = kmalloc(sizeof(u16) * (last_word - first_word + 1),
492			      GFP_KERNEL);
493	if (!eeprom_buff)
494		return -ENOMEM;
495
496	/* align data to 16 bit boundaries, read the missing data from
497	   the EEPROM */
498	if (eeprom->offset & 1) {
499		ret = asix_read_cmd(dev, AX_CMD_READ_EEPROM, first_word, 0, 2,
500				    &(eeprom_buff[0]));
501		if (ret < 0) {
502			netdev_err(net, "Failed to read EEPROM at offset 0x%02x.\n", first_word);
503			goto free;
504		}
505	}
506
507	if ((eeprom->offset + eeprom->len) & 1) {
508		ret = asix_read_cmd(dev, AX_CMD_READ_EEPROM, last_word, 0, 2,
509				    &(eeprom_buff[last_word - first_word]));
510		if (ret < 0) {
511			netdev_err(net, "Failed to read EEPROM at offset 0x%02x.\n", last_word);
512			goto free;
513		}
514	}
515
516	memcpy((u8 *)eeprom_buff + (eeprom->offset & 1), data, eeprom->len);
517
518	/* write data to EEPROM */
519	ret = asix_write_cmd(dev, AX_CMD_WRITE_ENABLE, 0x0000, 0, 0, NULL);
520	if (ret < 0) {
521		netdev_err(net, "Failed to enable EEPROM write\n");
522		goto free;
523	}
524	msleep(20);
525
526	for (i = first_word; i <= last_word; i++) {
527		netdev_dbg(net, "write to EEPROM at offset 0x%02x, data 0x%04x\n",
528			   i, eeprom_buff[i - first_word]);
529		ret = asix_write_cmd(dev, AX_CMD_WRITE_EEPROM, i,
530				     eeprom_buff[i - first_word], 0, NULL);
531		if (ret < 0) {
532			netdev_err(net, "Failed to write EEPROM at offset 0x%02x.\n",
533				   i);
534			goto free;
535		}
536		msleep(20);
537	}
538
539	ret = asix_write_cmd(dev, AX_CMD_WRITE_DISABLE, 0x0000, 0, 0, NULL);
540	if (ret < 0) {
541		netdev_err(net, "Failed to disable EEPROM write\n");
542		goto free;
543	}
544
545	ret = 0;
546free:
547	kfree(eeprom_buff);
548	return ret;
549}
550
551void asix_get_drvinfo(struct net_device *net, struct ethtool_drvinfo *info)
552{
553	/* Inherit standard device info */
554	usbnet_get_drvinfo(net, info);
555	strlcpy(info->driver, DRIVER_NAME, sizeof(info->driver));
556	strlcpy(info->version, DRIVER_VERSION, sizeof(info->version));
557	info->eedump_len = AX_EEPROM_LEN;
558}
559
560int asix_set_mac_address(struct net_device *net, void *p)
561{
562	struct usbnet *dev = netdev_priv(net);
563	struct asix_data *data = (struct asix_data *)&dev->data;
564	struct sockaddr *addr = p;
565
566	if (netif_running(net))
567		return -EBUSY;
568	if (!is_valid_ether_addr(addr->sa_data))
569		return -EADDRNOTAVAIL;
570
571	memcpy(net->dev_addr, addr->sa_data, ETH_ALEN);
572
573	/* We use the 20 byte dev->data
574	 * for our 6 byte mac buffer
575	 * to avoid allocating memory that
576	 * is tricky to free later */
577	memcpy(data->mac_addr, addr->sa_data, ETH_ALEN);
578	asix_write_cmd_async(dev, AX_CMD_WRITE_NODE_ID, 0, 0, ETH_ALEN,
579							data->mac_addr);
580
581	return 0;
582}
v4.17
  1/*
  2 * ASIX AX8817X based USB 2.0 Ethernet Devices
  3 * Copyright (C) 2003-2006 David Hollis <dhollis@davehollis.com>
  4 * Copyright (C) 2005 Phil Chang <pchang23@sbcglobal.net>
  5 * Copyright (C) 2006 James Painter <jamie.painter@iname.com>
  6 * Copyright (c) 2002-2003 TiVo Inc.
  7 *
  8 * This program is free software; you can redistribute it and/or modify
  9 * it under the terms of the GNU General Public License as published by
 10 * the Free Software Foundation; either version 2 of the License, or
 11 * (at your option) any later version.
 12 *
 13 * This program is distributed in the hope that it will be useful,
 14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 16 * GNU General Public License for more details.
 17 *
 18 * You should have received a copy of the GNU General Public License
 19 * along with this program; if not, see <http://www.gnu.org/licenses/>.
 20 */
 21
 22#include "asix.h"
 23
 24int asix_read_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
 25		  u16 size, void *data, int in_pm)
 26{
 27	int ret;
 28	int (*fn)(struct usbnet *, u8, u8, u16, u16, void *, u16);
 29
 30	BUG_ON(!dev);
 31
 32	if (!in_pm)
 33		fn = usbnet_read_cmd;
 34	else
 35		fn = usbnet_read_cmd_nopm;
 36
 37	ret = fn(dev, cmd, USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 38		 value, index, data, size);
 39
 40	if (unlikely(ret < 0))
 41		netdev_warn(dev->net, "Failed to read reg index 0x%04x: %d\n",
 42			    index, ret);
 43
 
 
 44	return ret;
 45}
 46
 47int asix_write_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
 48		   u16 size, void *data, int in_pm)
 49{
 50	int ret;
 51	int (*fn)(struct usbnet *, u8, u8, u16, u16, const void *, u16);
 52
 53	BUG_ON(!dev);
 54
 55	if (!in_pm)
 56		fn = usbnet_write_cmd;
 57	else
 58		fn = usbnet_write_cmd_nopm;
 59
 60	ret = fn(dev, cmd, USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 61		 value, index, data, size);
 62
 63	if (unlikely(ret < 0))
 64		netdev_warn(dev->net, "Failed to write reg index 0x%04x: %d\n",
 65			    index, ret);
 66
 67	return ret;
 68}
 69
 70void asix_write_cmd_async(struct usbnet *dev, u8 cmd, u16 value, u16 index,
 71			  u16 size, void *data)
 72{
 73	usbnet_write_cmd_async(dev, cmd,
 74			       USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 75			       value, index, data, size);
 76}
 77
 78static void reset_asix_rx_fixup_info(struct asix_rx_fixup_info *rx)
 79{
 80	/* Reset the variables that have a lifetime outside of
 81	 * asix_rx_fixup_internal() so that future processing starts from a
 82	 * known set of initial conditions.
 83	 */
 84
 85	if (rx->ax_skb) {
 86		/* Discard any incomplete Ethernet frame in the netdev buffer */
 87		kfree_skb(rx->ax_skb);
 88		rx->ax_skb = NULL;
 89	}
 90
 91	/* Assume the Data header 32-bit word is at the start of the current
 92	 * or next URB socket buffer so reset all the state variables.
 93	 */
 94	rx->remaining = 0;
 95	rx->split_head = false;
 96	rx->header = 0;
 97}
 98
 99int asix_rx_fixup_internal(struct usbnet *dev, struct sk_buff *skb,
100			   struct asix_rx_fixup_info *rx)
101{
102	int offset = 0;
103	u16 size;
104
105	/* When an Ethernet frame spans multiple URB socket buffers,
106	 * do a sanity test for the Data header synchronisation.
107	 * Attempt to detect the situation of the previous socket buffer having
108	 * been truncated or a socket buffer was missing. These situations
109	 * cause a discontinuity in the data stream and therefore need to avoid
110	 * appending bad data to the end of the current netdev socket buffer.
111	 * Also avoid unnecessarily discarding a good current netdev socket
112	 * buffer.
113	 */
114	if (rx->remaining && (rx->remaining + sizeof(u32) <= skb->len)) {
115		offset = ((rx->remaining + 1) & 0xfffe);
116		rx->header = get_unaligned_le32(skb->data + offset);
117		offset = 0;
118
119		size = (u16)(rx->header & 0x7ff);
120		if (size != ((~rx->header >> 16) & 0x7ff)) {
121			netdev_err(dev->net, "asix_rx_fixup() Data Header synchronisation was lost, remaining %d\n",
122				   rx->remaining);
123			reset_asix_rx_fixup_info(rx);
124		}
125	}
126
127	while (offset + sizeof(u16) <= skb->len) {
128		u16 copy_length;
 
129
130		if (!rx->remaining) {
131			if (skb->len - offset == sizeof(u16)) {
132				rx->header = get_unaligned_le16(
133						skb->data + offset);
134				rx->split_head = true;
135				offset += sizeof(u16);
136				break;
137			}
138
139			if (rx->split_head == true) {
140				rx->header |= (get_unaligned_le16(
141						skb->data + offset) << 16);
142				rx->split_head = false;
143				offset += sizeof(u16);
 
 
144			} else {
145				rx->header = get_unaligned_le32(skb->data +
146								offset);
147				offset += sizeof(u32);
148			}
149
150			/* take frame length from Data header 32-bit word */
151			size = (u16)(rx->header & 0x7ff);
152			if (size != ((~rx->header >> 16) & 0x7ff)) {
153				netdev_err(dev->net, "asix_rx_fixup() Bad Header Length 0x%x, offset %d\n",
154					   rx->header, offset);
155				reset_asix_rx_fixup_info(rx);
156				return 0;
157			}
158			if (size > dev->net->mtu + ETH_HLEN + VLAN_HLEN) {
159				netdev_dbg(dev->net, "asix_rx_fixup() Bad RX Length %d\n",
160					   size);
161				reset_asix_rx_fixup_info(rx);
162				return 0;
163			}
164
165			/* Sometimes may fail to get a netdev socket buffer but
166			 * continue to process the URB socket buffer so that
167			 * synchronisation of the Ethernet frame Data header
168			 * word is maintained.
169			 */
170			rx->ax_skb = netdev_alloc_skb_ip_align(dev->net, size);
171
172			rx->remaining = size;
173		}
174
175		if (rx->remaining > skb->len - offset) {
176			copy_length = skb->len - offset;
177			rx->remaining -= copy_length;
178		} else {
179			copy_length = rx->remaining;
180			rx->remaining = 0;
181		}
182
183		if (rx->ax_skb) {
184			skb_put_data(rx->ax_skb, skb->data + offset,
185				     copy_length);
186			if (!rx->remaining) {
187				usbnet_skb_return(dev, rx->ax_skb);
188				rx->ax_skb = NULL;
189			}
190		}
191
192		offset += (copy_length + 1) & 0xfffe;
 
193	}
194
195	if (skb->len != offset) {
196		netdev_err(dev->net, "asix_rx_fixup() Bad SKB Length %d, %d\n",
197			   skb->len, offset);
198		reset_asix_rx_fixup_info(rx);
199		return 0;
200	}
201
202	return 1;
203}
204
205int asix_rx_fixup_common(struct usbnet *dev, struct sk_buff *skb)
206{
207	struct asix_common_private *dp = dev->driver_priv;
208	struct asix_rx_fixup_info *rx = &dp->rx_fixup_info;
209
210	return asix_rx_fixup_internal(dev, skb, rx);
211}
212
213void asix_rx_fixup_common_free(struct asix_common_private *dp)
214{
215	struct asix_rx_fixup_info *rx;
216
217	if (!dp)
218		return;
219
220	rx = &dp->rx_fixup_info;
221
222	if (rx->ax_skb) {
223		kfree_skb(rx->ax_skb);
224		rx->ax_skb = NULL;
225	}
226}
227
228struct sk_buff *asix_tx_fixup(struct usbnet *dev, struct sk_buff *skb,
229			      gfp_t flags)
230{
231	int padlen;
232	int headroom = skb_headroom(skb);
233	int tailroom = skb_tailroom(skb);
234	u32 packet_len;
235	u32 padbytes = 0xffff0000;
236
237	padlen = ((skb->len + 4) & (dev->maxpacket - 1)) ? 0 : 4;
238
239	/* We need to push 4 bytes in front of frame (packet_len)
240	 * and maybe add 4 bytes after the end (if padlen is 4)
241	 *
242	 * Avoid skb_copy_expand() expensive call, using following rules :
243	 * - We are allowed to push 4 bytes in headroom if skb_header_cloned()
244	 *   is false (and if we have 4 bytes of headroom)
245	 * - We are allowed to put 4 bytes at tail if skb_cloned()
246	 *   is false (and if we have 4 bytes of tailroom)
247	 *
248	 * TCP packets for example are cloned, but __skb_header_release()
249	 * was called in tcp stack, allowing us to use headroom for our needs.
250	 */
251	if (!skb_header_cloned(skb) &&
252	    !(padlen && skb_cloned(skb)) &&
253	    headroom + tailroom >= 4 + padlen) {
254		/* following should not happen, but better be safe */
255		if (headroom < 4 ||
256		    tailroom < padlen) {
257			skb->data = memmove(skb->head + 4, skb->data, skb->len);
258			skb_set_tail_pointer(skb, skb->len);
259		}
260	} else {
261		struct sk_buff *skb2;
262
263		skb2 = skb_copy_expand(skb, 4, padlen, flags);
264		dev_kfree_skb_any(skb);
265		skb = skb2;
266		if (!skb)
267			return NULL;
268	}
269
270	packet_len = ((skb->len ^ 0x0000ffff) << 16) + skb->len;
271	skb_push(skb, 4);
272	cpu_to_le32s(&packet_len);
273	skb_copy_to_linear_data(skb, &packet_len, sizeof(packet_len));
274
275	if (padlen) {
276		cpu_to_le32s(&padbytes);
277		memcpy(skb_tail_pointer(skb), &padbytes, sizeof(padbytes));
278		skb_put(skb, sizeof(padbytes));
279	}
280
281	usbnet_set_skb_tx_stats(skb, 1, 0);
282	return skb;
283}
284
285int asix_set_sw_mii(struct usbnet *dev, int in_pm)
286{
287	int ret;
288	ret = asix_write_cmd(dev, AX_CMD_SET_SW_MII, 0x0000, 0, 0, NULL, in_pm);
289
290	if (ret < 0)
291		netdev_err(dev->net, "Failed to enable software MII access\n");
292	return ret;
293}
294
295int asix_set_hw_mii(struct usbnet *dev, int in_pm)
296{
297	int ret;
298	ret = asix_write_cmd(dev, AX_CMD_SET_HW_MII, 0x0000, 0, 0, NULL, in_pm);
299	if (ret < 0)
300		netdev_err(dev->net, "Failed to enable hardware MII access\n");
301	return ret;
302}
303
304int asix_read_phy_addr(struct usbnet *dev, int internal)
305{
306	int offset = (internal ? 1 : 0);
307	u8 buf[2];
308	int ret = asix_read_cmd(dev, AX_CMD_READ_PHY_ID, 0, 0, 2, buf, 0);
309
310	netdev_dbg(dev->net, "asix_get_phy_addr()\n");
311
312	if (ret < 0) {
313		netdev_err(dev->net, "Error reading PHYID register: %02x\n", ret);
314		goto out;
315	}
316	netdev_dbg(dev->net, "asix_get_phy_addr() returning 0x%04x\n",
317		   *((__le16 *)buf));
318	ret = buf[offset];
319
320out:
321	return ret;
322}
323
324int asix_get_phy_addr(struct usbnet *dev)
325{
326	/* return the address of the internal phy */
327	return asix_read_phy_addr(dev, 1);
328}
329
330
331int asix_sw_reset(struct usbnet *dev, u8 flags, int in_pm)
332{
333	int ret;
334
335	ret = asix_write_cmd(dev, AX_CMD_SW_RESET, flags, 0, 0, NULL, in_pm);
336	if (ret < 0)
337		netdev_err(dev->net, "Failed to send software reset: %02x\n", ret);
338
339	return ret;
340}
341
342u16 asix_read_rx_ctl(struct usbnet *dev, int in_pm)
343{
344	__le16 v;
345	int ret = asix_read_cmd(dev, AX_CMD_READ_RX_CTL, 0, 0, 2, &v, in_pm);
346
347	if (ret < 0) {
348		netdev_err(dev->net, "Error reading RX_CTL register: %02x\n", ret);
349		goto out;
350	}
351	ret = le16_to_cpu(v);
352out:
353	return ret;
354}
355
356int asix_write_rx_ctl(struct usbnet *dev, u16 mode, int in_pm)
357{
358	int ret;
359
360	netdev_dbg(dev->net, "asix_write_rx_ctl() - mode = 0x%04x\n", mode);
361	ret = asix_write_cmd(dev, AX_CMD_WRITE_RX_CTL, mode, 0, 0, NULL, in_pm);
362	if (ret < 0)
363		netdev_err(dev->net, "Failed to write RX_CTL mode to 0x%04x: %02x\n",
364			   mode, ret);
365
366	return ret;
367}
368
369u16 asix_read_medium_status(struct usbnet *dev, int in_pm)
370{
371	__le16 v;
372	int ret = asix_read_cmd(dev, AX_CMD_READ_MEDIUM_STATUS,
373				0, 0, 2, &v, in_pm);
374
375	if (ret < 0) {
376		netdev_err(dev->net, "Error reading Medium Status register: %02x\n",
377			   ret);
378		return ret;	/* TODO: callers not checking for error ret */
379	}
380
381	return le16_to_cpu(v);
382
383}
384
385int asix_write_medium_mode(struct usbnet *dev, u16 mode, int in_pm)
386{
387	int ret;
388
389	netdev_dbg(dev->net, "asix_write_medium_mode() - mode = 0x%04x\n", mode);
390	ret = asix_write_cmd(dev, AX_CMD_WRITE_MEDIUM_MODE,
391			     mode, 0, 0, NULL, in_pm);
392	if (ret < 0)
393		netdev_err(dev->net, "Failed to write Medium Mode mode to 0x%04x: %02x\n",
394			   mode, ret);
395
396	return ret;
397}
398
399int asix_write_gpio(struct usbnet *dev, u16 value, int sleep, int in_pm)
400{
401	int ret;
402
403	netdev_dbg(dev->net, "asix_write_gpio() - value = 0x%04x\n", value);
404	ret = asix_write_cmd(dev, AX_CMD_WRITE_GPIOS, value, 0, 0, NULL, in_pm);
405	if (ret < 0)
406		netdev_err(dev->net, "Failed to write GPIO value 0x%04x: %02x\n",
407			   value, ret);
408
409	if (sleep)
410		msleep(sleep);
411
412	return ret;
413}
414
415/*
416 * AX88772 & AX88178 have a 16-bit RX_CTL value
417 */
418void asix_set_multicast(struct net_device *net)
419{
420	struct usbnet *dev = netdev_priv(net);
421	struct asix_data *data = (struct asix_data *)&dev->data;
422	u16 rx_ctl = AX_DEFAULT_RX_CTL;
423
424	if (net->flags & IFF_PROMISC) {
425		rx_ctl |= AX_RX_CTL_PRO;
426	} else if (net->flags & IFF_ALLMULTI ||
427		   netdev_mc_count(net) > AX_MAX_MCAST) {
428		rx_ctl |= AX_RX_CTL_AMALL;
429	} else if (netdev_mc_empty(net)) {
430		/* just broadcast and directed */
431	} else {
432		/* We use the 20 byte dev->data
433		 * for our 8 byte filter buffer
434		 * to avoid allocating memory that
435		 * is tricky to free later */
436		struct netdev_hw_addr *ha;
437		u32 crc_bits;
438
439		memset(data->multi_filter, 0, AX_MCAST_FILTER_SIZE);
440
441		/* Build the multicast hash filter. */
442		netdev_for_each_mc_addr(ha, net) {
443			crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
444			data->multi_filter[crc_bits >> 3] |=
445			    1 << (crc_bits & 7);
446		}
447
448		asix_write_cmd_async(dev, AX_CMD_WRITE_MULTI_FILTER, 0, 0,
449				   AX_MCAST_FILTER_SIZE, data->multi_filter);
450
451		rx_ctl |= AX_RX_CTL_AM;
452	}
453
454	asix_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL);
455}
456
457int asix_mdio_read(struct net_device *netdev, int phy_id, int loc)
458{
459	struct usbnet *dev = netdev_priv(netdev);
460	__le16 res;
461	u8 smsr;
462	int i = 0;
463	int ret;
464
465	mutex_lock(&dev->phy_mutex);
466	do {
467		ret = asix_set_sw_mii(dev, 0);
468		if (ret == -ENODEV || ret == -ETIMEDOUT)
469			break;
470		usleep_range(1000, 1100);
471		ret = asix_read_cmd(dev, AX_CMD_STATMNGSTS_REG,
472				    0, 0, 1, &smsr, 0);
473	} while (!(smsr & AX_HOST_EN) && (i++ < 30) && (ret != -ENODEV));
474	if (ret == -ENODEV || ret == -ETIMEDOUT) {
475		mutex_unlock(&dev->phy_mutex);
476		return ret;
477	}
478
479	asix_read_cmd(dev, AX_CMD_READ_MII_REG, phy_id,
480				(__u16)loc, 2, &res, 0);
481	asix_set_hw_mii(dev, 0);
482	mutex_unlock(&dev->phy_mutex);
483
484	netdev_dbg(dev->net, "asix_mdio_read() phy_id=0x%02x, loc=0x%02x, returns=0x%04x\n",
485			phy_id, loc, le16_to_cpu(res));
486
487	return le16_to_cpu(res);
488}
489
490void asix_mdio_write(struct net_device *netdev, int phy_id, int loc, int val)
491{
492	struct usbnet *dev = netdev_priv(netdev);
493	__le16 res = cpu_to_le16(val);
494	u8 smsr;
495	int i = 0;
496	int ret;
497
498	netdev_dbg(dev->net, "asix_mdio_write() phy_id=0x%02x, loc=0x%02x, val=0x%04x\n",
499			phy_id, loc, val);
500
501	mutex_lock(&dev->phy_mutex);
502	do {
503		ret = asix_set_sw_mii(dev, 0);
504		if (ret == -ENODEV)
505			break;
506		usleep_range(1000, 1100);
507		ret = asix_read_cmd(dev, AX_CMD_STATMNGSTS_REG,
508				    0, 0, 1, &smsr, 0);
509	} while (!(smsr & AX_HOST_EN) && (i++ < 30) && (ret != -ENODEV));
510	if (ret == -ENODEV) {
511		mutex_unlock(&dev->phy_mutex);
512		return;
513	}
514
515	asix_write_cmd(dev, AX_CMD_WRITE_MII_REG, phy_id,
516		       (__u16)loc, 2, &res, 0);
517	asix_set_hw_mii(dev, 0);
518	mutex_unlock(&dev->phy_mutex);
519}
520
521int asix_mdio_read_nopm(struct net_device *netdev, int phy_id, int loc)
522{
523	struct usbnet *dev = netdev_priv(netdev);
524	__le16 res;
525	u8 smsr;
526	int i = 0;
527	int ret;
528
529	mutex_lock(&dev->phy_mutex);
530	do {
531		ret = asix_set_sw_mii(dev, 1);
532		if (ret == -ENODEV || ret == -ETIMEDOUT)
533			break;
534		usleep_range(1000, 1100);
535		ret = asix_read_cmd(dev, AX_CMD_STATMNGSTS_REG,
536				    0, 0, 1, &smsr, 1);
537	} while (!(smsr & AX_HOST_EN) && (i++ < 30) && (ret != -ENODEV));
538	if (ret == -ENODEV || ret == -ETIMEDOUT) {
539		mutex_unlock(&dev->phy_mutex);
540		return ret;
541	}
542
543	asix_read_cmd(dev, AX_CMD_READ_MII_REG, phy_id,
544		      (__u16)loc, 2, &res, 1);
545	asix_set_hw_mii(dev, 1);
546	mutex_unlock(&dev->phy_mutex);
547
548	netdev_dbg(dev->net, "asix_mdio_read_nopm() phy_id=0x%02x, loc=0x%02x, returns=0x%04x\n",
549			phy_id, loc, le16_to_cpu(res));
550
551	return le16_to_cpu(res);
552}
553
554void
555asix_mdio_write_nopm(struct net_device *netdev, int phy_id, int loc, int val)
556{
557	struct usbnet *dev = netdev_priv(netdev);
558	__le16 res = cpu_to_le16(val);
559	u8 smsr;
560	int i = 0;
561	int ret;
562
563	netdev_dbg(dev->net, "asix_mdio_write() phy_id=0x%02x, loc=0x%02x, val=0x%04x\n",
564			phy_id, loc, val);
565
566	mutex_lock(&dev->phy_mutex);
567	do {
568		ret = asix_set_sw_mii(dev, 1);
569		if (ret == -ENODEV)
570			break;
571		usleep_range(1000, 1100);
572		ret = asix_read_cmd(dev, AX_CMD_STATMNGSTS_REG,
573				    0, 0, 1, &smsr, 1);
574	} while (!(smsr & AX_HOST_EN) && (i++ < 30) && (ret != -ENODEV));
575	if (ret == -ENODEV) {
576		mutex_unlock(&dev->phy_mutex);
577		return;
578	}
579
580	asix_write_cmd(dev, AX_CMD_WRITE_MII_REG, phy_id,
581		       (__u16)loc, 2, &res, 1);
582	asix_set_hw_mii(dev, 1);
583	mutex_unlock(&dev->phy_mutex);
584}
585
586void asix_get_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
587{
588	struct usbnet *dev = netdev_priv(net);
589	u8 opt;
590
591	if (asix_read_cmd(dev, AX_CMD_READ_MONITOR_MODE,
592			  0, 0, 1, &opt, 0) < 0) {
593		wolinfo->supported = 0;
594		wolinfo->wolopts = 0;
595		return;
596	}
597	wolinfo->supported = WAKE_PHY | WAKE_MAGIC;
598	wolinfo->wolopts = 0;
599	if (opt & AX_MONITOR_LINK)
600		wolinfo->wolopts |= WAKE_PHY;
601	if (opt & AX_MONITOR_MAGIC)
602		wolinfo->wolopts |= WAKE_MAGIC;
603}
604
605int asix_set_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
606{
607	struct usbnet *dev = netdev_priv(net);
608	u8 opt = 0;
609
610	if (wolinfo->wolopts & WAKE_PHY)
611		opt |= AX_MONITOR_LINK;
612	if (wolinfo->wolopts & WAKE_MAGIC)
613		opt |= AX_MONITOR_MAGIC;
614
615	if (asix_write_cmd(dev, AX_CMD_WRITE_MONITOR_MODE,
616			      opt, 0, 0, NULL, 0) < 0)
617		return -EINVAL;
618
619	return 0;
620}
621
622int asix_get_eeprom_len(struct net_device *net)
623{
624	return AX_EEPROM_LEN;
625}
626
627int asix_get_eeprom(struct net_device *net, struct ethtool_eeprom *eeprom,
628		    u8 *data)
629{
630	struct usbnet *dev = netdev_priv(net);
631	u16 *eeprom_buff;
632	int first_word, last_word;
633	int i;
634
635	if (eeprom->len == 0)
636		return -EINVAL;
637
638	eeprom->magic = AX_EEPROM_MAGIC;
639
640	first_word = eeprom->offset >> 1;
641	last_word = (eeprom->offset + eeprom->len - 1) >> 1;
642
643	eeprom_buff = kmalloc(sizeof(u16) * (last_word - first_word + 1),
644			      GFP_KERNEL);
645	if (!eeprom_buff)
646		return -ENOMEM;
647
648	/* ax8817x returns 2 bytes from eeprom on read */
649	for (i = first_word; i <= last_word; i++) {
650		if (asix_read_cmd(dev, AX_CMD_READ_EEPROM, i, 0, 2,
651				  &eeprom_buff[i - first_word], 0) < 0) {
652			kfree(eeprom_buff);
653			return -EIO;
654		}
655	}
656
657	memcpy(data, (u8 *)eeprom_buff + (eeprom->offset & 1), eeprom->len);
658	kfree(eeprom_buff);
659	return 0;
660}
661
662int asix_set_eeprom(struct net_device *net, struct ethtool_eeprom *eeprom,
663		    u8 *data)
664{
665	struct usbnet *dev = netdev_priv(net);
666	u16 *eeprom_buff;
667	int first_word, last_word;
668	int i;
669	int ret;
670
671	netdev_dbg(net, "write EEPROM len %d, offset %d, magic 0x%x\n",
672		   eeprom->len, eeprom->offset, eeprom->magic);
673
674	if (eeprom->len == 0)
675		return -EINVAL;
676
677	if (eeprom->magic != AX_EEPROM_MAGIC)
678		return -EINVAL;
679
680	first_word = eeprom->offset >> 1;
681	last_word = (eeprom->offset + eeprom->len - 1) >> 1;
682
683	eeprom_buff = kmalloc(sizeof(u16) * (last_word - first_word + 1),
684			      GFP_KERNEL);
685	if (!eeprom_buff)
686		return -ENOMEM;
687
688	/* align data to 16 bit boundaries, read the missing data from
689	   the EEPROM */
690	if (eeprom->offset & 1) {
691		ret = asix_read_cmd(dev, AX_CMD_READ_EEPROM, first_word, 0, 2,
692				    &eeprom_buff[0], 0);
693		if (ret < 0) {
694			netdev_err(net, "Failed to read EEPROM at offset 0x%02x.\n", first_word);
695			goto free;
696		}
697	}
698
699	if ((eeprom->offset + eeprom->len) & 1) {
700		ret = asix_read_cmd(dev, AX_CMD_READ_EEPROM, last_word, 0, 2,
701				    &eeprom_buff[last_word - first_word], 0);
702		if (ret < 0) {
703			netdev_err(net, "Failed to read EEPROM at offset 0x%02x.\n", last_word);
704			goto free;
705		}
706	}
707
708	memcpy((u8 *)eeprom_buff + (eeprom->offset & 1), data, eeprom->len);
709
710	/* write data to EEPROM */
711	ret = asix_write_cmd(dev, AX_CMD_WRITE_ENABLE, 0x0000, 0, 0, NULL, 0);
712	if (ret < 0) {
713		netdev_err(net, "Failed to enable EEPROM write\n");
714		goto free;
715	}
716	msleep(20);
717
718	for (i = first_word; i <= last_word; i++) {
719		netdev_dbg(net, "write to EEPROM at offset 0x%02x, data 0x%04x\n",
720			   i, eeprom_buff[i - first_word]);
721		ret = asix_write_cmd(dev, AX_CMD_WRITE_EEPROM, i,
722				     eeprom_buff[i - first_word], 0, NULL, 0);
723		if (ret < 0) {
724			netdev_err(net, "Failed to write EEPROM at offset 0x%02x.\n",
725				   i);
726			goto free;
727		}
728		msleep(20);
729	}
730
731	ret = asix_write_cmd(dev, AX_CMD_WRITE_DISABLE, 0x0000, 0, 0, NULL, 0);
732	if (ret < 0) {
733		netdev_err(net, "Failed to disable EEPROM write\n");
734		goto free;
735	}
736
737	ret = 0;
738free:
739	kfree(eeprom_buff);
740	return ret;
741}
742
743void asix_get_drvinfo(struct net_device *net, struct ethtool_drvinfo *info)
744{
745	/* Inherit standard device info */
746	usbnet_get_drvinfo(net, info);
747	strlcpy(info->driver, DRIVER_NAME, sizeof(info->driver));
748	strlcpy(info->version, DRIVER_VERSION, sizeof(info->version));
 
749}
750
751int asix_set_mac_address(struct net_device *net, void *p)
752{
753	struct usbnet *dev = netdev_priv(net);
754	struct asix_data *data = (struct asix_data *)&dev->data;
755	struct sockaddr *addr = p;
756
757	if (netif_running(net))
758		return -EBUSY;
759	if (!is_valid_ether_addr(addr->sa_data))
760		return -EADDRNOTAVAIL;
761
762	memcpy(net->dev_addr, addr->sa_data, ETH_ALEN);
763
764	/* We use the 20 byte dev->data
765	 * for our 6 byte mac buffer
766	 * to avoid allocating memory that
767	 * is tricky to free later */
768	memcpy(data->mac_addr, addr->sa_data, ETH_ALEN);
769	asix_write_cmd_async(dev, AX_CMD_WRITE_NODE_ID, 0, 0, ETH_ALEN,
770							data->mac_addr);
771
772	return 0;
773}