drivers/net/ethernet/samsung/sxgbe/sxgbe_platform.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /* 10G controller driver for Samsung SoCs
   3  *
   4  * Copyright (C) 2013 Samsung Electronics Co., Ltd.
   5  *              http://www.samsung.com
   6  *
   7  * Author: Siva Reddy Kallam <siva.kallam@samsung.com>
   8  */
   9
  10 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  11
  12 #include <linux/etherdevice.h>
  13 #include <linux/io.h>
  14 #include <linux/module.h>
  15 #include <linux/netdevice.h>
  16 #include <linux/of.h>
  17 #include <linux/of_irq.h>
  18 #include <linux/of_net.h>
  19 #include <linux/phy.h>
  20 #include <linux/platform_device.h>
  21 #include <linux/sxgbe_platform.h>
  22
  23 #include "sxgbe_common.h"
  24 #include "sxgbe_reg.h"
  25
  26 #ifdef CONFIG_OF
  27 static int sxgbe_probe_config_dt(struct platform_device *pdev,
  28                                  struct sxgbe_plat_data *plat)
  29 {
  30         struct device_node *np = pdev->dev.of_node;
  31         struct sxgbe_dma_cfg *dma_cfg;
  32         int err;
  33
  34         if (!np)
  35                 return -ENODEV;
  36
  37         err = of_get_phy_mode(np, &plat->interface);
  38         if (err && err != -ENODEV)
  39                 return err;
  40
  41         plat->bus_id = of_alias_get_id(np, "ethernet");
  42         if (plat->bus_id < 0)
  43                 plat->bus_id = 0;
  44
  45         plat->mdio_bus_data = devm_kzalloc(&pdev->dev,
  46                                            sizeof(*plat->mdio_bus_data),
  47                                            GFP_KERNEL);
  48         if (!plat->mdio_bus_data)
  49                 return -ENOMEM;
  50
  51         dma_cfg = devm_kzalloc(&pdev->dev, sizeof(*dma_cfg), GFP_KERNEL);
  52         if (!dma_cfg)
  53                 return -ENOMEM;
  54
  55         plat->dma_cfg = dma_cfg;
  56         of_property_read_u32(np, "samsung,pbl", &dma_cfg->pbl);
  57         if (of_property_read_u32(np, "samsung,burst-map", &dma_cfg->burst_map) == 0)
  58                 dma_cfg->fixed_burst = true;
  59
  60         return 0;
  61 }
  62 #else
  63 static int sxgbe_probe_config_dt(struct platform_device *pdev,
  64                                  struct sxgbe_plat_data *plat)
  65 {
  66         return -ENOSYS;
  67 }
  68 #endif /* CONFIG_OF */
  69
  70 /**
  71  * sxgbe_platform_probe
  72  * @pdev: platform device pointer
  73  * Description: platform_device probe function. It allocates
  74  * the necessary resources and invokes the main to init
  75  * the net device, register the mdio bus etc.
  76  */
  77 static int sxgbe_platform_probe(struct platform_device *pdev)
  78 {
  79         int ret;
  80         int i, chan;
  81         struct device *dev = &pdev->dev;
  82         void __iomem *addr;
  83         struct sxgbe_priv_data *priv = NULL;
  84         struct sxgbe_plat_data *plat_dat = NULL;
  85         struct net_device *ndev = platform_get_drvdata(pdev);
  86         struct device_node *node = dev->of_node;
  87
  88         /* Get memory resource */
  89         addr = devm_platform_ioremap_resource(pdev, 0);
  90         if (IS_ERR(addr))
  91                 return PTR_ERR(addr);
  92
  93         if (pdev->dev.of_node) {
  94                 plat_dat = devm_kzalloc(&pdev->dev,
  95                                         sizeof(struct sxgbe_plat_data),
  96                                         GFP_KERNEL);
  97                 if (!plat_dat)
  98                         return  -ENOMEM;
  99
 100                 ret = sxgbe_probe_config_dt(pdev, plat_dat);
 101                 if (ret) {
 102                         pr_err("%s: main dt probe failed\n", __func__);
 103                         return ret;
 104                 }
 105         }
 106
 107         priv = sxgbe_drv_probe(&(pdev->dev), plat_dat, addr);
 108         if (!priv) {
 109                 pr_err("%s: main driver probe failed\n", __func__);
 110                 goto err_out;
 111         }
 112
 113         /* Get the SXGBE common INT information */
 114         priv->irq  = irq_of_parse_and_map(node, 0);
 115         if (priv->irq <= 0) {
 116                 dev_err(dev, "sxgbe common irq parsing failed\n");
 117                 goto err_drv_remove;
 118         }
 119
 120         /* Get MAC address if available (DT) */
 121         of_get_ethdev_address(node, priv->dev);
 122
 123         /* Get the TX/RX IRQ numbers */
 124         for (i = 0, chan = 1; i < SXGBE_TX_QUEUES; i++) {
 125                 priv->txq[i]->irq_no = irq_of_parse_and_map(node, chan++);
 126                 if (priv->txq[i]->irq_no <= 0) {
 127                         dev_err(dev, "sxgbe tx irq parsing failed\n");
 128                         goto err_tx_irq_unmap;
 129                 }
 130         }
 131
 132         for (i = 0; i < SXGBE_RX_QUEUES; i++) {
 133                 priv->rxq[i]->irq_no = irq_of_parse_and_map(node, chan++);
 134                 if (priv->rxq[i]->irq_no <= 0) {
 135                         dev_err(dev, "sxgbe rx irq parsing failed\n");
 136                         goto err_rx_irq_unmap;
 137                 }
 138         }
 139
 140         priv->lpi_irq = irq_of_parse_and_map(node, chan);
 141         if (priv->lpi_irq <= 0) {
 142                 dev_err(dev, "sxgbe lpi irq parsing failed\n");
 143                 goto err_rx_irq_unmap;
 144         }
 145
 146         platform_set_drvdata(pdev, priv->dev);
 147
 148         pr_debug("platform driver registration completed\n");
 149
 150         return 0;
 151
 152 err_rx_irq_unmap:
 153         while (i--)
 154                 irq_dispose_mapping(priv->rxq[i]->irq_no);
 155         i = SXGBE_TX_QUEUES;
 156 err_tx_irq_unmap:
 157         while (i--)
 158                 irq_dispose_mapping(priv->txq[i]->irq_no);
 159         irq_dispose_mapping(priv->irq);
 160 err_drv_remove:
 161         sxgbe_drv_remove(ndev);
 162 err_out:
 163         return -ENODEV;
 164 }
 165
 166 /**
 167  * sxgbe_platform_remove
 168  * @pdev: platform device pointer
 169  * Description: this function calls the main to free the net resources
 170  * and calls the platforms hook and release the resources (e.g. mem).
 171  */
 172 static void sxgbe_platform_remove(struct platform_device *pdev)
 173 {
 174         struct net_device *ndev = platform_get_drvdata(pdev);
 175
 176         sxgbe_drv_remove(ndev);
 177 }
 178
 179 #ifdef CONFIG_PM
 180 static int sxgbe_platform_suspend(struct device *dev)
 181 {
 182         struct net_device *ndev = dev_get_drvdata(dev);
 183
 184         return sxgbe_suspend(ndev);
 185 }
 186
 187 static int sxgbe_platform_resume(struct device *dev)
 188 {
 189         struct net_device *ndev = dev_get_drvdata(dev);
 190
 191         return sxgbe_resume(ndev);
 192 }
 193
 194 static int sxgbe_platform_freeze(struct device *dev)
 195 {
 196         struct net_device *ndev = dev_get_drvdata(dev);
 197
 198         return sxgbe_freeze(ndev);
 199 }
 200
 201 static int sxgbe_platform_restore(struct device *dev)
 202 {
 203         struct net_device *ndev = dev_get_drvdata(dev);
 204
 205         return sxgbe_restore(ndev);
 206 }
 207
 208 static const struct dev_pm_ops sxgbe_platform_pm_ops = {
 209         .suspend        = sxgbe_platform_suspend,
 210         .resume         = sxgbe_platform_resume,
 211         .freeze         = sxgbe_platform_freeze,
 212         .thaw           = sxgbe_platform_restore,
 213         .restore        = sxgbe_platform_restore,
 214 };
 215 #else
 216 static const struct dev_pm_ops sxgbe_platform_pm_ops;
 217 #endif /* CONFIG_PM */
 218
 219 static const struct of_device_id sxgbe_dt_ids[] = {
 220         { .compatible = "samsung,sxgbe-v2.0a"},
 221         { /* sentinel */ }
 222 };
 223 MODULE_DEVICE_TABLE(of, sxgbe_dt_ids);
 224
 225 static struct platform_driver sxgbe_platform_driver = {
 226         .probe  = sxgbe_platform_probe,
 227         .remove_new = sxgbe_platform_remove,
 228         .driver = {
 229                 .name           = SXGBE_RESOURCE_NAME,
 230                 .pm             = &sxgbe_platform_pm_ops,
 231                 .of_match_table = sxgbe_dt_ids,
 232         },
 233 };
 234
 235 int sxgbe_register_platform(void)
 236 {
 237         int err;
 238
 239         err = platform_driver_register(&sxgbe_platform_driver);
 240         if (err)
 241                 pr_err("failed to register the platform driver\n");
 242
 243         return err;
 244 }
 245
 246 void sxgbe_unregister_platform(void)
 247 {
 248         platform_driver_unregister(&sxgbe_platform_driver);
 249 }