|
@@ -367,7 +367,6 @@ struct cpsw_priv {
|
|
spinlock_t lock;
|
|
spinlock_t lock;
|
|
struct platform_device *pdev;
|
|
struct platform_device *pdev;
|
|
struct net_device *ndev;
|
|
struct net_device *ndev;
|
|
- struct device_node *phy_node;
|
|
|
|
struct napi_struct napi_rx;
|
|
struct napi_struct napi_rx;
|
|
struct napi_struct napi_tx;
|
|
struct napi_struct napi_tx;
|
|
struct device *dev;
|
|
struct device *dev;
|
|
@@ -1148,25 +1147,34 @@ static void cpsw_slave_open(struct cpsw_slave *slave, struct cpsw_priv *priv)
|
|
cpsw_ale_add_mcast(priv->ale, priv->ndev->broadcast,
|
|
cpsw_ale_add_mcast(priv->ale, priv->ndev->broadcast,
|
|
1 << slave_port, 0, 0, ALE_MCAST_FWD_2);
|
|
1 << slave_port, 0, 0, ALE_MCAST_FWD_2);
|
|
|
|
|
|
- if (priv->phy_node)
|
|
|
|
- slave->phy = of_phy_connect(priv->ndev, priv->phy_node,
|
|
|
|
|
|
+ if (slave->data->phy_node) {
|
|
|
|
+ slave->phy = of_phy_connect(priv->ndev, slave->data->phy_node,
|
|
&cpsw_adjust_link, 0, slave->data->phy_if);
|
|
&cpsw_adjust_link, 0, slave->data->phy_if);
|
|
- else
|
|
|
|
|
|
+ if (!slave->phy) {
|
|
|
|
+ dev_err(priv->dev, "phy \"%s\" not found on slave %d\n",
|
|
|
|
+ slave->data->phy_node->full_name,
|
|
|
|
+ slave->slave_num);
|
|
|
|
+ return;
|
|
|
|
+ }
|
|
|
|
+ } else {
|
|
slave->phy = phy_connect(priv->ndev, slave->data->phy_id,
|
|
slave->phy = phy_connect(priv->ndev, slave->data->phy_id,
|
|
&cpsw_adjust_link, slave->data->phy_if);
|
|
&cpsw_adjust_link, slave->data->phy_if);
|
|
- if (IS_ERR(slave->phy)) {
|
|
|
|
- dev_err(priv->dev, "phy %s not found on slave %d\n",
|
|
|
|
- slave->data->phy_id, slave->slave_num);
|
|
|
|
- slave->phy = NULL;
|
|
|
|
- } else {
|
|
|
|
- phy_attached_info(slave->phy);
|
|
|
|
|
|
+ if (IS_ERR(slave->phy)) {
|
|
|
|
+ dev_err(priv->dev,
|
|
|
|
+ "phy \"%s\" not found on slave %d, err %ld\n",
|
|
|
|
+ slave->data->phy_id, slave->slave_num,
|
|
|
|
+ PTR_ERR(slave->phy));
|
|
|
|
+ slave->phy = NULL;
|
|
|
|
+ return;
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
|
|
- phy_start(slave->phy);
|
|
|
|
|
|
+ phy_attached_info(slave->phy);
|
|
|
|
|
|
- /* Configure GMII_SEL register */
|
|
|
|
- cpsw_phy_sel(&priv->pdev->dev, slave->phy->interface,
|
|
|
|
- slave->slave_num);
|
|
|
|
- }
|
|
|
|
|
|
+ phy_start(slave->phy);
|
|
|
|
+
|
|
|
|
+ /* Configure GMII_SEL register */
|
|
|
|
+ cpsw_phy_sel(&priv->pdev->dev, slave->phy->interface, slave->slave_num);
|
|
}
|
|
}
|
|
|
|
|
|
static inline void cpsw_add_default_vlan(struct cpsw_priv *priv)
|
|
static inline void cpsw_add_default_vlan(struct cpsw_priv *priv)
|
|
@@ -1940,12 +1948,11 @@ static void cpsw_slave_init(struct cpsw_slave *slave, struct cpsw_priv *priv,
|
|
slave->port_vlan = data->dual_emac_res_vlan;
|
|
slave->port_vlan = data->dual_emac_res_vlan;
|
|
}
|
|
}
|
|
|
|
|
|
-static int cpsw_probe_dt(struct cpsw_priv *priv,
|
|
|
|
|
|
+static int cpsw_probe_dt(struct cpsw_platform_data *data,
|
|
struct platform_device *pdev)
|
|
struct platform_device *pdev)
|
|
{
|
|
{
|
|
struct device_node *node = pdev->dev.of_node;
|
|
struct device_node *node = pdev->dev.of_node;
|
|
struct device_node *slave_node;
|
|
struct device_node *slave_node;
|
|
- struct cpsw_platform_data *data = &priv->data;
|
|
|
|
int i = 0, ret;
|
|
int i = 0, ret;
|
|
u32 prop;
|
|
u32 prop;
|
|
|
|
|
|
@@ -2033,25 +2040,21 @@ static int cpsw_probe_dt(struct cpsw_priv *priv,
|
|
if (strcmp(slave_node->name, "slave"))
|
|
if (strcmp(slave_node->name, "slave"))
|
|
continue;
|
|
continue;
|
|
|
|
|
|
- priv->phy_node = of_parse_phandle(slave_node, "phy-handle", 0);
|
|
|
|
|
|
+ slave_data->phy_node = of_parse_phandle(slave_node,
|
|
|
|
+ "phy-handle", 0);
|
|
parp = of_get_property(slave_node, "phy_id", &lenp);
|
|
parp = of_get_property(slave_node, "phy_id", &lenp);
|
|
- if (of_phy_is_fixed_link(slave_node)) {
|
|
|
|
- struct device_node *phy_node;
|
|
|
|
- struct phy_device *phy_dev;
|
|
|
|
-
|
|
|
|
|
|
+ if (slave_data->phy_node) {
|
|
|
|
+ dev_dbg(&pdev->dev,
|
|
|
|
+ "slave[%d] using phy-handle=\"%s\"\n",
|
|
|
|
+ i, slave_data->phy_node->full_name);
|
|
|
|
+ } else if (of_phy_is_fixed_link(slave_node)) {
|
|
/* In the case of a fixed PHY, the DT node associated
|
|
/* In the case of a fixed PHY, the DT node associated
|
|
* to the PHY is the Ethernet MAC DT node.
|
|
* to the PHY is the Ethernet MAC DT node.
|
|
*/
|
|
*/
|
|
ret = of_phy_register_fixed_link(slave_node);
|
|
ret = of_phy_register_fixed_link(slave_node);
|
|
if (ret)
|
|
if (ret)
|
|
return ret;
|
|
return ret;
|
|
- phy_node = of_node_get(slave_node);
|
|
|
|
- phy_dev = of_phy_find_device(phy_node);
|
|
|
|
- if (!phy_dev)
|
|
|
|
- return -ENODEV;
|
|
|
|
- snprintf(slave_data->phy_id, sizeof(slave_data->phy_id),
|
|
|
|
- PHY_ID_FMT, phy_dev->mdio.bus->id,
|
|
|
|
- phy_dev->mdio.addr);
|
|
|
|
|
|
+ slave_data->phy_node = of_node_get(slave_node);
|
|
} else if (parp) {
|
|
} else if (parp) {
|
|
u32 phyid;
|
|
u32 phyid;
|
|
struct device_node *mdio_node;
|
|
struct device_node *mdio_node;
|
|
@@ -2072,7 +2075,9 @@ static int cpsw_probe_dt(struct cpsw_priv *priv,
|
|
snprintf(slave_data->phy_id, sizeof(slave_data->phy_id),
|
|
snprintf(slave_data->phy_id, sizeof(slave_data->phy_id),
|
|
PHY_ID_FMT, mdio->name, phyid);
|
|
PHY_ID_FMT, mdio->name, phyid);
|
|
} else {
|
|
} else {
|
|
- dev_err(&pdev->dev, "No slave[%d] phy_id or fixed-link property\n", i);
|
|
|
|
|
|
+ dev_err(&pdev->dev,
|
|
|
|
+ "No slave[%d] phy_id, phy-handle, or fixed-link property\n",
|
|
|
|
+ i);
|
|
goto no_phy_slave;
|
|
goto no_phy_slave;
|
|
}
|
|
}
|
|
slave_data->phy_if = of_get_phy_mode(slave_node);
|
|
slave_data->phy_if = of_get_phy_mode(slave_node);
|
|
@@ -2275,7 +2280,7 @@ static int cpsw_probe(struct platform_device *pdev)
|
|
/* Select default pin state */
|
|
/* Select default pin state */
|
|
pinctrl_pm_select_default_state(&pdev->dev);
|
|
pinctrl_pm_select_default_state(&pdev->dev);
|
|
|
|
|
|
- if (cpsw_probe_dt(priv, pdev)) {
|
|
|
|
|
|
+ if (cpsw_probe_dt(&priv->data, pdev)) {
|
|
dev_err(&pdev->dev, "cpsw: platform data missing\n");
|
|
dev_err(&pdev->dev, "cpsw: platform data missing\n");
|
|
ret = -ENODEV;
|
|
ret = -ENODEV;
|
|
goto clean_runtime_disable_ret;
|
|
goto clean_runtime_disable_ret;
|