net: designware: socfpga: adapt to Gen5

This driver was written for Arria10, but it applies to Gen5, too.

The main difference is that Gen5 has 2 MACs (Arria10 has 3) and the
syscon bits are encoded in the same register, thus an offset is needed.

This offset is already read from the devicetree, but for Arria10 it is
always 0, which is probably why it has been ignored. By using this
offset when writing the phy mode into the syscon regiter, we can use
this driver to set the phy mode for both of the MACs on Gen5.

Since the PHY mode bits in sysmgr are the same even for Stratix10,
let's drop the detection of the sub-mach by checking compatible
version and just use the same code for all FPGAs.

To work correctly, this driver depends on SYSCON and REGMAP, so select
those via Kconfig when it is enabeld.

Tested on socfpga_socrates (where the 2nd MAC is connected, so a shift
offset is required).

Signed-off-by: Simon Goldschmidt <simon.k.r.goldschmidt@gmail.com>
This commit is contained in:
Simon Goldschmidt 2019-01-13 19:58:40 +01:00 committed by Marek Vasut
parent b89074f650
commit 4f1267cea1
2 changed files with 34 additions and 53 deletions

View File

@ -162,6 +162,8 @@ config ETH_DESIGNWARE
provide the PHY (physical media interface). provide the PHY (physical media interface).
config ETH_DESIGNWARE_SOCFPGA config ETH_DESIGNWARE_SOCFPGA
select REGMAP
select SYSCON
bool "Altera SoCFPGA extras for Synopsys Designware Ethernet MAC" bool "Altera SoCFPGA extras for Synopsys Designware Ethernet MAC"
depends on DM_ETH && ETH_DESIGNWARE depends on DM_ETH && ETH_DESIGNWARE
help help

View File

@ -17,16 +17,10 @@
#include <asm/arch/system_manager.h> #include <asm/arch/system_manager.h>
enum dwmac_type {
DWMAC_SOCFPGA_GEN5 = 0,
DWMAC_SOCFPGA_ARRIA10,
DWMAC_SOCFPGA_STRATIX10,
};
struct dwmac_socfpga_platdata { struct dwmac_socfpga_platdata {
struct dw_eth_pdata dw_eth_pdata; struct dw_eth_pdata dw_eth_pdata;
enum dwmac_type type;
void *phy_intf; void *phy_intf;
u32 reg_shift;
}; };
static int dwmac_socfpga_ofdata_to_platdata(struct udevice *dev) static int dwmac_socfpga_ofdata_to_platdata(struct udevice *dev)
@ -63,21 +57,7 @@ static int dwmac_socfpga_ofdata_to_platdata(struct udevice *dev)
} }
pdata->phy_intf = range + args.args[0]; pdata->phy_intf = range + args.args[0];
pdata->reg_shift = args.args[1];
/*
* Sadly, the Altera DT bindings don't have SoC-specific compatibles,
* so we have to guesstimate which SoC we are running on from the
* DWMAC version. Luckily, Altera at least updated the DWMAC with
* each SoC.
*/
if (ofnode_device_is_compatible(dev->node, "snps,dwmac-3.70a"))
pdata->type = DWMAC_SOCFPGA_GEN5;
if (ofnode_device_is_compatible(dev->node, "snps,dwmac-3.72a"))
pdata->type = DWMAC_SOCFPGA_ARRIA10;
if (ofnode_device_is_compatible(dev->node, "snps,dwmac-3.74a"))
pdata->type = DWMAC_SOCFPGA_STRATIX10;
return designware_eth_ofdata_to_platdata(dev); return designware_eth_ofdata_to_platdata(dev);
} }
@ -88,40 +68,39 @@ static int dwmac_socfpga_probe(struct udevice *dev)
struct eth_pdata *edata = &pdata->dw_eth_pdata.eth_pdata; struct eth_pdata *edata = &pdata->dw_eth_pdata.eth_pdata;
struct reset_ctl_bulk reset_bulk; struct reset_ctl_bulk reset_bulk;
int ret; int ret;
u8 modereg; u32 modereg;
u32 modemask;
if (pdata->type == DWMAC_SOCFPGA_ARRIA10) { switch (edata->phy_interface) {
switch (edata->phy_interface) { case PHY_INTERFACE_MODE_MII:
case PHY_INTERFACE_MODE_MII: case PHY_INTERFACE_MODE_GMII:
case PHY_INTERFACE_MODE_GMII: modereg = SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_GMII_MII;
modereg = SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_GMII_MII; break;
break; case PHY_INTERFACE_MODE_RMII:
case PHY_INTERFACE_MODE_RMII: modereg = SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_RMII;
modereg = SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_RMII; break;
break; case PHY_INTERFACE_MODE_RGMII:
case PHY_INTERFACE_MODE_RGMII: modereg = SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_RGMII;
modereg = SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_RGMII; break;
break; default:
default: dev_err(dev, "Unsupported PHY mode\n");
dev_err(dev, "Unsupported PHY mode\n"); return -EINVAL;
return -EINVAL;
}
ret = reset_get_bulk(dev, &reset_bulk);
if (ret) {
dev_err(dev, "Failed to get reset: %d\n", ret);
return ret;
}
reset_assert_bulk(&reset_bulk);
clrsetbits_le32(pdata->phy_intf,
SYSMGR_EMACGRP_CTRL_PHYSEL_MASK,
modereg);
reset_release_bulk(&reset_bulk);
} }
ret = reset_get_bulk(dev, &reset_bulk);
if (ret) {
dev_err(dev, "Failed to get reset: %d\n", ret);
return ret;
}
reset_assert_bulk(&reset_bulk);
modemask = SYSMGR_EMACGRP_CTRL_PHYSEL_MASK << pdata->reg_shift;
clrsetbits_le32(pdata->phy_intf, modemask,
modereg << pdata->reg_shift);
reset_release_bulk(&reset_bulk);
return designware_eth_probe(dev); return designware_eth_probe(dev);
} }