339 lines
12 KiB
C
Executable File
339 lines
12 KiB
C
Executable File
/*
|
|
################################################################################
|
|
#
|
|
# r8168 is the Linux device driver released for Realtek Gigabit Ethernet
|
|
# controllers with PCI-Express interface.
|
|
#
|
|
# Copyright(c) 2017-2018 Realtek Semiconductor Corp. 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, see <http://www.gnu.org/licenses/>.
|
|
#
|
|
# Author:
|
|
# Realtek NIC software team <nicfae@realtek.com>
|
|
# No. 2, Innovation Road II, Hsinchu Science Park, Hsinchu 300, Taiwan
|
|
#
|
|
################################################################################
|
|
*/
|
|
|
|
/************************************************************************************
|
|
* This product is covered by one or more of the following patents:
|
|
* US6,570,884, US6,115,776, and US6,327,625.
|
|
***********************************************************************************/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/version.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/netdevice.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/in.h>
|
|
#include <linux/ethtool.h>
|
|
#include <asm/uaccess.h>
|
|
#include "r8168.h"
|
|
#include "rtl_eeprom.h"
|
|
#include "rtltool.h"
|
|
|
|
int rtltool_ioctl(struct rtl8168_private *tp, struct ifreq *ifr)
|
|
{
|
|
struct rtltool_cmd my_cmd;
|
|
unsigned long flags, flags2;
|
|
int ret;
|
|
|
|
if (copy_from_user(&my_cmd, ifr->ifr_data, sizeof(my_cmd)))
|
|
return -EFAULT;
|
|
|
|
ret = 0;
|
|
switch (my_cmd.cmd) {
|
|
case RTLTOOL_READ_MAC:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
if (my_cmd.len==1)
|
|
my_cmd.data = readb(tp->mmio_addr+my_cmd.offset);
|
|
else if (my_cmd.len==2)
|
|
my_cmd.data = readw(tp->mmio_addr+(my_cmd.offset&~1));
|
|
else if (my_cmd.len==4)
|
|
my_cmd.data = readl(tp->mmio_addr+(my_cmd.offset&~3));
|
|
else {
|
|
ret = -EOPNOTSUPP;
|
|
break;
|
|
}
|
|
|
|
if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) {
|
|
ret = -EFAULT;
|
|
break;
|
|
}
|
|
break;
|
|
|
|
case RTLTOOL_WRITE_MAC:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
if (my_cmd.len==1)
|
|
writeb(my_cmd.data, tp->mmio_addr+my_cmd.offset);
|
|
else if (my_cmd.len==2)
|
|
writew(my_cmd.data, tp->mmio_addr+(my_cmd.offset&~1));
|
|
else if (my_cmd.len==4)
|
|
writel(my_cmd.data, tp->mmio_addr+(my_cmd.offset&~3));
|
|
else {
|
|
ret = -EOPNOTSUPP;
|
|
break;
|
|
}
|
|
|
|
break;
|
|
|
|
case RTLTOOL_READ_PHY:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
spin_lock_irqsave(&tp->phy_lock, flags);
|
|
my_cmd.data = mdio_read(tp, my_cmd.offset);
|
|
spin_unlock_irqrestore(&tp->phy_lock, flags);
|
|
|
|
if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) {
|
|
ret = -EFAULT;
|
|
break;
|
|
}
|
|
|
|
break;
|
|
|
|
case RTLTOOL_WRITE_PHY:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
spin_lock_irqsave(&tp->phy_lock, flags);
|
|
mdio_prot_write(tp, my_cmd.offset, my_cmd.data);
|
|
spin_unlock_irqrestore(&tp->phy_lock, flags);
|
|
break;
|
|
|
|
case RTLTOOL_READ_EPHY:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
spin_lock_irqsave(&tp->phy_lock, flags);
|
|
my_cmd.data = rtl8168_ephy_read(tp->mmio_addr, my_cmd.offset);
|
|
spin_unlock_irqrestore(&tp->phy_lock, flags);
|
|
|
|
if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) {
|
|
ret = -EFAULT;
|
|
break;
|
|
}
|
|
|
|
break;
|
|
|
|
case RTLTOOL_WRITE_EPHY:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
spin_lock_irqsave(&tp->phy_lock, flags);
|
|
rtl8168_ephy_write(tp->mmio_addr, my_cmd.offset, my_cmd.data);
|
|
spin_unlock_irqrestore(&tp->phy_lock, flags);
|
|
break;
|
|
|
|
case RTLTOOL_READ_ERI:
|
|
my_cmd.data = 0;
|
|
if (my_cmd.len==1 || my_cmd.len==2 || my_cmd.len==4) {
|
|
spin_lock_irqsave(&tp->phy_lock, flags);
|
|
my_cmd.data = rtl8168_eri_read(tp->mmio_addr, my_cmd.offset, my_cmd.len, ERIAR_ExGMAC);
|
|
spin_unlock_irqrestore(&tp->phy_lock, flags);
|
|
} else {
|
|
ret = -EOPNOTSUPP;
|
|
break;
|
|
}
|
|
|
|
if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) {
|
|
ret = -EFAULT;
|
|
break;
|
|
}
|
|
|
|
break;
|
|
|
|
case RTLTOOL_WRITE_ERI:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
if (my_cmd.len==1 || my_cmd.len==2 || my_cmd.len==4) {
|
|
spin_lock_irqsave(&tp->phy_lock, flags);
|
|
rtl8168_eri_write(tp->mmio_addr, my_cmd.offset, my_cmd.len, my_cmd.data, ERIAR_ExGMAC);
|
|
spin_unlock_irqrestore(&tp->phy_lock, flags);
|
|
} else {
|
|
ret = -EOPNOTSUPP;
|
|
break;
|
|
}
|
|
break;
|
|
|
|
case RTLTOOL_READ_PCI:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
my_cmd.data = 0;
|
|
if (my_cmd.len==1)
|
|
pci_read_config_byte(tp->pci_dev, my_cmd.offset,
|
|
(u8 *)&my_cmd.data);
|
|
else if (my_cmd.len==2)
|
|
pci_read_config_word(tp->pci_dev, my_cmd.offset,
|
|
(u16 *)&my_cmd.data);
|
|
else if (my_cmd.len==4)
|
|
pci_read_config_dword(tp->pci_dev, my_cmd.offset,
|
|
&my_cmd.data);
|
|
else {
|
|
ret = -EOPNOTSUPP;
|
|
break;
|
|
}
|
|
|
|
if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) {
|
|
ret = -EFAULT;
|
|
break;
|
|
}
|
|
break;
|
|
|
|
case RTLTOOL_WRITE_PCI:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
if (my_cmd.len==1)
|
|
pci_write_config_byte(tp->pci_dev, my_cmd.offset,
|
|
my_cmd.data);
|
|
else if (my_cmd.len==2)
|
|
pci_write_config_word(tp->pci_dev, my_cmd.offset,
|
|
my_cmd.data);
|
|
else if (my_cmd.len==4)
|
|
pci_write_config_dword(tp->pci_dev, my_cmd.offset,
|
|
my_cmd.data);
|
|
else {
|
|
ret = -EOPNOTSUPP;
|
|
break;
|
|
}
|
|
|
|
break;
|
|
|
|
case RTLTOOL_READ_EEPROM:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
spin_lock_irqsave(&tp->phy_lock, flags);
|
|
my_cmd.data = rtl_eeprom_read_sc(tp, my_cmd.offset);
|
|
spin_unlock_irqrestore(&tp->phy_lock, flags);
|
|
|
|
if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) {
|
|
ret = -EFAULT;
|
|
break;
|
|
}
|
|
|
|
break;
|
|
|
|
case RTLTOOL_WRITE_EEPROM:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
spin_lock_irqsave(&tp->phy_lock, flags);
|
|
rtl_eeprom_write_sc(tp, my_cmd.offset, my_cmd.data);
|
|
spin_unlock_irqrestore(&tp->phy_lock, flags);
|
|
break;
|
|
|
|
case RTL_READ_OOB_MAC:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
spin_lock_irqsave(&tp->phy_lock, flags);
|
|
OOB_mutex_lock(tp);
|
|
my_cmd.data = OCP_read(tp, my_cmd.offset, 4);
|
|
OOB_mutex_unlock(tp);
|
|
spin_unlock_irqrestore(&tp->phy_lock, flags);
|
|
|
|
if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) {
|
|
ret = -EFAULT;
|
|
break;
|
|
}
|
|
break;
|
|
|
|
case RTL_WRITE_OOB_MAC:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
if (my_cmd.len == 0 || my_cmd.len > 4)
|
|
return -EOPNOTSUPP;
|
|
|
|
spin_lock_irqsave(&tp->phy_lock, flags);
|
|
OOB_mutex_lock(tp);
|
|
OCP_write(tp, my_cmd.offset, my_cmd.len, my_cmd.data);
|
|
OOB_mutex_unlock(tp);
|
|
spin_unlock_irqrestore(&tp->phy_lock, flags);
|
|
break;
|
|
|
|
case RTL_ENABLE_PCI_DIAG:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
spin_lock_irqsave(&tp->lock, flags);
|
|
spin_lock_irqsave(&tp->phy_lock, flags2);
|
|
tp->rtk_enable_diag = 1;
|
|
spin_unlock_irqrestore(&tp->phy_lock, flags2);
|
|
spin_unlock_irqrestore(&tp->lock, flags);
|
|
|
|
dprintk("enable rtk diag\n");
|
|
break;
|
|
|
|
case RTL_DISABLE_PCI_DIAG:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
spin_lock_irqsave(&tp->lock, flags);
|
|
spin_lock_irqsave(&tp->phy_lock, flags2);
|
|
tp->rtk_enable_diag = 0;
|
|
spin_unlock_irqrestore(&tp->phy_lock, flags2);
|
|
spin_unlock_irqrestore(&tp->lock, flags);
|
|
|
|
dprintk("disable rtk diag\n");
|
|
break;
|
|
|
|
case RTL_READ_MAC_OCP:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
if (my_cmd.offset % 2)
|
|
return -EOPNOTSUPP;
|
|
|
|
spin_lock_irqsave(&tp->phy_lock, flags);
|
|
my_cmd.data = mac_ocp_read(tp, my_cmd.offset);
|
|
spin_unlock_irqrestore(&tp->phy_lock, flags);
|
|
|
|
if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) {
|
|
ret = -EFAULT;
|
|
break;
|
|
}
|
|
break;
|
|
|
|
case RTL_WRITE_MAC_OCP:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
if ((my_cmd.offset % 2) || (my_cmd.len != 2))
|
|
return -EOPNOTSUPP;
|
|
|
|
spin_lock_irqsave(&tp->phy_lock, flags);
|
|
mac_ocp_write(tp, my_cmd.offset, (u16)my_cmd.data);
|
|
spin_unlock_irqrestore(&tp->phy_lock, flags);
|
|
break;
|
|
|
|
default:
|
|
ret = -EOPNOTSUPP;
|
|
break;
|
|
}
|
|
|
|
return ret;
|
|
}
|