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

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