lkml.org 
[lkml]   [2022]   [Dec]   [1]   [last100]   RSS Feed
Views: [wrap][no wrap]   [headers]  [forward] 
 
Messages in this thread
    Patch in this message
    /
    From
    Subject[PATCH v1 5/7] net: stmmac: Add StarFive dwmac supoort
    Date
    This adds StarFive dwmac driver support on the StarFive JH7110 SoCs.

    Signed-off-by: Yanhong Wang <yanhong.wang@starfivetech.com>
    ---
    MAINTAINERS | 1 +
    drivers/net/ethernet/stmicro/stmmac/Kconfig | 11 ++
    drivers/net/ethernet/stmicro/stmmac/Makefile | 1 +
    .../stmicro/stmmac/dwmac-starfive-plat.c | 147 ++++++++++++++++++
    4 files changed, 160 insertions(+)
    create mode 100644 drivers/net/ethernet/stmicro/stmmac/dwmac-starfive-plat.c

    diff --git a/MAINTAINERS b/MAINTAINERS
    index 7eaaec8d3b96..36cb00cf860b 100644
    --- a/MAINTAINERS
    +++ b/MAINTAINERS
    @@ -19610,6 +19610,7 @@ STARFIVE DWMAC GLUE LAYER
    M: Yanhong Wang <yanhong.wang@starfivetech.com>
    S: Maintained
    F: Documentation/devicetree/bindings/net/starfive,dwmac-plat.yaml
    +F: drivers/net/ethernet/stmicro/stmmac/dwmac-starfive-plat.c

    STARFIVE PINCTRL DRIVER
    M: Emil Renner Berthing <kernel@esmil.dk>
    diff --git a/drivers/net/ethernet/stmicro/stmmac/Kconfig b/drivers/net/ethernet/stmicro/stmmac/Kconfig
    index 31ff35174034..1e29cd3770b9 100644
    --- a/drivers/net/ethernet/stmicro/stmmac/Kconfig
    +++ b/drivers/net/ethernet/stmicro/stmmac/Kconfig
    @@ -235,6 +235,17 @@ config DWMAC_INTEL_PLAT
    the stmmac device driver. This driver is used for the Intel Keem Bay
    SoC.

    +config DWMAC_STARFIVE_PLAT
    + tristate "StarFive dwmac support"
    + depends on OF && COMMON_CLK
    + depends on STMMAC_ETH
    + default SOC_STARFIVE
    + help
    + Support for ethernet controllers on StarFive RISC-V SoCs
    +
    + This selects the StarFive platform specific glue layer support for
    + the stmmac device driver. This driver is used for StarFive RISC-V SoCs.
    +
    config DWMAC_VISCONTI
    tristate "Toshiba Visconti DWMAC support"
    default ARCH_VISCONTI
    diff --git a/drivers/net/ethernet/stmicro/stmmac/Makefile b/drivers/net/ethernet/stmicro/stmmac/Makefile
    index d4e12e9ace4f..a63ab0ab5071 100644
    --- a/drivers/net/ethernet/stmicro/stmmac/Makefile
    +++ b/drivers/net/ethernet/stmicro/stmmac/Makefile
    @@ -31,6 +31,7 @@ obj-$(CONFIG_DWMAC_DWC_QOS_ETH) += dwmac-dwc-qos-eth.o
    obj-$(CONFIG_DWMAC_INTEL_PLAT) += dwmac-intel-plat.o
    obj-$(CONFIG_DWMAC_GENERIC) += dwmac-generic.o
    obj-$(CONFIG_DWMAC_IMX8) += dwmac-imx.o
    +obj-$(CONFIG_DWMAC_STARFIVE_PLAT) += dwmac-starfive-plat.o
    obj-$(CONFIG_DWMAC_VISCONTI) += dwmac-visconti.o
    stmmac-platform-objs:= stmmac_platform.o
    dwmac-altr-socfpga-objs := altr_tse_pcs.o dwmac-socfpga.o
    diff --git a/drivers/net/ethernet/stmicro/stmmac/dwmac-starfive-plat.c b/drivers/net/ethernet/stmicro/stmmac/dwmac-starfive-plat.c
    new file mode 100644
    index 000000000000..8fbf584d4e19
    --- /dev/null
    +++ b/drivers/net/ethernet/stmicro/stmmac/dwmac-starfive-plat.c
    @@ -0,0 +1,147 @@
    +// SPDX-License-Identifier: GPL-2.0+
    +/*
    + * StarFive DWMAC platform driver
    + *
    + * Copyright(C) 2022 StarFive Technology Co., Ltd.
    + *
    + */
    +
    +#include <linux/of_device.h>
    +#include "stmmac_platform.h"
    +
    +struct starfive_dwmac {
    + struct device *dev;
    + struct clk *clk_tx;
    + struct clk *clk_gtx;
    + struct clk *clk_gtxc;
    +};
    +
    +static void starfive_eth_fix_mac_speed(void *priv, unsigned int speed)
    +{
    + struct starfive_dwmac *dwmac = priv;
    + unsigned long rate;
    + int err;
    +
    + switch (speed) {
    + case SPEED_1000:
    + rate = 125000000;
    + break;
    + case SPEED_100:
    + rate = 25000000;
    + break;
    + case SPEED_10:
    + rate = 2500000;
    + break;
    + default:
    + dev_err(dwmac->dev, "invalid speed %u\n", speed);
    + return;
    + }
    +
    + err = clk_set_rate(dwmac->clk_gtx, rate);
    + if (err)
    + dev_err(dwmac->dev, "failed to set tx rate %lu\n", rate);
    +}
    +
    +static void dwmac_starfive_clk_disable(void *clk)
    +{
    + clk_disable_unprepare(clk);
    +}
    +
    +static int starfive_eth_plat_probe(struct platform_device *pdev)
    +{
    + struct plat_stmmacenet_data *plat_dat;
    + struct stmmac_resources stmmac_res;
    + struct starfive_dwmac *dwmac;
    + int err;
    +
    + err = stmmac_get_platform_resources(pdev, &stmmac_res);
    + if (err)
    + return err;
    +
    + plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac);
    + if (IS_ERR(plat_dat)) {
    + dev_err(&pdev->dev, "dt configuration failed\n");
    + return PTR_ERR(plat_dat);
    + }
    +
    + dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL);
    + if (!dwmac)
    + return -ENOMEM;
    +
    + dwmac->clk_tx = devm_clk_get(&pdev->dev, "tx");
    + if (IS_ERR(dwmac->clk_tx))
    + return dev_err_probe(&pdev->dev, PTR_ERR(dwmac->clk_tx),
    + "error getting tx clock\n");
    +
    + err = devm_add_action(&pdev->dev, dwmac_starfive_clk_disable,
    + dwmac->clk_tx);
    + if (err)
    + return err;
    +
    + err = clk_prepare_enable(dwmac->clk_tx);
    + if (err)
    + return dev_err_probe(&pdev->dev, err, "error enabling tx clock\n");
    +
    + dwmac->clk_gtx = devm_clk_get(&pdev->dev, "gtx");
    + if (IS_ERR(dwmac->clk_gtx))
    + return dev_err_probe(&pdev->dev, PTR_ERR(dwmac->clk_gtx),
    + "error getting gtx clock\n");
    +
    + err = devm_add_action(&pdev->dev, dwmac_starfive_clk_disable,
    + dwmac->clk_gtx);
    + if (err)
    + return err;
    +
    + err = clk_prepare_enable(dwmac->clk_gtx);
    + if (err)
    + return dev_err_probe(&pdev->dev, err, "error enabling gtx clock\n");
    +
    + dwmac->clk_gtxc = devm_clk_get(&pdev->dev, "gtxc");
    + if (IS_ERR(dwmac->clk_gtxc))
    + return dev_err_probe(&pdev->dev, PTR_ERR(dwmac->clk_gtxc),
    + "error getting gtxc clock\n");
    +
    + err = devm_add_action(&pdev->dev, dwmac_starfive_clk_disable,
    + dwmac->clk_gtxc);
    + if (err)
    + return err;
    +
    + err = clk_prepare_enable(dwmac->clk_gtxc);
    + if (err)
    + return dev_err_probe(&pdev->dev, err, "error enabling gtxc clock\n");
    +
    + dwmac->dev = &pdev->dev;
    + plat_dat->fix_mac_speed = starfive_eth_fix_mac_speed;
    + plat_dat->init = NULL;
    + plat_dat->bsp_priv = dwmac;
    + plat_dat->dma_cfg->dche = true;
    +
    + err = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
    + if (err) {
    + stmmac_remove_config_dt(pdev, plat_dat);
    + return err;
    + }
    +
    + return 0;
    +}
    +
    +static const struct of_device_id starfive_eth_plat_match[] = {
    + {.compatible = "starfive,dwmac"},
    + { }
    +};
    +
    +static struct platform_driver starfive_eth_plat_driver = {
    + .probe = starfive_eth_plat_probe,
    + .remove = stmmac_pltfr_remove,
    + .driver = {
    + .name = "starfive-eth-plat",
    + .pm = &stmmac_pltfr_pm_ops,
    + .of_match_table = starfive_eth_plat_match,
    + },
    +};
    +
    +module_platform_driver(starfive_eth_plat_driver);
    +
    +MODULE_LICENSE("GPL");
    +MODULE_DESCRIPTION("StarFive DWMAC platform driver");
    +MODULE_AUTHOR("Yanhong Wang <yanhong.wang@starfivetech.com>");
    --
    2.17.1
    \
     
     \ /
      Last update: 2022-12-01 10:30    [W:2.810 / U:0.008 seconds]
    ©2003-2020 Jasper Spaans|hosted at Digital Ocean and TransIP|Read the blog|Advertise on this site