| lists.openwall.net | lists / announce owl-users owl-dev john-users john-dev passwdqc-users yescrypt popa3d-users / oss-security kernel-hardening musl sabotage tlsify passwords / crypt-dev xvendor / Bugtraq Full-Disclosure linux-kernel linux-netdev linux-ext4 linux-hardening linux-cve-announce PHC | |
|
Open Source and information security mailing list archives
| ||
|
Message-Id: <20200917214030.646-1-sbauer@blackbox.su>
Date: Fri, 18 Sep 2020 00:40:10 +0300
From: Sergej Bauer <sbauer@...ckbox.su>
To: "David S. Miller" <davem@...emloft.net>
Cc: sbauer@...ckbox.su, Jakub Kicinski <kuba@...nel.org>,
Bryan Whitehead <bryan.whitehead@...rochip.com>,
Microchip Linux Driver Support <UNGLinuxDriver@...rochip.com>,
Mauro Carvalho Chehab <mchehab+huawei@...nel.org>,
Rob Herring <robh@...nel.org>, linux-kernel@...r.kernel.org,
netdev@...r.kernel.org
Subject: [PATCH] add virtual PHY for PHY-less devices
From: sbauer@...ckbox.su
Here is a kernel related part of my work which was helps to develop brand
new PHY device.
It is migth be helpful for developers work with PHY-less lan743x
(7431:0011 in my case). It's just a fake virtual PHY which can change speed of
network card processing as a loopback device. Baud rate can be tuned with
ethtool from command line or by means of SIOCSMIIREG ioctl. Duplex mode not
configurable and it's allways DUPLEX_FULL.
It also provides module parameter mii_regs for setting initial values of
IEEE 802.3 Control Register.
diff --git a/MAINTAINERS b/MAINTAINERS
index f0068bceeb61..d4c10895aa13 100644
--- a/MAINTAINERS
+++ b/MAINTAINERS
@@ -11423,6 +11448,12 @@ L: netdev@...r.kernel.org
S: Maintained
F: drivers/net/ethernet/microchip/lan743x_*
+MICROCHIP LAN743X VIRTUAL PHY DRIVER
+M: Sergej Bauer <sbauer@...ckbox.su>
+L: netdev@...r.kernel.org
+S: Maintained
+F: drivers/net/ethernet/microchip/lan743x_virtual_phy.*
+
MICROCHIP LCDFB DRIVER
M: Nicolas Ferre <nicolas.ferre@...rochip.com>
L: linux-fbdev@...r.kernel.org
diff --git a/drivers/net/ethernet/microchip/Makefile b/drivers/net/ethernet/microchip/Makefile
index da603540ca57..8850ba5f5104 100644
--- a/drivers/net/ethernet/microchip/Makefile
+++ b/drivers/net/ethernet/microchip/Makefile
@@ -7,4 +7,5 @@ obj-$(CONFIG_ENC28J60) += enc28j60.o
obj-$(CONFIG_ENCX24J600) += encx24j600.o encx24j600-regmap.o
obj-$(CONFIG_LAN743X) += lan743x.o
-lan743x-objs := lan743x_main.o lan743x_ethtool.o lan743x_ptp.o
+lan743x-objs := lan743x_main.o lan743x_ethtool.o lan743x_ptp.o \
+ lan743x_virtual_phy.o
diff --git a/drivers/net/ethernet/microchip/lan743x_ethtool.c b/drivers/net/ethernet/microchip/lan743x_ethtool.c
index dcde496da7fb..0eaa20529ba2 100644
--- a/drivers/net/ethernet/microchip/lan743x_ethtool.c
+++ b/drivers/net/ethernet/microchip/lan743x_ethtool.c
@@ -815,6 +815,72 @@ static int lan743x_ethtool_set_wol(struct net_device *netdev,
}
#endif /* CONFIG_PM */
+int lan743x_set_link_ksettings(struct net_device *netdev,
+ const struct ethtool_link_ksettings *cmd)
+{
+ struct ethtool_link_ksettings *cmd_ref =
+ (struct ethtool_link_ksettings *)cmd;
+ struct lan743x_adapter *adapter = netdev_priv(netdev);
+ u8 duplex = cmd->base.duplex;
+ u32 speed = cmd->base.speed;
+ u16 v = 0, mac_rx, mac_tx;
+
+ if (speed &&
+ speed != SPEED_10 && speed != SPEED_100 && speed != SPEED_1000) {
+ netdev_err(netdev, "%s: unknown speed %d\n",
+ netdev->name, speed);
+ goto out;
+ }
+
+ mac_tx = lan743x_csr_read(adapter, MAC_TX);
+ mac_rx = lan743x_csr_read(adapter, MAC_RX);
+
+ if (adapter->virtual_phy) {
+ v = adapter->regs802p3[0];
+ v &= ~(BMCR_SPEED1000 | BMCR_SPEED100);
+
+ lan743x_netdev_set_bit(netdev, MAC_CR, 12, 0); // ADD
+ lan743x_netdev_set_bit(netdev, MAC_CR, 11, 0); // ASD
+ duplex = DUPLEX_FULL;
+ switch (speed) {
+ case 0:
+ break;
+ case SPEED_10:
+ lan743x_netdev_set_bit(netdev, MAC_CR, 2, 0);
+ lan743x_netdev_set_bit(netdev, MAC_CR, 1, 0);
+ netif_info(adapter, probe, adapter->netdev,
+ "lan743x: speed 10Mbps/%s\n",
+ duplex ? "Full" : "Half");
+ break;
+ case SPEED_100:
+ v |= BMCR_SPEED100;
+ lan743x_netdev_set_bit(netdev, MAC_CR, 2, 0);
+ lan743x_netdev_set_bit(netdev, MAC_CR, 1, 1);
+ netif_info(adapter, probe, adapter->netdev,
+ "lan743x: speed 100Mbps/%s\n",
+ duplex ? "Full" : "Half");
+ break;
+ case SPEED_1000:
+ v |= BMCR_SPEED1000;
+ lan743x_netdev_set_bit(netdev, MAC_CR, 2, 1);
+ lan743x_netdev_set_bit(netdev, MAC_CR, 1, 0);
+ netif_info(adapter, probe, adapter->netdev,
+ "lan743x: speed 1Gbps/%s\n",
+ duplex ? "Full" : "Half");
+ break;
+ default:
+ return -EINVAL;
+ };
+
+ v |= BMCR_LOOPBACK | BMCR_FULLDPLX;
+ adapter->regs802p3[0] = v;
+ cmd_ref->base.duplex = duplex;
+ }
+
+out:
+ return phy_ethtool_set_link_ksettings(netdev, cmd);
+}
+
const struct ethtool_ops lan743x_ethtool_ops = {
.get_drvinfo = lan743x_ethtool_get_drvinfo,
.get_msglevel = lan743x_ethtool_get_msglevel,
@@ -838,7 +904,7 @@ const struct ethtool_ops lan743x_ethtool_ops = {
.get_eee = lan743x_ethtool_get_eee,
.set_eee = lan743x_ethtool_set_eee,
.get_link_ksettings = phy_ethtool_get_link_ksettings,
- .set_link_ksettings = phy_ethtool_set_link_ksettings,
+ .set_link_ksettings = lan743x_set_link_ksettings,
#ifdef CONFIG_PM
.get_wol = lan743x_ethtool_get_wol,
.set_wol = lan743x_ethtool_set_wol,
diff --git a/drivers/net/ethernet/microchip/lan743x_ethtool.h b/drivers/net/ethernet/microchip/lan743x_ethtool.h
index d0d11a777a58..5caeec9b12dd 100644
--- a/drivers/net/ethernet/microchip/lan743x_ethtool.h
+++ b/drivers/net/ethernet/microchip/lan743x_ethtool.h
@@ -6,6 +6,8 @@
#include "linux/ethtool.h"
+int lan743x_set_link_ksettings(struct net_device *netdev,
+ const struct ethtool_link_ksettings *cmd);
extern const struct ethtool_ops lan743x_ethtool_ops;
#endif /* _LAN743X_ETHTOOL_H */
diff --git a/drivers/net/ethernet/microchip/lan743x_main.c b/drivers/net/ethernet/microchip/lan743x_main.c
index de93cc6ebc1a..4f6052121a0c 100644
--- a/drivers/net/ethernet/microchip/lan743x_main.c
+++ b/drivers/net/ethernet/microchip/lan743x_main.c
@@ -2,6 +2,7 @@
/* Copyright (C) 2018 Microchip Technology Inc. */
#include <linux/module.h>
+#include <linux/moduleparam.h>
#include <linux/pci.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
@@ -15,8 +16,32 @@
#include <linux/rtnetlink.h>
#include <linux/iopoll.h>
#include <linux/crc16.h>
+#include <linux/sched.h>
+#include <linux/slab.h>
+#include <linux/netdev_features.h>
#include "lan743x_main.h"
#include "lan743x_ethtool.h"
+#include "lan743x_virtual_phy.h"
+
+static char *mii_regs[16];
+static int mii_regs_count;
+module_param_array(mii_regs, charp, &mii_regs_count, 0644);
+
+static atomic_t device_no = ATOMIC_INIT(0);
+
+void lan743x_netdev_set_bit(struct net_device *netdev, int reg, int n,
+ int state)
+{
+ struct lan743x_adapter *adapter = netdev_priv(netdev);
+ u32 val;
+
+ val = lan743x_csr_read(adapter, reg);
+ if (state)
+ val |= BIT(n);
+ else
+ val &= ~BIT(n);
+ lan743x_csr_write(adapter, reg, val);
+}
static void lan743x_pci_cleanup(struct lan743x_adapter *adapter)
{
@@ -44,14 +69,18 @@ static int lan743x_pci_init(struct lan743x_adapter *adapter,
if (!test_bit(0, &bars))
goto disable_device;
- ret = pci_request_selected_regions(pdev, bars, DRIVER_NAME);
+ adapter->name = kzalloc(strlen(DRIVER_NAME) + 3, GFP_KERNEL);
+ snprintf(adapter->name, strlen(DRIVER_NAME) + 2, "%s%d", DRIVER_NAME,
+ atomic_read(&device_no));
+ ret = pci_request_selected_regions(pdev, bars, adapter->name);
if (ret)
goto disable_device;
-
+ atomic_inc(&device_no);
pci_set_master(pdev);
return 0;
disable_device:
+ kfree(adapter->name);
pci_disable_device(adapter->pdev);
return_error:
@@ -1012,8 +1041,16 @@ static void lan743x_phy_close(struct lan743x_adapter *adapter)
{
struct net_device *netdev = adapter->netdev;
- phy_stop(netdev->phydev);
- phy_disconnect(netdev->phydev);
+ if (!netdev->phydev)
+ return;
+
+ if (adapter->virtual_phy) {
+ kfree(netdev->phydev);
+ kfree(adapter->regs802p3);
+ } else {
+ phy_stop(netdev->phydev);
+ phy_disconnect(netdev->phydev);
+ }
netdev->phydev = NULL;
}
@@ -1049,12 +1086,26 @@ static int lan743x_phy_open(struct lan743x_adapter *adapter)
goto return_error;
} else {
phydev = phy_find_first(adapter->mdiobus);
- if (!phydev)
- goto return_error;
+ if (!phydev) {
+ phydev = lan743x_virtual_phy(adapter, mii_regs,
+ mii_regs_count);
+ if (!phydev) {
+ netif_warn(adapter, ifup, adapter->netdev,
+ "cannot open PHY\n");
+ goto return_error;
+ }
+ }
+
+ if (adapter->virtual_phy) {
+ ret = lan743x_virtual_phy_connect(netdev, phydev,
+ lan743x_phy_link_status_change,
+ PHY_INTERFACE_MODE_GMII);
+ } else {
+ ret = phy_connect_direct(netdev, phydev,
+ lan743x_phy_link_status_change,
+ PHY_INTERFACE_MODE_GMII);
+ }
- ret = phy_connect_direct(netdev, phydev,
- lan743x_phy_link_status_change,
- adapter->phy_mode);
if (ret)
goto return_error;
}
@@ -1066,9 +1117,11 @@ static int lan743x_phy_open(struct lan743x_adapter *adapter)
phy_support_asym_pause(phydev);
phy->fc_request_control = (FLOW_CTRL_RX | FLOW_CTRL_TX);
phy->fc_autoneg = phydev->autoneg;
+ if (!adapter->virtual_phy) {
+ phy_start(phydev);
+ phy_start_aneg(phydev);
+ }
- phy_start(phydev);
- phy_start_aneg(phydev);
return 0;
return_error:
@@ -1962,6 +2015,8 @@ static struct sk_buff *lan743x_rx_allocate_skb(struct lan743x_rx *rx)
int length = 0;
length = (LAN743X_MAX_FRAME_SIZE + ETH_HLEN + 4 + RX_HEAD_PADDING);
+ if ((rx->adapter->netdev->features & NETIF_F_RXFCS) == 0)
+ length -= ETH_FCS_LEN;
return __netdev_alloc_skb(rx->adapter->netdev,
length, GFP_ATOMIC | GFP_DMA);
}
@@ -1974,6 +2029,10 @@ static int lan743x_rx_init_ring_element(struct lan743x_rx *rx, int index,
int length = 0;
length = (LAN743X_MAX_FRAME_SIZE + ETH_HLEN + 4 + RX_HEAD_PADDING);
+
+ if ((rx->adapter->netdev->features & NETIF_F_RXFCS) == 0)
+ length -= ETH_FCS_LEN;
+
descriptor = &rx->ring_cpu_ptr[index];
buffer_info = &rx->buffer_info[index];
buffer_info->skb = skb;
@@ -2151,6 +2210,9 @@ static int lan743x_rx_process_packet(struct lan743x_rx *rx)
buffer_info->skb = NULL;
packet_length = RX_DESC_DATA0_FRAME_LENGTH_GET_
(descriptor->data0);
+ if ((rx->adapter->netdev->features &
+ NETIF_F_RXFCS) == 0)
+ packet_length -= ETH_FCS_LEN;
skb_put(skb, packet_length - 4);
skb->protocol = eth_type_trans(skb,
rx->adapter->netdev);
@@ -2608,11 +2670,21 @@ static netdev_tx_t lan743x_netdev_xmit_frame(struct sk_buff *skb,
static int lan743x_netdev_ioctl(struct net_device *netdev,
struct ifreq *ifr, int cmd)
{
+ struct lan743x_adapter *adapter;
+ int ret;
+
+ adapter = netdev_priv(netdev);
if (!netif_running(netdev))
return -EINVAL;
if (cmd == SIOCSHWTSTAMP)
return lan743x_ptp_ioctl(netdev, ifr, cmd);
- return phy_mii_ioctl(netdev->phydev, ifr, cmd);
+
+ if (adapter->virtual_phy)
+ ret = lan743x_virtual_phy_mii_ioctl(netdev->phydev, ifr, cmd);
+ else
+ ret = phy_mii_ioctl(netdev->phydev, ifr, cmd);
+
+ return ret;
}
static void lan743x_netdev_set_multicast(struct net_device *netdev)
@@ -2696,7 +2768,55 @@ static int lan743x_netdev_set_mac_address(struct net_device *netdev,
return 0;
}
+static int lan743x_netdev_set_features(struct net_device *netdev,
+ netdev_features_t features)
+{
+ netdev_features_t features_diff = netdev->features ^ features;
+
+ if (!(features_diff & (NETIF_F_SG | NETIF_F_TSO | NETIF_F_HW_CSUM |
+ NETIF_F_RXCSUM | NETIF_F_RXFCS | NETIF_F_RXALL |
+ NETIF_F_LOOPBACK))) {
+ return 0;
+ }
+
+ if (features & NETIF_F_RXALL)
+ lan743x_netdev_set_bit(netdev, FCT_CFG, 0, 1);
+ else
+ lan743x_netdev_set_bit(netdev, FCT_CFG, 0, 0);
+
+ if (features & NETIF_F_RXFCS)
+ lan743x_netdev_set_bit(netdev, MAC_RX, 4, 0);
+ else
+ lan743x_netdev_set_bit(netdev, MAC_RX, 4, 1);
+
+ if (features & NETIF_F_RXCSUM)
+ lan743x_netdev_set_bit(netdev, MAC_WUCSR2, 31, 0);
+ else
+ lan743x_netdev_set_bit(netdev, MAC_WUCSR2, 31, 1);
+
+ if (features & NETIF_F_LOOPBACK)
+ lan743x_netdev_set_bit(netdev, MAC_CR, 10, 1);
+ else
+ lan743x_netdev_set_bit(netdev, MAC_CR, 10, 0);
+
+ netdev->features = features;
+
+ return 0;
+}
+
+static int lan743x_netdev_init(struct net_device *netdev)
+{
+ netdev->hw_features = NETIF_F_SG | NETIF_F_TSO | NETIF_F_HW_CSUM |
+ NETIF_F_RXCSUM | NETIF_F_RXFCS | NETIF_F_RXALL |
+ NETIF_F_LOOPBACK;
+ netdev->features = netdev->hw_features &
+ ~(NETIF_F_RXFCS | NETIF_F_RXALL | NETIF_F_LOOPBACK);
+
+ return 0;
+}
+
static const struct net_device_ops lan743x_netdev_ops = {
+ .ndo_init = lan743x_netdev_init,
.ndo_open = lan743x_netdev_open,
.ndo_stop = lan743x_netdev_close,
.ndo_start_xmit = lan743x_netdev_xmit_frame,
@@ -2705,6 +2825,7 @@ static const struct net_device_ops lan743x_netdev_ops = {
.ndo_change_mtu = lan743x_netdev_change_mtu,
.ndo_get_stats64 = lan743x_netdev_get_stats64,
.ndo_set_mac_address = lan743x_netdev_set_mac_address,
+ .ndo_set_features = lan743x_netdev_set_features,
};
static void lan743x_hardware_cleanup(struct lan743x_adapter *adapter)
@@ -2724,6 +2845,8 @@ static void lan743x_full_cleanup(struct lan743x_adapter *adapter)
lan743x_mdiobus_cleanup(adapter);
lan743x_hardware_cleanup(adapter);
lan743x_pci_cleanup(adapter);
+
+ kfree(adapter->name);
}
static int lan743x_hardware_init(struct lan743x_adapter *adapter,
@@ -2856,6 +2979,7 @@ static int lan743x_pcidev_probe(struct pci_dev *pdev,
adapter->netdev->netdev_ops = &lan743x_netdev_ops;
adapter->netdev->ethtool_ops = &lan743x_ethtool_ops;
+ adapter->netdev->priv_flags |= IFF_SUPP_NOFCS;
adapter->netdev->features = NETIF_F_SG | NETIF_F_TSO | NETIF_F_HW_CSUM;
adapter->netdev->hw_features = adapter->netdev->features;
diff --git a/drivers/net/ethernet/microchip/lan743x_main.h b/drivers/net/ethernet/microchip/lan743x_main.h
index c61a40411317..4516c76acb08 100644
--- a/drivers/net/ethernet/microchip/lan743x_main.h
+++ b/drivers/net/ethernet/microchip/lan743x_main.h
@@ -104,6 +104,8 @@
#define FCT_FLOW_CTL_ON_THRESHOLD_SET_(value) \
((value << 0) & FCT_FLOW_CTL_ON_THRESHOLD_)
+#define FCT_CFG (0x00DC)
+
#define MAC_CR (0x100)
#define MAC_CR_MII_EN_ BIT(19)
#define MAC_CR_EEE_EN_ BIT(17)
@@ -726,6 +728,9 @@ struct lan743x_adapter {
#define LAN743X_ADAPTER_FLAG_OTP BIT(0)
u32 flags;
+ u8 virtual_phy;
+ u16 *regs802p3;
+ char *name;
};
#define LAN743X_COMPONENT_FLAG_RX(channel) BIT(20 + (channel))
@@ -839,5 +844,7 @@ struct lan743x_rx_buffer_info {
u32 lan743x_csr_read(struct lan743x_adapter *adapter, int offset);
void lan743x_csr_write(struct lan743x_adapter *adapter, int offset, u32 data);
+void lan743x_netdev_set_bit(struct net_device *netdev, int reg, int n,
+ int state);
#endif /* _LAN743X_H */
diff --git a/drivers/net/ethernet/microchip/lan743x_virtual_phy.c b/drivers/net/ethernet/microchip/lan743x_virtual_phy.c
new file mode 100644
index 000000000000..6246b248f86e
--- /dev/null
+++ b/drivers/net/ethernet/microchip/lan743x_virtual_phy.c
@@ -0,0 +1,215 @@
+// SPDX-License-Identifier: GPL-2.0+
+// Copyright (C) 2020 Sergej Bauer
+
+#include <linux/version.h>
+#include <linux/module.h>
+#include <linux/moduleparam.h>
+#include <linux/pci.h>
+#include <linux/netdevice.h>
+#include <linux/etherdevice.h>
+#include <linux/crc32.h>
+#include <linux/microchipphy.h>
+#include <linux/net_tstamp.h>
+#include <linux/phy.h>
+#include <linux/rtnetlink.h>
+#include <linux/iopoll.h>
+#include <linux/crc16.h>
+#include <linux/netdev_features.h>
+#include "lan743x_main.h"
+#include "lan743x_ethtool.h"
+#include "lan743x_virtual_phy.h"
+
+int lan743x_virtual_phy_connect(struct net_device *netdev,
+ struct phy_device *phydev,
+ void (*handler)(struct net_device *),
+ phy_interface_t interface)
+{
+ phydev->adjust_link = handler;
+ phydev->attached_dev = netdev;
+ phydev->duplex = DUPLEX_FULL;
+ phydev->speed = SPEED_1000;
+ phydev->state = PHY_RUNNING;
+ phydev->autoneg = 1;
+ clear_bit(__LINK_STATE_NOCARRIER, &netdev->state);
+ netdev->flags |= IFF_UP; //IFF_LOOPBACK;
+ netdev->phydev = phydev;
+ write_lock_bh(&dev_base_lock);
+ netdev->operstate = IF_OPER_UP;
+ write_unlock_bh(&dev_base_lock);
+ netdev_state_change(netdev);
+
+ return 0;
+}
+
+int lan743x_virtual_phy_mii_ioctl(struct phy_device *phydev,
+ struct ifreq *ifr, int cmd)
+{
+ struct ethtool_link_ksettings ksettings;
+ struct net_device *netdev = phydev->attached_dev;
+ struct mii_ioctl_data *mii_data = if_mii(ifr);
+ struct lan743x_adapter *adapter = netdev_priv(netdev);
+ int duplex, ret = 0;
+ u16 val = mii_data->val_in;
+ u16 reg_num = mii_data->reg_num;
+
+ if (reg_num > 0x1f)
+ return -ERANGE;
+
+ memset(&ksettings, 0, sizeof(ksettings));
+ phy_ethtool_get_link_ksettings(netdev, &ksettings);
+ ksettings.base.autoneg = AUTONEG_DISABLE;
+ switch (cmd) {
+ case SIOCGMIIPHY:
+ break;
+ case SIOCGMIIREG:
+ if (reg_num < 0x20)
+ mii_data->val_out = adapter->regs802p3[reg_num];
+ break;
+ case SIOCSMIIREG:
+ switch (reg_num) {
+ case 0:
+ val &= ~BMCR_RESET;
+ val |= BMCR_LOOPBACK;
+ if (!(val & BMCR_FULLDPLX))
+ val |= BMCR_FULLDPLX;
+ val &= ~0x1f;
+
+ if (val & BMCR_ANRESTART)
+ val &= ~BMCR_ANRESTART;
+
+ if ((val & BMCR_SPEED1000) && (val & BMCR_SPEED100)) {
+ ret = -EINVAL;
+ netif_err(adapter, probe, adapter->netdev,
+ "invalid values for bits 0.6 and 0.13");
+ break;
+ }
+
+ duplex = DUPLEX_FULL;
+ ksettings.base.duplex = DUPLEX_FULL;
+ if (val & BMCR_SPEED1000) {
+ ksettings.base.speed = SPEED_1000;
+ } else {
+ ksettings.base.speed = val & BMCR_SPEED100 ?
+ SPEED_100 : SPEED_10;
+ }
+
+ break;
+
+ case 1:
+ case 2:
+ case 3:
+ case 15:
+ default:
+ break;
+ }
+ if (ret)
+ break;
+
+ adapter->regs802p3[reg_num] = val;
+ ret = lan743x_set_link_ksettings(netdev, &ksettings);
+
+ break;
+ default:
+ netdev_err(netdev, "lan743x: not supported ioctl %X\n", cmd);
+ ret = -EOPNOTSUPP;
+ };
+
+ return ret;
+}
+
+struct phy_device *lan743x_virtual_phy(struct lan743x_adapter *adapter,
+ char *mii_regs[], int mi_regs_count)
+{
+ struct phy_device *phydev = NULL;
+ struct net_device *netdev = adapter->netdev;
+ struct ifreq ifr;
+ struct mii_ioctl_data mii_data;
+ long res;
+ int i, ret;
+
+ phydev = kzalloc(sizeof(*phydev), GFP_KERNEL);
+ phydev->attached_dev = netdev;
+ set_bit(__LINK_STATE_PRESENT, &netdev->state);
+ netdev->reg_state = NETREG_REGISTERED; //NETREG_DUMMY;
+ phy_set_asym_pause(phydev, true, true);
+
+ linkmode_zero(phydev->supported);
+ linkmode_zero(phydev->advertising);
+ linkmode_set_bit(ETHTOOL_LINK_MODE_MII_BIT,
+ phydev->supported);
+ linkmode_set_bit(ETHTOOL_LINK_MODE_Autoneg_BIT,
+ phydev->supported);
+ linkmode_set_bit(ETHTOOL_LINK_MODE_10baseT_Half_BIT,
+ phydev->supported);
+ linkmode_set_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT,
+ phydev->supported);
+ linkmode_set_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT,
+ phydev->supported);
+ linkmode_set_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT,
+ phydev->supported);
+ linkmode_set_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT,
+ phydev->supported);
+ phy_advertise_supported(phydev);
+
+ phydev->state |= PHY_UP;
+ adapter->virtual_phy = 1;
+
+ /* create faked regs [0..1f] */
+ adapter->regs802p3 = kzalloc(sizeof(u16) * 32, GFP_KERNEL);
+ if (!adapter->regs802p3)
+ return NULL;
+
+ lan743x_netdev_set_bit(netdev, MAC_CR, 19, 0);
+ lan743x_netdev_set_bit(netdev, MAC_CR, 12, 0); // turn off ADD
+ lan743x_netdev_set_bit(netdev, MAC_CR, 11, 0); // turn off ASD
+ lan743x_netdev_set_bit(netdev, MAC_CR, 10, 1); // INT_LOOP
+ lan743x_netdev_set_bit(netdev, MAC_CR, 3, 1); // full duplex
+
+ memset(&ifr, 0, sizeof(struct ifreq));
+
+ if (mi_regs_count > 0) {
+ for (i = 0; i < mi_regs_count; i++) {
+ mii_data.reg_num = i;
+ ret = kstrtol(mii_regs[i], 16, &res);
+
+ if (ret == 0)
+ mii_data.val_in = res;
+ else
+ mii_data.val_in = 0xffff;
+
+ memcpy(&ifr.ifr_ifru.ifru_data, &mii_data,
+ sizeof(mii_data));
+ ret = lan743x_virtual_phy_mii_ioctl(phydev, &ifr, SIOCSMIIREG);
+ if (ret < 0)
+ return NULL;
+ }
+ } else {
+
+ mii_data.reg_num = 0x1;
+ mii_data.val_in = 0x796d;
+ memcpy(&ifr.ifr_ifru.ifru_data, &mii_data, sizeof(mii_data));
+ lan743x_virtual_phy_mii_ioctl(phydev, &ifr, SIOCSMIIREG);
+
+ mii_data.reg_num = 0x2;
+ mii_data.val_in = (adapter->csr.id_rev & ID_REV_ID_MASK_) >> 16;
+ memcpy(&ifr.ifr_ifru.ifru_data, &mii_data, sizeof(mii_data));
+ lan743x_virtual_phy_mii_ioctl(phydev, &ifr, SIOCSMIIREG);
+
+ mii_data.reg_num = 0x3;
+ mii_data.val_in = adapter->csr.id_rev & ID_REV_CHIP_REV_MASK_;
+ memcpy(&ifr.ifr_ifru.ifru_data, &mii_data, sizeof(mii_data));
+ lan743x_virtual_phy_mii_ioctl(phydev, &ifr, SIOCSMIIREG);
+
+ mii_data.reg_num = 0xf;
+ mii_data.val_in = 0x3000;
+ memcpy(&ifr.ifr_ifru.ifru_data, &mii_data, sizeof(mii_data));
+ lan743x_virtual_phy_mii_ioctl(phydev, &ifr, SIOCSMIIREG);
+
+ mii_data.reg_num = 0x0;
+ mii_data.val_in = 0x4140;
+ memcpy(&ifr.ifr_ifru.ifru_data, &mii_data, sizeof(mii_data));
+ lan743x_virtual_phy_mii_ioctl(phydev, &ifr, SIOCSMIIREG);
+ }
+
+ return phydev;
+}
diff --git a/drivers/net/ethernet/microchip/lan743x_virtual_phy.h b/drivers/net/ethernet/microchip/lan743x_virtual_phy.h
new file mode 100644
index 000000000000..d91d322e16ce
--- /dev/null
+++ b/drivers/net/ethernet/microchip/lan743x_virtual_phy.h
@@ -0,0 +1,21 @@
+/* SPDX-License-Identifier: GPL-2.0+ */
+/* Copyright (C) 2020 Sergej Bauer */
+
+#ifndef LAN743X_VIRTUAL_PHY_H
+#define LAN743X_VIRTUAL_PHY_H
+
+#include <linux/phy.h>
+#include <uapi/linux/if.h>
+#include "lan743x_main.h"
+
+int lan743x_virtual_phy_mii_ioctl(struct phy_device *phydev,
+ struct ifreq *ifr, int cmd);
+
+struct phy_device *lan743x_virtual_phy(struct lan743x_adapter *adapter,
+ char *mii_regs[], int mi_regs_count);
+
+int lan743x_virtual_phy_connect(struct net_device *netdev,
+ struct phy_device *phydev,
+ void (*handler)(struct net_device *),
+ phy_interface_t interface);
+#endif
Powered by blists - more mailing lists