[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, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 */

#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(struct usbnet *dev, struct sk_buff *skb)
{
	int offset = 0;

	while (offset + sizeof(u32) < skb->len) {
		struct sk_buff *ax_skb;
		u16 size;
		u32 header = get_unaligned_le32(skb->data + offset);

		offset += sizeof(u32);

		/* get the packet length */
		size = (u16) (header & 0x7ff);
		if (size != ((~header >> 16) & 0x07ff)) {
			netdev_err(dev->net, "asix_rx_fixup() Bad Header Length\n");
			return 0;
		}

		if ((size > dev->net->mtu + ETH_HLEN + VLAN_HLEN) ||
		    (size + offset > skb->len)) {
			netdev_err(dev->net, "asix_rx_fixup() Bad RX Length %d\n",
				   size);
			return 0;
		}
		ax_skb = netdev_alloc_skb_ip_align(dev->net, size);
		if (!ax_skb)
			return 0;

		skb_put(ax_skb, size);
		memcpy(ax_skb->data, skb->data + offset, size);
		usbnet_skb_return(dev, ax_skb);

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

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

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));
	}
	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);
	strncpy (info->driver, DRIVER_NAME, sizeof info->driver);
	strncpy (info->version, DRIVER_VERSION, sizeof info->version);
	info->eedump_len = AX_EEPROM_LEN;
}

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