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 30static 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 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 63static int sxgbe_probe_config_dt(struct platform_device *pdev, 64 struct sxgbe_plat_data *plat, 65 const char **mac) 66{ 67 return -ENOSYS; 68} 69#endif /* CONFIG_OF */ 70 71/** 72 * sxgbe_platform_probe 73 * @pdev: platform device pointer 74 * Description: platform_device probe function. It allocates 75 * the necessary resources and invokes the main to init 76 * the net device, register the mdio bus etc. 77 */ 78static int sxgbe_platform_probe(struct platform_device *pdev) 79{ 80 int ret; 81 int i, chan; 82 struct resource *res; 83 struct device *dev = &pdev->dev; 84 void __iomem *addr; 85 struct sxgbe_priv_data *priv = NULL; 86 struct sxgbe_plat_data *plat_dat = NULL; 87 const char *mac = NULL; 88 struct net_device *ndev = platform_get_drvdata(pdev); 89 struct device_node *node = dev->of_node; 90 91 /* Get memory resource */ 92 res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 93 addr = devm_ioremap_resource(dev, res); 94 if (IS_ERR(addr)) 95 return PTR_ERR(addr); 96 97 if (pdev->dev.of_node) { 98 plat_dat = devm_kzalloc(&pdev->dev, 99 sizeof(struct sxgbe_plat_data), 100 GFP_KERNEL); 101 if (!plat_dat) 102 return -ENOMEM; 103 104 ret = sxgbe_probe_config_dt(pdev, plat_dat, &mac); 105 if (ret) { 106 pr_err("%s: main dt probe failed\n", __func__); 107 return ret; 108 } 109 } 110 111 priv = sxgbe_drv_probe(&(pdev->dev), plat_dat, addr); 112 if (!priv) { 113 pr_err("%s: main driver probe failed\n", __func__); 114 goto err_out; 115 } 116 117 /* Get the SXGBE common INT information */ 118 priv->irq = irq_of_parse_and_map(node, 0); 119 if (priv->irq <= 0) { 120 dev_err(dev, "sxgbe common irq parsing failed\n"); 121 goto err_drv_remove; 122 } 123 124 /* Get MAC address if available (DT) */ 125 if (mac) 126 ether_addr_copy(priv->dev->dev_addr, mac); 127 128 /* Get the TX/RX IRQ numbers */ 129 for (i = 0, chan = 1; i < SXGBE_TX_QUEUES; i++) { 130 priv->txq[i]->irq_no = irq_of_parse_and_map(node, chan++); 131 if (priv->txq[i]->irq_no <= 0) { 132 dev_err(dev, "sxgbe tx irq parsing failed\n"); 133 goto err_tx_irq_unmap; 134 } 135 } 136 137 for (i = 0; i < SXGBE_RX_QUEUES; i++) { 138 priv->rxq[i]->irq_no = irq_of_parse_and_map(node, chan++); 139 if (priv->rxq[i]->irq_no <= 0) { 140 dev_err(dev, "sxgbe rx irq parsing failed\n"); 141 goto err_rx_irq_unmap; 142 } 143 } 144 145 priv->lpi_irq = irq_of_parse_and_map(node, chan); 146 if (priv->lpi_irq <= 0) { 147 dev_err(dev, "sxgbe lpi irq parsing failed\n"); 148 goto err_rx_irq_unmap; 149 } 150 151 platform_set_drvdata(pdev, priv->dev); 152 153 pr_debug("platform driver registration completed\n"); 154 155 return 0; 156 157err_rx_irq_unmap: 158 while (--i) 159 irq_dispose_mapping(priv->rxq[i]->irq_no); 160 i = SXGBE_TX_QUEUES; 161err_tx_irq_unmap: 162 while (--i) 163 irq_dispose_mapping(priv->txq[i]->irq_no); 164 irq_dispose_mapping(priv->irq); 165err_drv_remove: 166 sxgbe_drv_remove(ndev); 167err_out: 168 return -ENODEV; 169} 170 171/** 172 * sxgbe_platform_remove 173 * @pdev: platform device pointer 174 * Description: this function calls the main to free the net resources 175 * and calls the platforms hook and release the resources (e.g. mem). 176 */ 177static int sxgbe_platform_remove(struct platform_device *pdev) 178{ 179 struct net_device *ndev = platform_get_drvdata(pdev); 180 int ret = sxgbe_drv_remove(ndev); 181 182 return ret; 183} 184 185#ifdef CONFIG_PM 186static int sxgbe_platform_suspend(struct device *dev) 187{ 188 struct net_device *ndev = dev_get_drvdata(dev); 189 190 return sxgbe_suspend(ndev); 191} 192 193static int sxgbe_platform_resume(struct device *dev) 194{ 195 struct net_device *ndev = dev_get_drvdata(dev); 196 197 return sxgbe_resume(ndev); 198} 199 200static int sxgbe_platform_freeze(struct device *dev) 201{ 202 struct net_device *ndev = dev_get_drvdata(dev); 203 204 return sxgbe_freeze(ndev); 205} 206 207static int sxgbe_platform_restore(struct device *dev) 208{ 209 struct net_device *ndev = dev_get_drvdata(dev); 210 211 return sxgbe_restore(ndev); 212} 213 214static const struct dev_pm_ops sxgbe_platform_pm_ops = { 215 .suspend = sxgbe_platform_suspend, 216 .resume = sxgbe_platform_resume, 217 .freeze = sxgbe_platform_freeze, 218 .thaw = sxgbe_platform_restore, 219 .restore = sxgbe_platform_restore, 220}; 221#else 222static const struct dev_pm_ops sxgbe_platform_pm_ops; 223#endif /* CONFIG_PM */ 224 225static const struct of_device_id sxgbe_dt_ids[] = { 226 { .compatible = "samsung,sxgbe-v2.0a"}, 227 { /* sentinel */ } 228}; 229MODULE_DEVICE_TABLE(of, sxgbe_dt_ids); 230 231static struct platform_driver sxgbe_platform_driver = { 232 .probe = sxgbe_platform_probe, 233 .remove = sxgbe_platform_remove, 234 .driver = { 235 .name = SXGBE_RESOURCE_NAME, 236 .pm = &sxgbe_platform_pm_ops, 237 .of_match_table = of_match_ptr(sxgbe_dt_ids), 238 }, 239}; 240 241int sxgbe_register_platform(void) 242{ 243 int err; 244 245 err = platform_driver_register(&sxgbe_platform_driver); 246 if (err) 247 pr_err("failed to register the platform driver\n"); 248 249 return err; 250} 251 252void sxgbe_unregister_platform(void) 253{ 254 platform_driver_unregister(&sxgbe_platform_driver); 255} 256