b480b1d78d44d7d24c08e0f3e5c375d9fe0a2a6c
[openwrt/openwrt.git] / target / linux / generic / pending-4.9 / 701-phy_extension.patch
1 From: John Crispin <john@phrozen.org>
2 Subject: net: phy: add phy_ethtool_ioctl()
3
4 Signed-off-by: John Crispin <john@phrozen.org>
5 ---
6 drivers/net/phy/phy.c | 44 ++++++++++++++++++++++++++++++++++++++++++++
7 include/linux/phy.h | 1 +
8 2 files changed, 45 insertions(+)
9
10 --- a/drivers/net/phy/phy.c
11 +++ b/drivers/net/phy/phy.c
12 @@ -466,6 +466,50 @@ int phy_ethtool_ksettings_get(struct phy
13 }
14 EXPORT_SYMBOL(phy_ethtool_ksettings_get);
15
16 +int phy_ethtool_ioctl(struct phy_device *phydev, void *useraddr)
17 +{
18 + u32 cmd;
19 + int tmp;
20 + struct ethtool_cmd ecmd = { ETHTOOL_GSET };
21 + struct ethtool_value edata = { ETHTOOL_GLINK };
22 +
23 + if (get_user(cmd, (u32 *) useraddr))
24 + return -EFAULT;
25 +
26 + switch (cmd) {
27 + case ETHTOOL_GSET:
28 + phy_ethtool_gset(phydev, &ecmd);
29 + if (copy_to_user(useraddr, &ecmd, sizeof(ecmd)))
30 + return -EFAULT;
31 + return 0;
32 +
33 + case ETHTOOL_SSET:
34 + if (copy_from_user(&ecmd, useraddr, sizeof(ecmd)))
35 + return -EFAULT;
36 + return phy_ethtool_sset(phydev, &ecmd);
37 +
38 + case ETHTOOL_NWAY_RST:
39 + /* if autoneg is off, it's an error */
40 + tmp = phy_read(phydev, MII_BMCR);
41 + if (tmp & BMCR_ANENABLE) {
42 + tmp |= (BMCR_ANRESTART);
43 + phy_write(phydev, MII_BMCR, tmp);
44 + return 0;
45 + }
46 + return -EINVAL;
47 +
48 + case ETHTOOL_GLINK:
49 + edata.data = (phy_read(phydev,
50 + MII_BMSR) & BMSR_LSTATUS) ? 1 : 0;
51 + if (copy_to_user(useraddr, &edata, sizeof(edata)))
52 + return -EFAULT;
53 + return 0;
54 + }
55 +
56 + return -EOPNOTSUPP;
57 +}
58 +EXPORT_SYMBOL(phy_ethtool_ioctl);
59 +
60 /**
61 * phy_mii_ioctl - generic PHY MII ioctl interface
62 * @phydev: the phy_device struct
63 --- a/include/linux/phy.h
64 +++ b/include/linux/phy.h
65 @@ -816,6 +816,7 @@ int phy_ethtool_ksettings_get(struct phy
66 struct ethtool_link_ksettings *cmd);
67 int phy_ethtool_ksettings_set(struct phy_device *phydev,
68 const struct ethtool_link_ksettings *cmd);
69 +int phy_ethtool_ioctl(struct phy_device *phydev, void *useraddr);
70 int phy_mii_ioctl(struct phy_device *phydev, struct ifreq *ifr, int cmd);
71 int phy_start_interrupts(struct phy_device *phydev);
72 void phy_print_status(struct phy_device *phydev);