[deliverable/linux.git] / drivers / net / usb / asix_common.c

/*
 * ASIX AX8817X based USB 2.0 Ethernet Devices
 * Copyright (C) 2003-2006 David Hollis <dhollis@davehollis.com>
 * Copyright (C) 2005 Phil Chang <pchang23@sbcglobal.net>
 * Copyright (C) 2006 James Painter <jamie.painter@iname.com>
 * Copyright (c) 2002-2003 TiVo Inc.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, see <http://www.gnu.org/licenses/>.
 */

#include "asix.h"

int asix_read_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
		  u16 size, void *data)
{
	int ret;
	ret = usbnet_read_cmd(dev, cmd,
			       USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
			       value, index, data, size);

	if (ret != size && ret >= 0)
		return -EINVAL;
	return ret;
}

int asix_write_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
		   u16 size, void *data)
{
	return usbnet_write_cmd(dev, cmd,
				USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
				value, index, data, size);
}

void asix_write_cmd_async(struct usbnet *dev, u8 cmd, u16 value, u16 index,
			  u16 size, void *data)
{
	usbnet_write_cmd_async(dev, cmd,
			       USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
			       value, index, data, size);
}

int asix_rx_fixup_internal(struct usbnet *dev, struct sk_buff *skb,
			   struct asix_rx_fixup_info *rx)
{
	int offset = 0;
	u16 size;

	/* When an Ethernet frame spans multiple URB socket buffers,
	 * do a sanity test for the Data header synchronisation.
	 * Attempt to detect the situation of the previous socket buffer having
	 * been truncated or a socket buffer was missing. These situations
	 * cause a discontinuity in the data stream and therefore need to avoid
	 * appending bad data to the end of the current netdev socket buffer.
	 * Also avoid unnecessarily discarding a good current netdev socket
	 * buffer.
	 */
	if (rx->remaining && (rx->remaining + sizeof(u32) <= skb->len)) {
		offset = ((rx->remaining + 1) & 0xfffe);
		rx->header = get_unaligned_le32(skb->data + offset);
		offset = 0;

		size = (u16)(rx->header & 0x7ff);
		if (size != ((~rx->header >> 16) & 0x7ff)) {
			netdev_err(dev->net, "asix_rx_fixup() Data Header synchronisation was lost, remaining %d\n",
				   rx->remaining);
			if (rx->ax_skb) {
				kfree_skb(rx->ax_skb);
				rx->ax_skb = NULL;
				/* Discard the incomplete netdev Ethernet frame
				 * and assume the Data header is at the start of
				 * the current URB socket buffer.
				 */
			}
			rx->remaining = 0;
		}
	}

	while (offset + sizeof(u16) <= skb->len) {
		u16 copy_length;
		unsigned char *data;

		if (!rx->remaining) {
			if (skb->len - offset == sizeof(u16)) {
				rx->header = get_unaligned_le16(
						skb->data + offset);
				rx->split_head = true;
				offset += sizeof(u16);
				break;
			}

			if (rx->split_head == true) {
				rx->header |= (get_unaligned_le16(
						skb->data + offset) << 16);
				rx->split_head = false;
				offset += sizeof(u16);
			} else {
				rx->header = get_unaligned_le32(skb->data +
								offset);
				offset += sizeof(u32);
			}

			/* take frame length from Data header 32-bit word */
			size = (u16)(rx->header & 0x7ff);
			if (size != ((~rx->header >> 16) & 0x7ff)) {
				netdev_err(dev->net, "asix_rx_fixup() Bad Header Length 0x%x, offset %d\n",
					   rx->header, offset);
				return 0;
			}
			if (size > dev->net->mtu + ETH_HLEN + VLAN_HLEN) {
				netdev_dbg(dev->net, "asix_rx_fixup() Bad RX Length %d\n",
					   size);
				return 0;
			}

			/* Sometimes may fail to get a netdev socket buffer but
			 * continue to process the URB socket buffer so that
			 * synchronisation of the Ethernet frame Data header
			 * word is maintained.
			 */
			rx->ax_skb = netdev_alloc_skb_ip_align(dev->net, size);

			rx->remaining = size;
		}

		if (rx->remaining > skb->len - offset) {
			copy_length = skb->len - offset;
			rx->remaining -= copy_length;
		} else {
			copy_length = rx->remaining;
			rx->remaining = 0;
		}

		if (rx->ax_skb) {
			data = skb_put(rx->ax_skb, copy_length);
			memcpy(data, skb->data + offset, copy_length);
			if (!rx->remaining)
				usbnet_skb_return(dev, rx->ax_skb);
		}

		offset += (copy_length + 1) & 0xfffe;
	}

	if (skb->len != offset) {
		netdev_err(dev->net, "asix_rx_fixup() Bad SKB Length %d, %d\n",
			   skb->len, offset);
		return 0;
	}

	return 1;
}

int asix_rx_fixup_common(struct usbnet *dev, struct sk_buff *skb)
{
	struct asix_common_private *dp = dev->driver_priv;
	struct asix_rx_fixup_info *rx = &dp->rx_fixup_info;

	return asix_rx_fixup_internal(dev, skb, rx);
}

struct sk_buff *asix_tx_fixup(struct usbnet *dev, struct sk_buff *skb,
			      gfp_t flags)
{
	int padlen;
	int headroom = skb_headroom(skb);
	int tailroom = skb_tailroom(skb);
	u32 packet_len;
	u32 padbytes = 0xffff0000;

	padlen = ((skb->len + 4) & (dev->maxpacket - 1)) ? 0 : 4;

	/* We need to push 4 bytes in front of frame (packet_len)
	 * and maybe add 4 bytes after the end (if padlen is 4)
	 *
	 * Avoid skb_copy_expand() expensive call, using following rules :
	 * - We are allowed to push 4 bytes in headroom if skb_header_cloned()
	 *   is false (and if we have 4 bytes of headroom)
	 * - We are allowed to put 4 bytes at tail if skb_cloned()
	 *   is false (and if we have 4 bytes of tailroom)
	 *
	 * TCP packets for example are cloned, but skb_header_release()
	 * was called in tcp stack, allowing us to use headroom for our needs.
	 */
	if (!skb_header_cloned(skb) &&
	    !(padlen && skb_cloned(skb)) &&
	    headroom + tailroom >= 4 + padlen) {
		/* following should not happen, but better be safe */
		if (headroom < 4 ||
		    tailroom < padlen) {
			skb->data = memmove(skb->head + 4, skb->data, skb->len);
			skb_set_tail_pointer(skb, skb->len);
		}
	} else {
		struct sk_buff *skb2;

		skb2 = skb_copy_expand(skb, 4, padlen, flags);
		dev_kfree_skb_any(skb);
		skb = skb2;
		if (!skb)
			return NULL;
	}

	packet_len = ((skb->len ^ 0x0000ffff) << 16) + skb->len;
	skb_push(skb, 4);
	cpu_to_le32s(&packet_len);
	skb_copy_to_linear_data(skb, &packet_len, sizeof(packet_len));

	if (padlen) {
		cpu_to_le32s(&padbytes);
		memcpy(skb_tail_pointer(skb), &padbytes, sizeof(padbytes));
		skb_put(skb, sizeof(padbytes));
	}

	usbnet_set_skb_tx_stats(skb, 1, 0);
	return skb;
}

int asix_set_sw_mii(struct usbnet *dev)
{
	int ret;
	ret = asix_write_cmd(dev, AX_CMD_SET_SW_MII, 0x0000, 0, 0, NULL);
	if (ret < 0)
		netdev_err(dev->net, "Failed to enable software MII access\n");
	return ret;
}

int asix_set_hw_mii(struct usbnet *dev)
{
	int ret;
	ret = asix_write_cmd(dev, AX_CMD_SET_HW_MII, 0x0000, 0, 0, NULL);
	if (ret < 0)
		netdev_err(dev->net, "Failed to enable hardware MII access\n");
	return ret;
}

int asix_read_phy_addr(struct usbnet *dev, int internal)
{
	int offset = (internal ? 1 : 0);
	u8 buf[2];
	int ret = asix_read_cmd(dev, AX_CMD_READ_PHY_ID, 0, 0, 2, buf);

	netdev_dbg(dev->net, "asix_get_phy_addr()\n");

	if (ret < 0) {
		netdev_err(dev->net, "Error reading PHYID register: %02x\n", ret);
		goto out;
	}
	netdev_dbg(dev->net, "asix_get_phy_addr() returning 0x%04x\n",
		   *((__le16 *)buf));
	ret = buf[offset];

out:
	return ret;
}

int asix_get_phy_addr(struct usbnet *dev)
{
	/* return the address of the internal phy */
	return asix_read_phy_addr(dev, 1);
}


int asix_sw_reset(struct usbnet *dev, u8 flags)
{
	int ret;

        ret = asix_write_cmd(dev, AX_CMD_SW_RESET, flags, 0, 0, NULL);
	if (ret < 0)
		netdev_err(dev->net, "Failed to send software reset: %02x\n", ret);

	return ret;
}

u16 asix_read_rx_ctl(struct usbnet *dev)
{
	__le16 v;
	int ret = asix_read_cmd(dev, AX_CMD_READ_RX_CTL, 0, 0, 2, &v);

	if (ret < 0) {
		netdev_err(dev->net, "Error reading RX_CTL register: %02x\n", ret);
		goto out;
	}
	ret = le16_to_cpu(v);
out:
	return ret;
}

int asix_write_rx_ctl(struct usbnet *dev, u16 mode)
{
	int ret;

	netdev_dbg(dev->net, "asix_write_rx_ctl() - mode = 0x%04x\n", mode);
	ret = asix_write_cmd(dev, AX_CMD_WRITE_RX_CTL, mode, 0, 0, NULL);
	if (ret < 0)
		netdev_err(dev->net, "Failed to write RX_CTL mode to 0x%04x: %02x\n",
			   mode, ret);

	return ret;
}

u16 asix_read_medium_status(struct usbnet *dev)
{
	__le16 v;
	int ret = asix_read_cmd(dev, AX_CMD_READ_MEDIUM_STATUS, 0, 0, 2, &v);

	if (ret < 0) {
		netdev_err(dev->net, "Error reading Medium Status register: %02x\n",
			   ret);
		return ret;	/* TODO: callers not checking for error ret */
	}

	return le16_to_cpu(v);

}

int asix_write_medium_mode(struct usbnet *dev, u16 mode)
{
	int ret;

	netdev_dbg(dev->net, "asix_write_medium_mode() - mode = 0x%04x\n", mode);
	ret = asix_write_cmd(dev, AX_CMD_WRITE_MEDIUM_MODE, mode, 0, 0, NULL);
	if (ret < 0)
		netdev_err(dev->net, "Failed to write Medium Mode mode to 0x%04x: %02x\n",
			   mode, ret);

	return ret;
}

int asix_write_gpio(struct usbnet *dev, u16 value, int sleep)
{
	int ret;

	netdev_dbg(dev->net, "asix_write_gpio() - value = 0x%04x\n", value);
	ret = asix_write_cmd(dev, AX_CMD_WRITE_GPIOS, value, 0, 0, NULL);
	if (ret < 0)
		netdev_err(dev->net, "Failed to write GPIO value 0x%04x: %02x\n",
			   value, ret);

	if (sleep)
		msleep(sleep);

	return ret;
}

/*
 * AX88772 & AX88178 have a 16-bit RX_CTL value
 */
void asix_set_multicast(struct net_device *net)
{
	struct usbnet *dev = netdev_priv(net);
	struct asix_data *data = (struct asix_data *)&dev->data;
	u16 rx_ctl = AX_DEFAULT_RX_CTL;

	if (net->flags & IFF_PROMISC) {
		rx_ctl |= AX_RX_CTL_PRO;
	} else if (net->flags & IFF_ALLMULTI ||
		   netdev_mc_count(net) > AX_MAX_MCAST) {
		rx_ctl |= AX_RX_CTL_AMALL;
	} else if (netdev_mc_empty(net)) {
		/* just broadcast and directed */
	} else {
		/* We use the 20 byte dev->data
		 * for our 8 byte filter buffer
		 * to avoid allocating memory that
		 * is tricky to free later */
		struct netdev_hw_addr *ha;
		u32 crc_bits;

		memset(data->multi_filter, 0, AX_MCAST_FILTER_SIZE);

		/* Build the multicast hash filter. */
		netdev_for_each_mc_addr(ha, net) {
			crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
			data->multi_filter[crc_bits >> 3] |=
			    1 << (crc_bits & 7);
		}

		asix_write_cmd_async(dev, AX_CMD_WRITE_MULTI_FILTER, 0, 0,
				   AX_MCAST_FILTER_SIZE, data->multi_filter);

		rx_ctl |= AX_RX_CTL_AM;
	}

	asix_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL);
}

int asix_mdio_read(struct net_device *netdev, int phy_id, int loc)
{
	struct usbnet *dev = netdev_priv(netdev);
	__le16 res;

	mutex_lock(&dev->phy_mutex);
	asix_set_sw_mii(dev);
	asix_read_cmd(dev, AX_CMD_READ_MII_REG, phy_id,
				(__u16)loc, 2, &res);
	asix_set_hw_mii(dev);
	mutex_unlock(&dev->phy_mutex);

	netdev_dbg(dev->net, "asix_mdio_read() phy_id=0x%02x, loc=0x%02x, returns=0x%04x\n",
		   phy_id, loc, le16_to_cpu(res));

	return le16_to_cpu(res);
}

void asix_mdio_write(struct net_device *netdev, int phy_id, int loc, int val)
{
	struct usbnet *dev = netdev_priv(netdev);
	__le16 res = cpu_to_le16(val);

	netdev_dbg(dev->net, "asix_mdio_write() phy_id=0x%02x, loc=0x%02x, val=0x%04x\n",
		   phy_id, loc, val);
	mutex_lock(&dev->phy_mutex);
	asix_set_sw_mii(dev);
	asix_write_cmd(dev, AX_CMD_WRITE_MII_REG, phy_id, (__u16)loc, 2, &res);
	asix_set_hw_mii(dev);
	mutex_unlock(&dev->phy_mutex);
}

void asix_get_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
{
	struct usbnet *dev = netdev_priv(net);
	u8 opt;

	if (asix_read_cmd(dev, AX_CMD_READ_MONITOR_MODE, 0, 0, 1, &opt) < 0) {
		wolinfo->supported = 0;
		wolinfo->wolopts = 0;
		return;
	}
	wolinfo->supported = WAKE_PHY | WAKE_MAGIC;
	wolinfo->wolopts = 0;
	if (opt & AX_MONITOR_LINK)
		wolinfo->wolopts |= WAKE_PHY;
	if (opt & AX_MONITOR_MAGIC)
		wolinfo->wolopts |= WAKE_MAGIC;
}

int asix_set_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
{
	struct usbnet *dev = netdev_priv(net);
	u8 opt = 0;

	if (wolinfo->wolopts & WAKE_PHY)
		opt |= AX_MONITOR_LINK;
	if (wolinfo->wolopts & WAKE_MAGIC)
		opt |= AX_MONITOR_MAGIC;

	if (asix_write_cmd(dev, AX_CMD_WRITE_MONITOR_MODE,
			      opt, 0, 0, NULL) < 0)
		return -EINVAL;

	return 0;
}

int asix_get_eeprom_len(struct net_device *net)
{
	return AX_EEPROM_LEN;
}

int asix_get_eeprom(struct net_device *net, struct ethtool_eeprom *eeprom,
		    u8 *data)
{
	struct usbnet *dev = netdev_priv(net);
	u16 *eeprom_buff;
	int first_word, last_word;
	int i;

	if (eeprom->len == 0)
		return -EINVAL;

	eeprom->magic = AX_EEPROM_MAGIC;

	first_word = eeprom->offset >> 1;
	last_word = (eeprom->offset + eeprom->len - 1) >> 1;

	eeprom_buff = kmalloc(sizeof(u16) * (last_word - first_word + 1),
			      GFP_KERNEL);
	if (!eeprom_buff)
		return -ENOMEM;

	/* ax8817x returns 2 bytes from eeprom on read */
	for (i = first_word; i <= last_word; i++) {
		if (asix_read_cmd(dev, AX_CMD_READ_EEPROM, i, 0, 2,
				  &(eeprom_buff[i - first_word])) < 0) {
			kfree(eeprom_buff);
			return -EIO;
		}
	}

	memcpy(data, (u8 *)eeprom_buff + (eeprom->offset & 1), eeprom->len);
	kfree(eeprom_buff);
	return 0;
}

int asix_set_eeprom(struct net_device *net, struct ethtool_eeprom *eeprom,
		    u8 *data)
{
	struct usbnet *dev = netdev_priv(net);
	u16 *eeprom_buff;
	int first_word, last_word;
	int i;
	int ret;

	netdev_dbg(net, "write EEPROM len %d, offset %d, magic 0x%x\n",
		   eeprom->len, eeprom->offset, eeprom->magic);

	if (eeprom->len == 0)
		return -EINVAL;

	if (eeprom->magic != AX_EEPROM_MAGIC)
		return -EINVAL;

	first_word = eeprom->offset >> 1;
	last_word = (eeprom->offset + eeprom->len - 1) >> 1;

	eeprom_buff = kmalloc(sizeof(u16) * (last_word - first_word + 1),
			      GFP_KERNEL);
	if (!eeprom_buff)
		return -ENOMEM;

	/* align data to 16 bit boundaries, read the missing data from
	   the EEPROM */
	if (eeprom->offset & 1) {
		ret = asix_read_cmd(dev, AX_CMD_READ_EEPROM, first_word, 0, 2,
				    &(eeprom_buff[0]));
		if (ret < 0) {
			netdev_err(net, "Failed to read EEPROM at offset 0x%02x.\n", first_word);
			goto free;
		}
	}

	if ((eeprom->offset + eeprom->len) & 1) {
		ret = asix_read_cmd(dev, AX_CMD_READ_EEPROM, last_word, 0, 2,
				    &(eeprom_buff[last_word - first_word]));
		if (ret < 0) {
			netdev_err(net, "Failed to read EEPROM at offset 0x%02x.\n", last_word);
			goto free;
		}
	}

	memcpy((u8 *)eeprom_buff + (eeprom->offset & 1), data, eeprom->len);

	/* write data to EEPROM */
	ret = asix_write_cmd(dev, AX_CMD_WRITE_ENABLE, 0x0000, 0, 0, NULL);
	if (ret < 0) {
		netdev_err(net, "Failed to enable EEPROM write\n");
		goto free;
	}
	msleep(20);

	for (i = first_word; i <= last_word; i++) {
		netdev_dbg(net, "write to EEPROM at offset 0x%02x, data 0x%04x\n",
			   i, eeprom_buff[i - first_word]);
		ret = asix_write_cmd(dev, AX_CMD_WRITE_EEPROM, i,
				     eeprom_buff[i - first_word], 0, NULL);
		if (ret < 0) {
			netdev_err(net, "Failed to write EEPROM at offset 0x%02x.\n",
				   i);
			goto free;
		}
		msleep(20);
	}

	ret = asix_write_cmd(dev, AX_CMD_WRITE_DISABLE, 0x0000, 0, 0, NULL);
	if (ret < 0) {
		netdev_err(net, "Failed to disable EEPROM write\n");
		goto free;
	}

	ret = 0;
free:
	kfree(eeprom_buff);
	return ret;
}

void asix_get_drvinfo(struct net_device *net, struct ethtool_drvinfo *info)
{
	/* Inherit standard device info */
	usbnet_get_drvinfo(net, info);
	strlcpy(info->driver, DRIVER_NAME, sizeof(info->driver));
	strlcpy(info->version, DRIVER_VERSION, sizeof(info->version));
}

int asix_set_mac_address(struct net_device *net, void *p)
{
	struct usbnet *dev = netdev_priv(net);
	struct asix_data *data = (struct asix_data *)&dev->data;
	struct sockaddr *addr = p;

	if (netif_running(net))
		return -EBUSY;
	if (!is_valid_ether_addr(addr->sa_data))
		return -EADDRNOTAVAIL;

	memcpy(net->dev_addr, addr->sa_data, ETH_ALEN);

	/* We use the 20 byte dev->data
	 * for our 6 byte mac buffer
	 * to avoid allocating memory that
	 * is tricky to free later */
	memcpy(data->mac_addr, addr->sa_data, ETH_ALEN);
	asix_write_cmd_async(dev, AX_CMD_WRITE_NODE_ID, 0, 0, ETH_ALEN,
							data->mac_addr);

	return 0;
}
Commit	Line	Data
2e55cc72 DB	1	/*
2e55cc72 DB	2	* ASIX AX8817X based USB 2.0 Ethernet Devices
933a27d3	3	* Copyright (C) 2003-2006 David Hollis <dhollis@davehollis.com>
2e55cc72	4	* Copyright (C) 2005 Phil Chang <pchang23@sbcglobal.net>
933a27d3	5	* Copyright (C) 2006 James Painter <jamie.painter@iname.com>
2e55cc72 DB	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
9cb00073	19	* along with this program; if not, see <http://www.gnu.org/licenses/>.
2e55cc72 DB	20	*/
2e55cc72 DB	21
607740bc CR	22	#include "asix.h"
	23
	24	int asix_read_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
	25	u16 size, void *data)
2e55cc72	26	{
0bc69efb ML	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;
2e55cc72 DB	35	}
2e55cc72 DB	36
607740bc CR	37	int asix_write_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
607740bc CR	38	u16 size, void *data)
2e55cc72	39	{
0bc69efb ML	40	return usbnet_write_cmd(dev, cmd,
	41	USB_DIR_OUT \| USB_TYPE_VENDOR \| USB_RECIP_DEVICE,
	42	value, index, data, size);
2e55cc72 DB	43	}
2e55cc72 DB	44
607740bc CR	45	void asix_write_cmd_async(struct usbnet *dev, u8 cmd, u16 value, u16 index,
607740bc CR	46	u16 size, void *data)
933a27d3	47	{
0bc69efb ML	48	usbnet_write_cmd_async(dev, cmd,
	49	USB_DIR_OUT \| USB_TYPE_VENDOR \| USB_RECIP_DEVICE,
	50	value, index, data, size);
933a27d3 DH	51	}
933a27d3 DH	52
8b5b6f54 LS	53	int asix_rx_fixup_internal(struct usbnet dev, struct sk_buff skb,
8b5b6f54 LS	54	struct asix_rx_fixup_info *rx)
933a27d3	55	{
a9e0aca4	56	int offset = 0;
7b0378f5	57	u16 size;
933a27d3	58
3f30b158 DJ	59	/* When an Ethernet frame spans multiple URB socket buffers,
	60	* do a sanity test for the Data header synchronisation.
	61	* Attempt to detect the situation of the previous socket buffer having
	62	* been truncated or a socket buffer was missing. These situations
	63	* cause a discontinuity in the data stream and therefore need to avoid
	64	* appending bad data to the end of the current netdev socket buffer.
	65	* Also avoid unnecessarily discarding a good current netdev socket
	66	* buffer.
	67	*/
	68	if (rx->remaining && (rx->remaining + sizeof(u32) <= skb->len)) {
cd9e2e5d	69	offset = ((rx->remaining + 1) & 0xfffe);
3f30b158 DJ	70	rx->header = get_unaligned_le32(skb->data + offset);
	71	offset = 0;
	72
	73	size = (u16)(rx->header & 0x7ff);
	74	if (size != ((~rx->header >> 16) & 0x7ff)) {
	75	netdev_err(dev->net, "asix_rx_fixup() Data Header synchronisation was lost, remaining %d\n",
	76	rx->remaining);
6a570814 DJ	77	if (rx->ax_skb) {
	78	kfree_skb(rx->ax_skb);
	79	rx->ax_skb = NULL;
	80	/* Discard the incomplete netdev Ethernet frame
	81	* and assume the Data header is at the start of
	82	* the current URB socket buffer.
	83	*/
	84	}
3f30b158 DJ	85	rx->remaining = 0;
	86	}
	87	}
	88
8b5b6f54	89	while (offset + sizeof(u16) <= skb->len) {
7b0378f5	90	u16 copy_length;
8b5b6f54	91	unsigned char *data;
933a27d3	92
7b0378f5	93	if (!rx->remaining) {
3bfc69ab DJ	94	if (skb->len - offset == sizeof(u16)) {
	95	rx->header = get_unaligned_le16(
	96	skb->data + offset);
	97	rx->split_head = true;
	98	offset += sizeof(u16);
	99	break;
	100	}
	101
	102	if (rx->split_head == true) {
	103	rx->header \|= (get_unaligned_le16(
	104	skb->data + offset) << 16);
	105	rx->split_head = false;
	106	offset += sizeof(u16);
8b5b6f54 LS	107	} else {
	108	rx->header = get_unaligned_le32(skb->data +
	109	offset);
	110	offset += sizeof(u32);
	111	}
bc466e67	112
7b0378f5 DJ	113	/* take frame length from Data header 32-bit word */
	114	size = (u16)(rx->header & 0x7ff);
	115	if (size != ((~rx->header >> 16) & 0x7ff)) {
8b5b6f54 LS	116	netdev_err(dev->net, "asix_rx_fixup() Bad Header Length 0x%x, offset %d\n",
8b5b6f54 LS	117	rx->header, offset);
8b5b6f54 LS	118	return 0;
8b5b6f54 LS	119	}
9a5ccd8e	120	if (size > dev->net->mtu + ETH_HLEN + VLAN_HLEN) {
b70183db	121	netdev_dbg(dev->net, "asix_rx_fixup() Bad RX Length %d\n",
9a5ccd8e DJ	122	size);
	123	return 0;
	124	}
	125
6a570814 DJ	126	/* Sometimes may fail to get a netdev socket buffer but
	127	* continue to process the URB socket buffer so that
	128	* synchronisation of the Ethernet frame Data header
	129	* word is maintained.
	130	*/
7b0378f5	131	rx->ax_skb = netdev_alloc_skb_ip_align(dev->net, size);
3f78d1f2	132
9a5ccd8e	133	rx->remaining = size;
933a27d3	134	}
933a27d3	135
7b0378f5 DJ	136	if (rx->remaining > skb->len - offset) {
	137	copy_length = skb->len - offset;
	138	rx->remaining -= copy_length;
	139	} else {
	140	copy_length = rx->remaining;
	141	rx->remaining = 0;
8b5b6f54	142	}
933a27d3	143
6a570814 DJ	144	if (rx->ax_skb) {
	145	data = skb_put(rx->ax_skb, copy_length);
	146	memcpy(data, skb->data + offset, copy_length);
	147	if (!rx->remaining)
	148	usbnet_skb_return(dev, rx->ax_skb);
	149	}
8b5b6f54	150
7b0378f5	151	offset += (copy_length + 1) & 0xfffe;
933a27d3 DH	152	}
933a27d3 DH	153
a9e0aca4	154	if (skb->len != offset) {
8b5b6f54 LS	155	netdev_err(dev->net, "asix_rx_fixup() Bad SKB Length %d, %d\n",
8b5b6f54 LS	156	skb->len, offset);
933a27d3 DH	157	return 0;
933a27d3 DH	158	}
8b5b6f54	159
933a27d3 DH	160	return 1;
	161	}
	162
8b5b6f54 LS	163	int asix_rx_fixup_common(struct usbnet dev, struct sk_buff skb)
	164	{
	165	struct asix_common_private *dp = dev->driver_priv;
	166	struct asix_rx_fixup_info *rx = &dp->rx_fixup_info;
	167
	168	return asix_rx_fixup_internal(dev, skb, rx);
	169	}
	170
607740bc CR	171	struct sk_buff asix_tx_fixup(struct usbnet dev, struct sk_buff *skb,
607740bc CR	172	gfp_t flags)
933a27d3 DH	173	{
	174	int padlen;
	175	int headroom = skb_headroom(skb);
	176	int tailroom = skb_tailroom(skb);
	177	u32 packet_len;
	178	u32 padbytes = 0xffff0000;
	179
2a580949	180	padlen = ((skb->len + 4) & (dev->maxpacket - 1)) ? 0 : 4;
933a27d3	181
95162d65 ED	182	/* We need to push 4 bytes in front of frame (packet_len)
	183	* and maybe add 4 bytes after the end (if padlen is 4)
	184	*
	185	* Avoid skb_copy_expand() expensive call, using following rules :
	186	* - We are allowed to push 4 bytes in headroom if skb_header_cloned()
	187	* is false (and if we have 4 bytes of headroom)
	188	* - We are allowed to put 4 bytes at tail if skb_cloned()
	189	* is false (and if we have 4 bytes of tailroom)
	190	*
	191	* TCP packets for example are cloned, but skb_header_release()
	192	* was called in tcp stack, allowing us to use headroom for our needs.
	193	*/
	194	if (!skb_header_cloned(skb) &&
	195	!(padlen && skb_cloned(skb)) &&
	196	headroom + tailroom >= 4 + padlen) {
	197	/* following should not happen, but better be safe */
	198	if (headroom < 4 \|\|
	199	tailroom < padlen) {
933a27d3	200	skb->data = memmove(skb->head + 4, skb->data, skb->len);
27a884dc	201	skb_set_tail_pointer(skb, skb->len);
933a27d3 DH	202	}
	203	} else {
	204	struct sk_buff *skb2;
95162d65	205
933a27d3 DH	206	skb2 = skb_copy_expand(skb, 4, padlen, flags);
	207	dev_kfree_skb_any(skb);
	208	skb = skb2;
	209	if (!skb)
	210	return NULL;
	211	}
	212
95162d65	213	packet_len = ((skb->len ^ 0x0000ffff) << 16) + skb->len;
933a27d3	214	skb_push(skb, 4);
57e4f041	215	cpu_to_le32s(&packet_len);
27d7ff46	216	skb_copy_to_linear_data(skb, &packet_len, sizeof(packet_len));
933a27d3	217
2a580949	218	if (padlen) {
57e4f041	219	cpu_to_le32s(&padbytes);
27a884dc	220	memcpy(skb_tail_pointer(skb), &padbytes, sizeof(padbytes));
933a27d3 DH	221	skb_put(skb, sizeof(padbytes));
933a27d3 DH	222	}
1e9e39f4	223
7a1e890e	224	usbnet_set_skb_tx_stats(skb, 1, 0);
933a27d3 DH	225	return skb;
	226	}
	227
607740bc	228	int asix_set_sw_mii(struct usbnet *dev)
48b1be6a DH	229	{
	230	int ret;
	231	ret = asix_write_cmd(dev, AX_CMD_SET_SW_MII, 0x0000, 0, 0, NULL);
	232	if (ret < 0)
60b86755	233	netdev_err(dev->net, "Failed to enable software MII access\n");
48b1be6a DH	234	return ret;
	235	}
	236
607740bc	237	int asix_set_hw_mii(struct usbnet *dev)
48b1be6a DH	238	{
	239	int ret;
	240	ret = asix_write_cmd(dev, AX_CMD_SET_HW_MII, 0x0000, 0, 0, NULL);
	241	if (ret < 0)
60b86755	242	netdev_err(dev->net, "Failed to enable hardware MII access\n");
48b1be6a DH	243	return ret;
	244	}
	245
16626b0c	246	int asix_read_phy_addr(struct usbnet *dev, int internal)
48b1be6a	247	{
16626b0c	248	int offset = (internal ? 1 : 0);
51bf2976 AV	249	u8 buf[2];
51bf2976 AV	250	int ret = asix_read_cmd(dev, AX_CMD_READ_PHY_ID, 0, 0, 2, buf);
48b1be6a	251
60b86755	252	netdev_dbg(dev->net, "asix_get_phy_addr()\n");
933a27d3	253
51bf2976	254	if (ret < 0) {
60b86755	255	netdev_err(dev->net, "Error reading PHYID register: %02x\n", ret);
51bf2976	256	goto out;
48b1be6a	257	}
60b86755 JP	258	netdev_dbg(dev->net, "asix_get_phy_addr() returning 0x%04x\n",
60b86755 JP	259	((__le16 )buf));
16626b0c	260	ret = buf[offset];
51bf2976 AV	261
51bf2976 AV	262	out:
48b1be6a DH	263	return ret;
	264	}
	265
16626b0c CR	266	int asix_get_phy_addr(struct usbnet *dev)
	267	{
	268	/* return the address of the internal phy */
	269	return asix_read_phy_addr(dev, 1);
	270	}
	271
	272
607740bc	273	int asix_sw_reset(struct usbnet *dev, u8 flags)
48b1be6a DH	274	{
	275	int ret;
	276
	277	ret = asix_write_cmd(dev, AX_CMD_SW_RESET, flags, 0, 0, NULL);
	278	if (ret < 0)
60b86755	279	netdev_err(dev->net, "Failed to send software reset: %02x\n", ret);
933a27d3 DH	280
	281	return ret;
	282	}
48b1be6a	283
607740bc	284	u16 asix_read_rx_ctl(struct usbnet *dev)
933a27d3	285	{
51bf2976 AV	286	__le16 v;
51bf2976 AV	287	int ret = asix_read_cmd(dev, AX_CMD_READ_RX_CTL, 0, 0, 2, &v);
933a27d3	288
51bf2976	289	if (ret < 0) {
60b86755	290	netdev_err(dev->net, "Error reading RX_CTL register: %02x\n", ret);
51bf2976	291	goto out;
933a27d3	292	}
51bf2976 AV	293	ret = le16_to_cpu(v);
51bf2976 AV	294	out:
48b1be6a DH	295	return ret;
	296	}
	297
607740bc	298	int asix_write_rx_ctl(struct usbnet *dev, u16 mode)
48b1be6a DH	299	{
	300	int ret;
	301
60b86755	302	netdev_dbg(dev->net, "asix_write_rx_ctl() - mode = 0x%04x\n", mode);
48b1be6a DH	303	ret = asix_write_cmd(dev, AX_CMD_WRITE_RX_CTL, mode, 0, 0, NULL);
48b1be6a DH	304	if (ret < 0)
60b86755 JP	305	netdev_err(dev->net, "Failed to write RX_CTL mode to 0x%04x: %02x\n",
60b86755 JP	306	mode, ret);
48b1be6a DH	307
	308	return ret;
	309	}
	310
607740bc	311	u16 asix_read_medium_status(struct usbnet *dev)
2e55cc72	312	{
51bf2976 AV	313	__le16 v;
51bf2976 AV	314	int ret = asix_read_cmd(dev, AX_CMD_READ_MEDIUM_STATUS, 0, 0, 2, &v);
2e55cc72	315
51bf2976	316	if (ret < 0) {
60b86755 JP	317	netdev_err(dev->net, "Error reading Medium Status register: %02x\n",
60b86755 JP	318	ret);
83e1b918	319	return ret; /* TODO: callers not checking for error ret */
2e55cc72	320	}
83e1b918 GG	321
	322	return le16_to_cpu(v);
	323
2e55cc72 DB	324	}
2e55cc72 DB	325
607740bc	326	int asix_write_medium_mode(struct usbnet *dev, u16 mode)
2e55cc72	327	{
933a27d3	328	int ret;
2e55cc72	329
60b86755	330	netdev_dbg(dev->net, "asix_write_medium_mode() - mode = 0x%04x\n", mode);
933a27d3 DH	331	ret = asix_write_cmd(dev, AX_CMD_WRITE_MEDIUM_MODE, mode, 0, 0, NULL);
933a27d3 DH	332	if (ret < 0)
60b86755 JP	333	netdev_err(dev->net, "Failed to write Medium Mode mode to 0x%04x: %02x\n",
60b86755 JP	334	mode, ret);
2e55cc72	335
933a27d3 DH	336	return ret;
933a27d3 DH	337	}
2e55cc72	338
607740bc	339	int asix_write_gpio(struct usbnet *dev, u16 value, int sleep)
933a27d3 DH	340	{
933a27d3 DH	341	int ret;
2e55cc72	342
60b86755	343	netdev_dbg(dev->net, "asix_write_gpio() - value = 0x%04x\n", value);
933a27d3 DH	344	ret = asix_write_cmd(dev, AX_CMD_WRITE_GPIOS, value, 0, 0, NULL);
933a27d3 DH	345	if (ret < 0)
60b86755 JP	346	netdev_err(dev->net, "Failed to write GPIO value 0x%04x: %02x\n",
60b86755 JP	347	value, ret);
2e55cc72	348
933a27d3 DH	349	if (sleep)
	350	msleep(sleep);
	351
	352	return ret;
2e55cc72 DB	353	}
2e55cc72 DB	354
933a27d3 DH	355	/*
	356	* AX88772 & AX88178 have a 16-bit RX_CTL value
	357	*/
607740bc	358	void asix_set_multicast(struct net_device *net)
2e55cc72 DB	359	{
2e55cc72 DB	360	struct usbnet *dev = netdev_priv(net);
48b1be6a	361	struct asix_data data = (struct asix_data )&dev->data;
933a27d3	362	u16 rx_ctl = AX_DEFAULT_RX_CTL;
2e55cc72 DB	363
2e55cc72 DB	364	if (net->flags & IFF_PROMISC) {
933a27d3	365	rx_ctl \|= AX_RX_CTL_PRO;
8e95a202	366	} else if (net->flags & IFF_ALLMULTI \|\|
4cd24eaf	367	netdev_mc_count(net) > AX_MAX_MCAST) {
933a27d3	368	rx_ctl \|= AX_RX_CTL_AMALL;
4cd24eaf	369	} else if (netdev_mc_empty(net)) {
2e55cc72 DB	370	/* just broadcast and directed */
	371	} else {
	372	/* We use the 20 byte dev->data
	373	* for our 8 byte filter buffer
	374	* to avoid allocating memory that
	375	* is tricky to free later */
22bedad3	376	struct netdev_hw_addr *ha;
2e55cc72	377	u32 crc_bits;
2e55cc72 DB	378
	379	memset(data->multi_filter, 0, AX_MCAST_FILTER_SIZE);
	380
	381	/* Build the multicast hash filter. */
22bedad3 JP	382	netdev_for_each_mc_addr(ha, net) {
22bedad3 JP	383	crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
2e55cc72 DB	384	data->multi_filter[crc_bits >> 3] \|=
2e55cc72 DB	385	1 << (crc_bits & 7);
2e55cc72 DB	386	}
2e55cc72 DB	387
48b1be6a	388	asix_write_cmd_async(dev, AX_CMD_WRITE_MULTI_FILTER, 0, 0,
2e55cc72 DB	389	AX_MCAST_FILTER_SIZE, data->multi_filter);
2e55cc72 DB	390
933a27d3	391	rx_ctl \|= AX_RX_CTL_AM;
2e55cc72 DB	392	}
2e55cc72 DB	393
48b1be6a	394	asix_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL);
2e55cc72 DB	395	}
2e55cc72 DB	396
607740bc	397	int asix_mdio_read(struct net_device *netdev, int phy_id, int loc)
2e55cc72 DB	398	{
2e55cc72 DB	399	struct usbnet *dev = netdev_priv(netdev);
51bf2976	400	__le16 res;
2e55cc72	401
a9fc6338	402	mutex_lock(&dev->phy_mutex);
48b1be6a DH	403	asix_set_sw_mii(dev);
48b1be6a DH	404	asix_read_cmd(dev, AX_CMD_READ_MII_REG, phy_id,
51bf2976	405	(__u16)loc, 2, &res);
48b1be6a	406	asix_set_hw_mii(dev);
a9fc6338	407	mutex_unlock(&dev->phy_mutex);
2e55cc72	408
60b86755 JP	409	netdev_dbg(dev->net, "asix_mdio_read() phy_id=0x%02x, loc=0x%02x, returns=0x%04x\n",
60b86755 JP	410	phy_id, loc, le16_to_cpu(res));
2e55cc72	411
51bf2976	412	return le16_to_cpu(res);
2e55cc72 DB	413	}
2e55cc72 DB	414
607740bc	415	void asix_mdio_write(struct net_device *netdev, int phy_id, int loc, int val)
2e55cc72 DB	416	{
2e55cc72 DB	417	struct usbnet *dev = netdev_priv(netdev);
51bf2976	418	__le16 res = cpu_to_le16(val);
2e55cc72	419
60b86755 JP	420	netdev_dbg(dev->net, "asix_mdio_write() phy_id=0x%02x, loc=0x%02x, val=0x%04x\n",
60b86755 JP	421	phy_id, loc, val);
a9fc6338	422	mutex_lock(&dev->phy_mutex);
48b1be6a	423	asix_set_sw_mii(dev);
51bf2976	424	asix_write_cmd(dev, AX_CMD_WRITE_MII_REG, phy_id, (__u16)loc, 2, &res);
48b1be6a	425	asix_set_hw_mii(dev);
a9fc6338	426	mutex_unlock(&dev->phy_mutex);
2e55cc72 DB	427	}
2e55cc72 DB	428
607740bc	429	void asix_get_wol(struct net_device net, struct ethtool_wolinfo wolinfo)
2e55cc72 DB	430	{
	431	struct usbnet *dev = netdev_priv(net);
	432	u8 opt;
	433
48b1be6a	434	if (asix_read_cmd(dev, AX_CMD_READ_MONITOR_MODE, 0, 0, 1, &opt) < 0) {
2e55cc72 DB	435	wolinfo->supported = 0;
	436	wolinfo->wolopts = 0;
	437	return;
	438	}
	439	wolinfo->supported = WAKE_PHY \| WAKE_MAGIC;
	440	wolinfo->wolopts = 0;
f87ce5b2	441	if (opt & AX_MONITOR_LINK)
	442	wolinfo->wolopts \|= WAKE_PHY;
	443	if (opt & AX_MONITOR_MAGIC)
	444	wolinfo->wolopts \|= WAKE_MAGIC;
2e55cc72 DB	445	}
2e55cc72 DB	446
607740bc	447	int asix_set_wol(struct net_device net, struct ethtool_wolinfo wolinfo)
2e55cc72 DB	448	{
	449	struct usbnet *dev = netdev_priv(net);
	450	u8 opt = 0;
2e55cc72 DB	451
	452	if (wolinfo->wolopts & WAKE_PHY)
	453	opt \|= AX_MONITOR_LINK;
	454	if (wolinfo->wolopts & WAKE_MAGIC)
	455	opt \|= AX_MONITOR_MAGIC;
2e55cc72	456
48b1be6a	457	if (asix_write_cmd(dev, AX_CMD_WRITE_MONITOR_MODE,
51bf2976	458	opt, 0, 0, NULL) < 0)
2e55cc72 DB	459	return -EINVAL;
	460
	461	return 0;
	462	}
	463
607740bc	464	int asix_get_eeprom_len(struct net_device *net)
2e55cc72	465	{
ceb02c91	466	return AX_EEPROM_LEN;
2e55cc72 DB	467	}
2e55cc72 DB	468
607740bc CR	469	int asix_get_eeprom(struct net_device net, struct ethtool_eeprom eeprom,
607740bc CR	470	u8 *data)
2e55cc72 DB	471	{
2e55cc72 DB	472	struct usbnet *dev = netdev_priv(net);
ceb02c91 CR	473	u16 *eeprom_buff;
ceb02c91 CR	474	int first_word, last_word;
2e55cc72 DB	475	int i;
2e55cc72 DB	476
ceb02c91	477	if (eeprom->len == 0)
2e55cc72 DB	478	return -EINVAL;
	479
	480	eeprom->magic = AX_EEPROM_MAGIC;
	481
ceb02c91 CR	482	first_word = eeprom->offset >> 1;
	483	last_word = (eeprom->offset + eeprom->len - 1) >> 1;
	484
	485	eeprom_buff = kmalloc(sizeof(u16) * (last_word - first_word + 1),
	486	GFP_KERNEL);
	487	if (!eeprom_buff)
	488	return -ENOMEM;
	489
2e55cc72	490	/* ax8817x returns 2 bytes from eeprom on read */
ceb02c91 CR	491	for (i = first_word; i <= last_word; i++) {
	492	if (asix_read_cmd(dev, AX_CMD_READ_EEPROM, i, 0, 2,
	493	&(eeprom_buff[i - first_word])) < 0) {
	494	kfree(eeprom_buff);
	495	return -EIO;
	496	}
2e55cc72	497	}
ceb02c91 CR	498
	499	memcpy(data, (u8 *)eeprom_buff + (eeprom->offset & 1), eeprom->len);
	500	kfree(eeprom_buff);
2e55cc72 DB	501	return 0;
	502	}
	503
cb7b24cd CR	504	int asix_set_eeprom(struct net_device net, struct ethtool_eeprom eeprom,
	505	u8 *data)
	506	{
	507	struct usbnet *dev = netdev_priv(net);
	508	u16 *eeprom_buff;
	509	int first_word, last_word;
	510	int i;
	511	int ret;
	512
	513	netdev_dbg(net, "write EEPROM len %d, offset %d, magic 0x%x\n",
	514	eeprom->len, eeprom->offset, eeprom->magic);
	515
	516	if (eeprom->len == 0)
	517	return -EINVAL;
	518
	519	if (eeprom->magic != AX_EEPROM_MAGIC)
	520	return -EINVAL;
	521
	522	first_word = eeprom->offset >> 1;
	523	last_word = (eeprom->offset + eeprom->len - 1) >> 1;
	524
	525	eeprom_buff = kmalloc(sizeof(u16) * (last_word - first_word + 1),
	526	GFP_KERNEL);
	527	if (!eeprom_buff)
	528	return -ENOMEM;
	529
	530	/* align data to 16 bit boundaries, read the missing data from
	531	the EEPROM */
	532	if (eeprom->offset & 1) {
	533	ret = asix_read_cmd(dev, AX_CMD_READ_EEPROM, first_word, 0, 2,
	534	&(eeprom_buff[0]));
	535	if (ret < 0) {
	536	netdev_err(net, "Failed to read EEPROM at offset 0x%02x.\n", first_word);
	537	goto free;
	538	}
	539	}
	540
	541	if ((eeprom->offset + eeprom->len) & 1) {
	542	ret = asix_read_cmd(dev, AX_CMD_READ_EEPROM, last_word, 0, 2,
	543	&(eeprom_buff[last_word - first_word]));
	544	if (ret < 0) {
	545	netdev_err(net, "Failed to read EEPROM at offset 0x%02x.\n", last_word);
	546	goto free;
	547	}
	548	}
	549
	550	memcpy((u8 *)eeprom_buff + (eeprom->offset & 1), data, eeprom->len);
	551
	552	/* write data to EEPROM */
	553	ret = asix_write_cmd(dev, AX_CMD_WRITE_ENABLE, 0x0000, 0, 0, NULL);
	554	if (ret < 0) {
	555	netdev_err(net, "Failed to enable EEPROM write\n");
	556	goto free;
	557	}
	558	msleep(20);
	559
	560	for (i = first_word; i <= last_word; i++) {
	561	netdev_dbg(net, "write to EEPROM at offset 0x%02x, data 0x%04x\n",
	562	i, eeprom_buff[i - first_word]);
	563	ret = asix_write_cmd(dev, AX_CMD_WRITE_EEPROM, i,
	564	eeprom_buff[i - first_word], 0, NULL);
	565	if (ret < 0) {
	566	netdev_err(net, "Failed to write EEPROM at offset 0x%02x.\n",
	567	i);
568	goto free;
569	}
570	msleep(20);
571	}
572
573	ret = asix_write_cmd(dev, AX_CMD_WRITE_DISABLE, 0x0000, 0, 0, NULL);
574	if (ret < 0) {
575	netdev_err(net, "Failed to disable EEPROM write\n");
576	goto free;
577	}
578
579	ret = 0;
580	free:
581	kfree(eeprom_buff);
582	return ret;
583	}
584
607740bc	585	void asix_get_drvinfo(struct net_device net, struct ethtool_drvinfo info)
2e55cc72 DB	586	{
	587	/* Inherit standard device info */
	588	usbnet_get_drvinfo(net, info);
7826d43f JP	589	strlcpy(info->driver, DRIVER_NAME, sizeof(info->driver));
7826d43f JP	590	strlcpy(info->version, DRIVER_VERSION, sizeof(info->version));
2e55cc72 DB	591	}
2e55cc72 DB	592
607740bc	593	int asix_set_mac_address(struct net_device net, void p)
7f29a3ba JK	594	{
	595	struct usbnet *dev = netdev_priv(net);
	596	struct asix_data data = (struct asix_data )&dev->data;
	597	struct sockaddr *addr = p;
	598
	599	if (netif_running(net))
	600	return -EBUSY;
	601	if (!is_valid_ether_addr(addr->sa_data))
	602	return -EADDRNOTAVAIL;
	603
	604	memcpy(net->dev_addr, addr->sa_data, ETH_ALEN);
	605
	606	/* We use the 20 byte dev->data
	607	* for our 6 byte mac buffer
	608	* to avoid allocating memory that
	609	* is tricky to free later */
	610	memcpy(data->mac_addr, addr->sa_data, ETH_ALEN);
	611	asix_write_cmd_async(dev, AX_CMD_WRITE_NODE_ID, 0, 0, ETH_ALEN,
	612	data->mac_addr);
	613
	614	return 0;
	615	}