LXR linux/drivers/net/ethernet/stmicro/stmmac/dwmac-anarion.c

   1/*
   2 * Adaptrum Anarion DWMAC glue layer
   3 *
   4 * Copyright (C) 2017, Adaptrum, Inc.
   5 * (Written by Alexandru Gagniuc <alex.g at adaptrum.com> for Adaptrum, Inc.)
   6 * Licensed under the GPLv2 or (at your option) any later version.
   7 */
   8
   9#include <linux/io.h>
  10#include <linux/of.h>
  11#include <linux/of_net.h>
  12#include <linux/stmmac.h>
  13
  14#include "stmmac.h"
  15#include "stmmac_platform.h"
  16
  17#define GMAC_RESET_CONTROL_REG          0
  18#define GMAC_SW_CONFIG_REG              4
  19#define  GMAC_CONFIG_INTF_SEL_MASK      (0x7 << 0)
  20#define  GMAC_CONFIG_INTF_RGMII         (0x1 << 0)
  21
  22struct anarion_gmac {
  23        uintptr_t ctl_block;
  24        uint32_t phy_intf_sel;
  25};
  26
  27static uint32_t gmac_read_reg(struct anarion_gmac *gmac, uint8_t reg)
  28{
  29        return readl((void *)(gmac->ctl_block + reg));
  30};
  31
  32static void gmac_write_reg(struct anarion_gmac *gmac, uint8_t reg, uint32_t val)
  33{
  34        writel(val, (void *)(gmac->ctl_block + reg));
  35}
  36
  37static int anarion_gmac_init(struct platform_device *pdev, void *priv)
  38{
  39        uint32_t sw_config;
  40        struct anarion_gmac *gmac = priv;
  41
  42        /* Reset logic, configure interface mode, then release reset. SIMPLE! */
  43        gmac_write_reg(gmac, GMAC_RESET_CONTROL_REG, 1);
  44
  45        sw_config = gmac_read_reg(gmac, GMAC_SW_CONFIG_REG);
  46        sw_config &= ~GMAC_CONFIG_INTF_SEL_MASK;
  47        sw_config |= (gmac->phy_intf_sel & GMAC_CONFIG_INTF_SEL_MASK);
  48        gmac_write_reg(gmac, GMAC_SW_CONFIG_REG, sw_config);
  49
  50        gmac_write_reg(gmac, GMAC_RESET_CONTROL_REG, 0);
  51
  52        return 0;
  53}
  54
  55static void anarion_gmac_exit(struct platform_device *pdev, void *priv)
  56{
  57        struct anarion_gmac *gmac = priv;
  58
  59        gmac_write_reg(gmac, GMAC_RESET_CONTROL_REG, 1);
  60}
  61
  62static struct anarion_gmac *anarion_config_dt(struct platform_device *pdev)
  63{
  64        int phy_mode;
  65        struct resource *res;
  66        void __iomem *ctl_block;
  67        struct anarion_gmac *gmac;
  68
  69        res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
  70        ctl_block = devm_ioremap_resource(&pdev->dev, res);
  71        if (IS_ERR(ctl_block)) {
  72                dev_err(&pdev->dev, "Cannot get reset region (%ld)!\n",
  73                        PTR_ERR(ctl_block));
  74                return ctl_block;
  75        }
  76
  77        gmac = devm_kzalloc(&pdev->dev, sizeof(*gmac), GFP_KERNEL);
  78        if (!gmac)
  79                return ERR_PTR(-ENOMEM);
  80
  81        gmac->ctl_block = (uintptr_t)ctl_block;
  82
  83        phy_mode = of_get_phy_mode(pdev->dev.of_node);
  84        switch (phy_mode) {
  85        case PHY_INTERFACE_MODE_RGMII:          /* Fall through */
  86        case PHY_INTERFACE_MODE_RGMII_ID        /* Fall through */:
  87        case PHY_INTERFACE_MODE_RGMII_RXID:     /* Fall through */
  88        case PHY_INTERFACE_MODE_RGMII_TXID:
  89                gmac->phy_intf_sel = GMAC_CONFIG_INTF_RGMII;
  90                break;
  91        default:
  92                dev_err(&pdev->dev, "Unsupported phy-mode (%d)\n",
  93                        phy_mode);
  94                return ERR_PTR(-ENOTSUPP);
  95        }
  96
  97        return gmac;
  98}
  99
 100static int anarion_dwmac_probe(struct platform_device *pdev)
 101{
 102        int ret;
 103        struct anarion_gmac *gmac;
 104        struct plat_stmmacenet_data *plat_dat;
 105        struct stmmac_resources stmmac_res;
 106
 107        ret = stmmac_get_platform_resources(pdev, &stmmac_res);
 108        if (ret)
 109                return ret;
 110
 111        gmac = anarion_config_dt(pdev);
 112        if (IS_ERR(gmac))
 113                return PTR_ERR(gmac);
 114
 115        plat_dat = stmmac_probe_config_dt(pdev, &stmmac_res.mac);
 116        if (IS_ERR(plat_dat))
 117                return PTR_ERR(plat_dat);
 118
 119        plat_dat->init = anarion_gmac_init;
 120        plat_dat->exit = anarion_gmac_exit;
 121        anarion_gmac_init(pdev, gmac);
 122        plat_dat->bsp_priv = gmac;
 123
 124        ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
 125        if (ret) {
 126                stmmac_remove_config_dt(pdev, plat_dat);
 127                return ret;
 128        }
 129
 130        return 0;
 131}
 132
 133static const struct of_device_id anarion_dwmac_match[] = {
 134        { .compatible = "adaptrum,anarion-gmac" },
 135        { }
 136};
 137MODULE_DEVICE_TABLE(of, anarion_dwmac_match);
 138
 139static struct platform_driver anarion_dwmac_driver = {
 140        .probe  = anarion_dwmac_probe,
 141        .remove = stmmac_pltfr_remove,
 142        .driver = {
 143                .name           = "anarion-dwmac",
 144                .pm             = &stmmac_pltfr_pm_ops,
 145                .of_match_table = anarion_dwmac_match,
 146        },
 147};
 148module_platform_driver(anarion_dwmac_driver);
 149
 150MODULE_DESCRIPTION("Adaptrum Anarion DWMAC specific glue layer");
 151MODULE_AUTHOR("Alexandru Gagniuc <mr.nuke.me@gmail.com>");
 152MODULE_LICENSE("GPL v2");
 153