Author | Tokens | Token Proportion | Commits | Commit Proportion |
---|---|---|---|---|
Salil | 903 | 78.86% | 1 | 7.14% |
Fuyun Liang | 77 | 6.72% | 3 | 21.43% |
Li Peng | 69 | 6.03% | 4 | 28.57% |
Andrew Lunn | 64 | 5.59% | 2 | 14.29% |
Huazhong Tan | 26 | 2.27% | 2 | 14.29% |
Jian Shen | 6 | 0.52% | 2 | 14.29% |
Total | 1145 | 14 |
// SPDX-License-Identifier: GPL-2.0+ // Copyright (c) 2016-2017 Hisilicon Limited. #include <linux/etherdevice.h> #include <linux/kernel.h> #include "hclge_cmd.h" #include "hclge_main.h" #include "hclge_mdio.h" #define HCLGE_PHY_SUPPORTED_FEATURES (SUPPORTED_Autoneg | \ SUPPORTED_TP | \ PHY_10BT_FEATURES | \ PHY_100BT_FEATURES | \ SUPPORTED_1000baseT_Full) enum hclge_mdio_c22_op_seq { HCLGE_MDIO_C22_WRITE = 1, HCLGE_MDIO_C22_READ = 2 }; #define HCLGE_MDIO_CTRL_START_B 0 #define HCLGE_MDIO_CTRL_ST_S 1 #define HCLGE_MDIO_CTRL_ST_M (0x3 << HCLGE_MDIO_CTRL_ST_S) #define HCLGE_MDIO_CTRL_OP_S 3 #define HCLGE_MDIO_CTRL_OP_M (0x3 << HCLGE_MDIO_CTRL_OP_S) #define HCLGE_MDIO_PHYID_S 0 #define HCLGE_MDIO_PHYID_M (0x1f << HCLGE_MDIO_PHYID_S) #define HCLGE_MDIO_PHYREG_S 0 #define HCLGE_MDIO_PHYREG_M (0x1f << HCLGE_MDIO_PHYREG_S) #define HCLGE_MDIO_STA_B 0 struct hclge_mdio_cfg_cmd { u8 ctrl_bit; u8 phyid; u8 phyad; u8 rsvd; __le16 reserve; __le16 data_wr; __le16 data_rd; __le16 sta; }; static int hclge_mdio_write(struct mii_bus *bus, int phyid, int regnum, u16 data) { struct hclge_mdio_cfg_cmd *mdio_cmd; struct hclge_dev *hdev = bus->priv; struct hclge_desc desc; int ret; if (test_bit(HCLGE_STATE_CMD_DISABLE, &hdev->state)) return 0; hclge_cmd_setup_basic_desc(&desc, HCLGE_OPC_MDIO_CONFIG, false); mdio_cmd = (struct hclge_mdio_cfg_cmd *)desc.data; hnae3_set_field(mdio_cmd->phyid, HCLGE_MDIO_PHYID_M, HCLGE_MDIO_PHYID_S, phyid); hnae3_set_field(mdio_cmd->phyad, HCLGE_MDIO_PHYREG_M, HCLGE_MDIO_PHYREG_S, regnum); hnae3_set_bit(mdio_cmd->ctrl_bit, HCLGE_MDIO_CTRL_START_B, 1); hnae3_set_field(mdio_cmd->ctrl_bit, HCLGE_MDIO_CTRL_ST_M, HCLGE_MDIO_CTRL_ST_S, 1); hnae3_set_field(mdio_cmd->ctrl_bit, HCLGE_MDIO_CTRL_OP_M, HCLGE_MDIO_CTRL_OP_S, HCLGE_MDIO_C22_WRITE); mdio_cmd->data_wr = cpu_to_le16(data); ret = hclge_cmd_send(&hdev->hw, &desc, 1); if (ret) { dev_err(&hdev->pdev->dev, "mdio write fail when sending cmd, status is %d.\n", ret); return ret; } return 0; } static int hclge_mdio_read(struct mii_bus *bus, int phyid, int regnum) { struct hclge_mdio_cfg_cmd *mdio_cmd; struct hclge_dev *hdev = bus->priv; struct hclge_desc desc; int ret; if (test_bit(HCLGE_STATE_CMD_DISABLE, &hdev->state)) return 0; hclge_cmd_setup_basic_desc(&desc, HCLGE_OPC_MDIO_CONFIG, true); mdio_cmd = (struct hclge_mdio_cfg_cmd *)desc.data; hnae3_set_field(mdio_cmd->phyid, HCLGE_MDIO_PHYID_M, HCLGE_MDIO_PHYID_S, phyid); hnae3_set_field(mdio_cmd->phyad, HCLGE_MDIO_PHYREG_M, HCLGE_MDIO_PHYREG_S, regnum); hnae3_set_bit(mdio_cmd->ctrl_bit, HCLGE_MDIO_CTRL_START_B, 1); hnae3_set_field(mdio_cmd->ctrl_bit, HCLGE_MDIO_CTRL_ST_M, HCLGE_MDIO_CTRL_ST_S, 1); hnae3_set_field(mdio_cmd->ctrl_bit, HCLGE_MDIO_CTRL_OP_M, HCLGE_MDIO_CTRL_OP_S, HCLGE_MDIO_C22_READ); /* Read out phy data */ ret = hclge_cmd_send(&hdev->hw, &desc, 1); if (ret) { dev_err(&hdev->pdev->dev, "mdio read fail when get data, status is %d.\n", ret); return ret; } if (hnae3_get_bit(le16_to_cpu(mdio_cmd->sta), HCLGE_MDIO_STA_B)) { dev_err(&hdev->pdev->dev, "mdio read data error\n"); return -EIO; } return le16_to_cpu(mdio_cmd->data_rd); } int hclge_mac_mdio_config(struct hclge_dev *hdev) { struct hclge_mac *mac = &hdev->hw.mac; struct phy_device *phydev; struct mii_bus *mdio_bus; int ret; if (hdev->hw.mac.phy_addr >= PHY_MAX_ADDR) { dev_err(&hdev->pdev->dev, "phy_addr(%d) is too large.\n", hdev->hw.mac.phy_addr); return -EINVAL; } mdio_bus = devm_mdiobus_alloc(&hdev->pdev->dev); if (!mdio_bus) return -ENOMEM; mdio_bus->name = "hisilicon MII bus"; mdio_bus->read = hclge_mdio_read; mdio_bus->write = hclge_mdio_write; snprintf(mdio_bus->id, MII_BUS_ID_SIZE, "%s-%s", "mii", dev_name(&hdev->pdev->dev)); mdio_bus->parent = &hdev->pdev->dev; mdio_bus->priv = hdev; mdio_bus->phy_mask = ~(1 << mac->phy_addr); ret = mdiobus_register(mdio_bus); if (ret) { dev_err(mdio_bus->parent, "Failed to register MDIO bus ret = %#x\n", ret); return ret; } phydev = mdiobus_get_phy(mdio_bus, mac->phy_addr); if (!phydev) { dev_err(mdio_bus->parent, "Failed to get phy device\n"); mdiobus_unregister(mdio_bus); return -EIO; } mac->phydev = phydev; mac->mdio_bus = mdio_bus; return 0; } static void hclge_mac_adjust_link(struct net_device *netdev) { struct hnae3_handle *h = *((void **)netdev_priv(netdev)); struct hclge_vport *vport = hclge_get_vport(h); struct hclge_dev *hdev = vport->back; int duplex, speed; int ret; /* When phy link down, do nothing */ if (netdev->phydev->link == 0) return; speed = netdev->phydev->speed; duplex = netdev->phydev->duplex; ret = hclge_cfg_mac_speed_dup(hdev, speed, duplex); if (ret) netdev_err(netdev, "failed to adjust link.\n"); ret = hclge_cfg_flowctrl(hdev); if (ret) netdev_err(netdev, "failed to configure flow control.\n"); } int hclge_mac_connect_phy(struct hclge_dev *hdev) { struct net_device *netdev = hdev->vport[0].nic.netdev; struct phy_device *phydev = hdev->hw.mac.phydev; __ETHTOOL_DECLARE_LINK_MODE_MASK(mask) = { 0, }; int ret; if (!phydev) return 0; linkmode_clear_bit(ETHTOOL_LINK_MODE_FIBRE_BIT, phydev->supported); ret = phy_connect_direct(netdev, phydev, hclge_mac_adjust_link, PHY_INTERFACE_MODE_SGMII); if (ret) { netdev_err(netdev, "phy_connect_direct err.\n"); return ret; } linkmode_set_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, mask); linkmode_set_bit(ETHTOOL_LINK_MODE_TP_BIT, mask); linkmode_set_bit_array(phy_10_100_features_array, ARRAY_SIZE(phy_10_100_features_array), mask); linkmode_set_bit_array(phy_gbit_features_array, ARRAY_SIZE(phy_gbit_features_array), mask); linkmode_and(phydev->supported, phydev->supported, mask); phy_support_asym_pause(phydev); return 0; } void hclge_mac_disconnect_phy(struct hclge_dev *hdev) { struct phy_device *phydev = hdev->hw.mac.phydev; if (!phydev) return; phy_disconnect(phydev); } void hclge_mac_start_phy(struct hclge_dev *hdev) { struct phy_device *phydev = hdev->hw.mac.phydev; if (!phydev) return; phy_start(phydev); } void hclge_mac_stop_phy(struct hclge_dev *hdev) { struct net_device *netdev = hdev->vport[0].nic.netdev; struct phy_device *phydev = netdev->phydev; if (!phydev) return; phy_stop(phydev); }
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with Cregit http://github.com/cregit/cregit
Version 2.0-RC1