/*******************************************************************************

  
  Copyright(c) 1999 - 2003 Intel Corporation. All rights reserved.
  
  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.
  
  The full GNU General Public License is included in this distribution in the
  file called LICENSE.
  
  Contact Information:
  Linux NICS <linux.nics@intel.com>
  Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
*******************************************************************************/

/* ethtool support for ixgb */

#include "ixgb.h"

#include <asm/uaccess.h>

extern char ixgb_driver_name[];
extern char ixgb_driver_version[];

extern int ixgb_up(struct ixgb_adapter *adapter);
extern int ixgb_down(struct ixgb_adapter *adapter);

/**
 * ixgb_ethtool_ioctl - Ethtool Ioctl Support
 * @netdev: net device structure
 * @ifr: interface request structure
 **/

static inline int
ixgb_eeprom_size(struct ixgb_hw *hw)
{
	/* return size in bytes */
	return (IXGB_EEPROM_SIZE << 1);
}

#define SPEED_10000 10000

static void
ixgb_ethtool_gset(struct ixgb_adapter *adapter, struct ethtool_cmd *ecmd)
{
	ecmd->supported = (SUPPORTED_10000baseT_Full | SUPPORTED_FIBRE);
	ecmd->advertising = (SUPPORTED_10000baseT_Full | SUPPORTED_FIBRE);
	ecmd->port = PORT_FIBRE;
	ecmd->transceiver = XCVR_EXTERNAL;

	if (netif_carrier_ok(adapter->netdev)) {
		ecmd->speed = 10000;
		ecmd->duplex = DUPLEX_FULL;
	} else {
		ecmd->speed = -1;
		ecmd->duplex = -1;
	}

	ecmd->autoneg = AUTONEG_DISABLE;
}

static int
ixgb_ethtool_sset(struct ixgb_adapter *adapter, struct ethtool_cmd *ecmd)
{
	if (ecmd->autoneg == AUTONEG_ENABLE ||
	    ecmd->speed + ecmd->duplex != SPEED_10000 + DUPLEX_FULL)
		return -EINVAL;
	else {
		ixgb_down(adapter);
		ixgb_up(adapter);
	}

	return 0;
}

#if 0
static int
ixgb_ethtool_promiscuous(struct ixgb_adapter *adapter,
			 struct ethtool_pmode *pmode)
{
	u32 rctl = IXGB_READ_REG(&adapter->hw, RCTL);

	pmode->rctl_old = rctl;
	if (pmode->upe)
		rctl |= IXGB_RCTL_UPE;
	else
		rctl &= ~IXGB_RCTL_UPE;

	if (pmode->mpe)
		rctl |= IXGB_RCTL_MPE;
	else
		rctl &= ~IXGB_RCTL_MPE;

	IXGB_WRITE_REG(&adapter->hw, RCTL, rctl);

	pmode->rctl_new = IXGB_READ_REG(&adapter->hw, RCTL);

	return 0;
}
#endif

#define IXGB_REG_DUMP_LEN  136*sizeof(u32)
static void
ixgb_ethtool_gdrvinfo(struct ixgb_adapter *adapter,
		      struct ethtool_drvinfo *drvinfo)
{
	strncpy(drvinfo->driver, ixgb_driver_name, 32);
	strncpy(drvinfo->version, ixgb_driver_version, 32);
	strncpy(drvinfo->fw_version, "", 32);
	strncpy(drvinfo->bus_info, pci_name(adapter->pdev), 32);
#ifdef ETHTOOL_GREGS
	drvinfo->regdump_len = IXGB_REG_DUMP_LEN;
#endif				/* ETHTOOL_GREGS */
	drvinfo->eedump_len = ixgb_eeprom_size(&adapter->hw);
}

#ifdef  ETHTOOL_GREGS
#define IXGB_GET_STAT(_A_, _R_) _A_->stats._R_
static void
ixgb_ethtool_gregs(struct ixgb_adapter *adapter,
		   struct ethtool_regs *regs, u8 * regs_buff)
{
	struct ixgb_hw *hw = &adapter->hw;
	u32 *reg = (u32 *) regs_buff;
	u32 *reg_start = reg;
	u8 i;

	regs->version =
	    (adapter->hw.device_id << 16) | adapter->hw.subsystem_id;

	/* General Registers */
	*reg++ = IXGB_READ_REG(hw, CTRL0);	/*   0 */
	*reg++ = IXGB_READ_REG(hw, CTRL1);	/*   1 */
	*reg++ = IXGB_READ_REG(hw, STATUS);	/*   2 */
	*reg++ = IXGB_READ_REG(hw, EECD);	/*   3 */
	*reg++ = IXGB_READ_REG(hw, MFS);	/*   4 */

	/* Interrupt */
	*reg++ = IXGB_READ_REG(hw, ICR);	/*   5 */
	*reg++ = IXGB_READ_REG(hw, ICS);	/*   6 */
	*reg++ = IXGB_READ_REG(hw, IMS);	/*   7 */
	*reg++ = IXGB_READ_REG(hw, IMC);	/*   8 */

	/* Receive */
	*reg++ = IXGB_READ_REG(hw, RCTL);	/*   9 */
	*reg++ = IXGB_READ_REG(hw, FCRTL);	/*  10 */
	*reg++ = IXGB_READ_REG(hw, FCRTH);	/*  11 */
	*reg++ = IXGB_READ_REG(hw, RDBAL);	/*  12 */
	*reg++ = IXGB_READ_REG(hw, RDBAH);	/*  13 */
	*reg++ = IXGB_READ_REG(hw, RDLEN);	/*  14 */
	*reg++ = IXGB_READ_REG(hw, RDH);	/*  15 */
	*reg++ = IXGB_READ_REG(hw, RDT);	/*  16 */
	*reg++ = IXGB_READ_REG(hw, RDTR);	/*  17 */
	*reg++ = IXGB_READ_REG(hw, RXDCTL);	/*  18 */
	*reg++ = IXGB_READ_REG(hw, RAIDC);	/*  19 */
	*reg++ = IXGB_READ_REG(hw, RXCSUM);	/*  20 */

	for (i = 0; i < IXGB_RAR_ENTRIES; i++) {
		*reg++ = IXGB_READ_REG_ARRAY(hw, RAL, (i << 1));	/*21,...,51 */
		*reg++ = IXGB_READ_REG_ARRAY(hw, RAH, (i << 1));	/*22,...,52 */
	}

	/* Transmit */
	*reg++ = IXGB_READ_REG(hw, TCTL);	/*  53 */
	*reg++ = IXGB_READ_REG(hw, TDBAL);	/*  54 */
	*reg++ = IXGB_READ_REG(hw, TDBAH);	/*  55 */
	*reg++ = IXGB_READ_REG(hw, TDLEN);	/*  56 */
	*reg++ = IXGB_READ_REG(hw, TDH);	/*  57 */
	*reg++ = IXGB_READ_REG(hw, TDT);	/*  58 */
	*reg++ = IXGB_READ_REG(hw, TIDV);	/*  59 */
	*reg++ = IXGB_READ_REG(hw, TXDCTL);	/*  60 */
	*reg++ = IXGB_READ_REG(hw, TSPMT);	/*  61 */
	*reg++ = IXGB_READ_REG(hw, PAP);	/*  62 */

	/* Physical */
	*reg++ = IXGB_READ_REG(hw, PCSC1);	/*  63 */
	*reg++ = IXGB_READ_REG(hw, PCSC2);	/*  64 */
	*reg++ = IXGB_READ_REG(hw, PCSS1);	/*  65 */
	*reg++ = IXGB_READ_REG(hw, PCSS2);	/*  66 */
	*reg++ = IXGB_READ_REG(hw, XPCSS);	/*  67 */
	*reg++ = IXGB_READ_REG(hw, UCCR);	/*  68 */
	*reg++ = IXGB_READ_REG(hw, XPCSTC);	/*  69 */
	*reg++ = IXGB_READ_REG(hw, MACA);	/*  70 */
	*reg++ = IXGB_READ_REG(hw, APAE);	/*  71 */
	*reg++ = IXGB_READ_REG(hw, ARD);	/*  72 */
	*reg++ = IXGB_READ_REG(hw, AIS);	/*  73 */
	*reg++ = IXGB_READ_REG(hw, MSCA);	/*  74 */
	*reg++ = IXGB_READ_REG(hw, MSRWD);	/*  75 */

#if 0
	/* Wake-up */
	reg[IXGB_WUFC] = IXGB_READ_REG(hw, WUFC);
	reg[IXGB_WUS] = IXGB_READ_REG(hw, WUS);
	reg[IXGB_FFLT] = IXGB_READ_REG(hw, FFLT);
	reg[IXGB_FFMT] = IXGB_READ_REG(hw, FFMT);
	reg[IXGB_FTVT] = IXGB_READ_REG(hw, FTVT);
#endif

	/* Statistics */
	*reg++ = IXGB_GET_STAT(adapter, tprl);	/*  76 */
	*reg++ = IXGB_GET_STAT(adapter, tprh);	/*  77 */
	*reg++ = IXGB_GET_STAT(adapter, gprcl);	/*  78 */
	*reg++ = IXGB_GET_STAT(adapter, gprch);	/*  79 */
	*reg++ = IXGB_GET_STAT(adapter, bprcl);	/*  80 */
	*reg++ = IXGB_GET_STAT(adapter, bprch);	/*  81 */
	*reg++ = IXGB_GET_STAT(adapter, mprcl);	/*  82 */
	*reg++ = IXGB_GET_STAT(adapter, mprch);	/*  83 */
	*reg++ = IXGB_GET_STAT(adapter, uprcl);	/*  84 */
	*reg++ = IXGB_GET_STAT(adapter, uprch);	/*  85 */
	*reg++ = IXGB_GET_STAT(adapter, vprcl);	/*  86 */
	*reg++ = IXGB_GET_STAT(adapter, vprch);	/*  87 */
	*reg++ = IXGB_GET_STAT(adapter, jprcl);	/*  88 */
	*reg++ = IXGB_GET_STAT(adapter, jprch);	/*  89 */
	*reg++ = IXGB_GET_STAT(adapter, gorcl);	/*  90 */
	*reg++ = IXGB_GET_STAT(adapter, gorch);	/*  91 */
	*reg++ = IXGB_GET_STAT(adapter, torl);	/*  92 */
	*reg++ = IXGB_GET_STAT(adapter, torh);	/*  93 */
	*reg++ = IXGB_GET_STAT(adapter, rnbc);	/*  94 */
	*reg++ = IXGB_GET_STAT(adapter, ruc);	/*  95 */
	*reg++ = IXGB_GET_STAT(adapter, roc);	/*  96 */
	*reg++ = IXGB_GET_STAT(adapter, rlec);	/*  97 */
	*reg++ = IXGB_GET_STAT(adapter, crcerrs);	/*  98 */
	*reg++ = IXGB_GET_STAT(adapter, icbc);	/*  99 */
	*reg++ = IXGB_GET_STAT(adapter, ecbc);	/* 100 */
	*reg++ = IXGB_GET_STAT(adapter, mpc);	/* 101 */
	*reg++ = IXGB_GET_STAT(adapter, tptl);	/* 102 */
	*reg++ = IXGB_GET_STAT(adapter, tpth);	/* 103 */
	*reg++ = IXGB_GET_STAT(adapter, gptcl);	/* 104 */
	*reg++ = IXGB_GET_STAT(adapter, gptch);	/* 105 */
	*reg++ = IXGB_GET_STAT(adapter, bptcl);	/* 106 */
	*reg++ = IXGB_GET_STAT(adapter, bptch);	/* 107 */
	*reg++ = IXGB_GET_STAT(adapter, mptcl);	/* 108 */
	*reg++ = IXGB_GET_STAT(adapter, mptch);	/* 109 */
	*reg++ = IXGB_GET_STAT(adapter, uptcl);	/* 110 */
	*reg++ = IXGB_GET_STAT(adapter, uptch);	/* 111 */
	*reg++ = IXGB_GET_STAT(adapter, vptcl);	/* 112 */
	*reg++ = IXGB_GET_STAT(adapter, vptch);	/* 113 */
	*reg++ = IXGB_GET_STAT(adapter, jptcl);	/* 114 */
	*reg++ = IXGB_GET_STAT(adapter, jptch);	/* 115 */
	*reg++ = IXGB_GET_STAT(adapter, gotcl);	/* 116 */
	*reg++ = IXGB_GET_STAT(adapter, gotch);	/* 117 */
	*reg++ = IXGB_GET_STAT(adapter, totl);	/* 118 */
	*reg++ = IXGB_GET_STAT(adapter, toth);	/* 119 */
	*reg++ = IXGB_GET_STAT(adapter, dc);	/* 120 */
	*reg++ = IXGB_GET_STAT(adapter, plt64c);	/* 121 */
	*reg++ = IXGB_GET_STAT(adapter, tsctc);	/* 122 */
	*reg++ = IXGB_GET_STAT(adapter, tsctfc);	/* 123 */
	*reg++ = IXGB_GET_STAT(adapter, ibic);	/* 124 */
	*reg++ = IXGB_GET_STAT(adapter, rfc);	/* 125 */
	*reg++ = IXGB_GET_STAT(adapter, lfc);	/* 126 */
	*reg++ = IXGB_GET_STAT(adapter, pfrc);	/* 127 */
	*reg++ = IXGB_GET_STAT(adapter, pftc);	/* 128 */
	*reg++ = IXGB_GET_STAT(adapter, mcfrc);	/* 129 */
	*reg++ = IXGB_GET_STAT(adapter, mcftc);	/* 130 */
	*reg++ = IXGB_GET_STAT(adapter, xonrxc);	/* 131 */
	*reg++ = IXGB_GET_STAT(adapter, xontxc);	/* 132 */
	*reg++ = IXGB_GET_STAT(adapter, xoffrxc);	/* 133 */
	*reg++ = IXGB_GET_STAT(adapter, xofftxc);	/* 134 */
	*reg++ = IXGB_GET_STAT(adapter, rjc);	/* 135 */

#if 0
#endif
	regs->len = (reg - reg_start) * sizeof (u32);
}
#endif				/* ETHTOOL_GREGS */

static int
ixgb_ethtool_geeprom(struct ixgb_adapter *adapter,
		     struct ethtool_eeprom *eeprom, u16 * eeprom_buff)
{
	struct ixgb_hw *hw = &adapter->hw;
	int i, max_len, first_word, last_word;
	IXGB_DBG("ixgb_ethtool_geeprom\n");

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

	eeprom->magic = hw->vendor_id | (hw->device_id << 16);

	max_len = ixgb_eeprom_size(hw);

	/* use our function to read the eeprom and update our cache */
	ixgb_get_eeprom_data(hw);

	if (eeprom->offset > eeprom->offset + eeprom->len)
		return -EINVAL;

	if ((eeprom->offset + eeprom->len) > max_len)
		eeprom->len = (max_len - eeprom->offset);

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

	for (i = 0; i <= (last_word - first_word); i++) {
		eeprom_buff[i] = hw->eeprom[first_word + i];
	}

	return 0;
}
static int
ixgb_ethtool_seeprom(struct ixgb_adapter *adapter,
		     struct ethtool_eeprom *eeprom, void *user_data)
{
	struct ixgb_hw *hw = &adapter->hw;
	u16 eeprom_buff[256];
	int i, max_len, first_word, last_word;
	void *ptr;

	if (eeprom->magic != (hw->vendor_id | (hw->device_id << 16)))
		return -EFAULT;

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

	max_len = ixgb_eeprom_size(hw);

	if (eeprom->offset > eeprom->offset + eeprom->len)
		return -EINVAL;

	if ((eeprom->offset + eeprom->len) > max_len)
		eeprom->len = (max_len - eeprom->offset);

	first_word = eeprom->offset >> 1;
	last_word = (eeprom->offset + eeprom->len - 1) >> 1;
	ptr = (void *) eeprom_buff;

	if (eeprom->offset & 1) {
		/* need read/modify/write of first changed EEPROM word */
		/* only the second byte of the word is being modified */
		eeprom_buff[0] = ixgb_read_eeprom(hw, first_word);
		ptr++;
	}
	if ((eeprom->offset + eeprom->len) & 1) {
		/* need read/modify/write of last changed EEPROM word */
		/* only the first byte of the word is being modified */
		eeprom_buff[last_word - first_word]
		    = ixgb_read_eeprom(hw, last_word);
	}
	if (copy_from_user(ptr, user_data, eeprom->len))
		return -EFAULT;

	for (i = 0; i <= (last_word - first_word); i++)
		ixgb_write_eeprom(hw, first_word + i, eeprom_buff[i]);

	/* Update the checksum over the first part of the EEPROM if needed */
	if (first_word <= EEPROM_CHECKSUM_REG)
		ixgb_update_eeprom_checksum(hw);

	return 0;
}

#ifdef  ETHTOOL_PHYS_ID

/* toggle LED 4 times per second = 2 "blinks" per second */
#define IXGB_ID_INTERVAL    (HZ/4)

/* bit defines for adapter->led_status */
#define IXGB_LED_ON     0

static void
ixgb_led_blink_callback(unsigned long data)
{
	struct ixgb_adapter *adapter = (struct ixgb_adapter *) data;

	if (test_and_change_bit(IXGB_LED_ON, &adapter->led_status))
		ixgb_led_off(&adapter->hw);
	else
		ixgb_led_on(&adapter->hw);

	mod_timer(&adapter->blink_timer, jiffies + IXGB_ID_INTERVAL);
}

static int
ixgb_ethtool_led_blink(struct ixgb_adapter *adapter, struct ethtool_value *id)
{
	if (!adapter->blink_timer.function) {
		init_timer(&adapter->blink_timer);
		adapter->blink_timer.function = ixgb_led_blink_callback;
		adapter->blink_timer.data = (unsigned long) adapter;
	}

	mod_timer(&adapter->blink_timer, jiffies);

	set_current_state(TASK_INTERRUPTIBLE);
	if (id->data)
		schedule_timeout(id->data * HZ);
	else
		schedule_timeout(MAX_SCHEDULE_TIMEOUT);

	del_timer_sync(&adapter->blink_timer);
	ixgb_led_off(&adapter->hw);
	clear_bit(IXGB_LED_ON, &adapter->led_status);

	return 0;
}
#endif				/* ETHTOOL_PHYS_ID */

int
ixgb_ethtool_ioctl(struct net_device *netdev, struct ifreq *ifr)
{
	struct ixgb_adapter *adapter = netdev->priv;
	void *addr = ifr->ifr_data;
	u32 cmd;

	if (get_user(cmd, (u32 *) addr))
		return -EFAULT;

	switch (cmd) {
#if 0
	case ETHTOOL_PROMISCUOUS:{
			struct ethtool_pmode pmode;

			if (copy_from_user(&pmode, addr, sizeof (pmode)))
				return -EFAULT;

			ixgb_ethtool_promiscuous(adapter, &pmode);

			if (copy_to_user(addr, &pmode, sizeof (pmode)))
				return -EFAULT;

			return 0;
		}
	case ETHTOOL_DOWN_UP:
		ixgb_down(netdev->priv);
		ixgb_up(netdev->priv);
		return 0;
#endif
	case ETHTOOL_GSET:{
			struct ethtool_cmd ecmd = { ETHTOOL_GSET };

			ixgb_ethtool_gset(adapter, &ecmd);
			if (copy_to_user(addr, &ecmd, sizeof (ecmd)))
				return -EFAULT;
			return 0;
		}
	case ETHTOOL_SSET:{
			struct ethtool_cmd ecmd;

			if (copy_from_user(&ecmd, addr, sizeof (ecmd)))
				return -EFAULT;
			return ixgb_ethtool_sset(adapter, &ecmd);
		}
	case ETHTOOL_GDRVINFO:
		{
			struct ethtool_drvinfo drvinfo = { ETHTOOL_GDRVINFO };

			ixgb_ethtool_gdrvinfo(adapter, &drvinfo);
			if (copy_to_user(addr, &drvinfo, sizeof (drvinfo)))
				return -EFAULT;
			return 0;
		}
#if defined(ETHTOOL_GREGS) && defined(ETHTOOL_GEEPROM)
	case ETHTOOL_GREGS:{
			struct ethtool_regs regs = { ETHTOOL_GREGS };
			u8 regs_buff[IXGB_REG_DUMP_LEN];

			ixgb_ethtool_gregs(adapter, &regs, regs_buff);

			if (copy_to_user(addr, &regs, sizeof (regs)))
				return -EFAULT;

			addr += offsetof(struct ethtool_regs, data);

			if (copy_to_user(addr, regs_buff, regs.len))
				return -EFAULT;
			return 0;
		}
#endif				/* ETHTOOL_GREGS */
	case ETHTOOL_NWAY_RST:{
			IXGB_DBG("ETHTOOL_NWAY_RST\n");
			ixgb_down(adapter);
			ixgb_up(adapter);

			return 0;
		}
#ifdef  ETHTOOL_PHYS_ID
	case ETHTOOL_PHYS_ID:{
			struct ethtool_value id;

			IXGB_DBG("ETHTOOL_PHYS_ID\n");
			if (copy_from_user(&id, addr, sizeof (id)))
				return -EFAULT;
			return ixgb_ethtool_led_blink(adapter, &id);
		}
#endif				/* ETHTOOL_PHYS_ID */
	case ETHTOOL_GLINK:{
			struct ethtool_value link = { ETHTOOL_GLINK };

			IXGB_DBG("ETHTOOL_GLINK\n");
			link.data = netif_carrier_ok(netdev);
			if (copy_to_user(addr, &link, sizeof (link)))
				return -EFAULT;
			return 0;
		}

	case ETHTOOL_GEEPROM:{
			struct ethtool_eeprom eeprom = { ETHTOOL_GEEPROM };
			u16 eeprom_buff[IXGB_EEPROM_SIZE];
			void *ptr;
			int err;

			IXGB_DBG("ETHTOOL_GEEPROM\n");
			if (copy_from_user(&eeprom, addr, sizeof (eeprom)))
				return -EFAULT;

			if ((err =
			     ixgb_ethtool_geeprom(adapter, &eeprom,
						  eeprom_buff)) < 0)
				return err;

			if (copy_to_user(addr, &eeprom, sizeof (eeprom)))
				return -EFAULT;

			addr += offsetof(struct ethtool_eeprom, data);

			ptr = ((void *) eeprom_buff) + (eeprom.offset & 1);
			if (copy_to_user(addr, ptr, eeprom.len))
				return -EFAULT;
			return 0;
		}
	case ETHTOOL_SEEPROM:{
			struct ethtool_eeprom eeprom;

			IXGB_DBG("ETHTOOL_SEEPROM\n");
			if (copy_from_user(&eeprom, addr, sizeof (eeprom)))
				return -EFAULT;

			addr += offsetof(struct ethtool_eeprom, data);
			return ixgb_ethtool_seeprom(adapter, &eeprom, addr);
		}
	default:
		return -EOPNOTSUPP;
	}
}