1
2
3
4
5
6
7
8
9
10
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 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
65static 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
72
73
74
75
76
77
78
79
80static 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
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
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
127 if (mac)
128 ether_addr_copy(priv->dev->dev_addr, mac);
129
130
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
159err_rx_irq_unmap:
160 while (i--)
161 irq_dispose_mapping(priv->rxq[i]->irq_no);
162 i = SXGBE_TX_QUEUES;
163err_tx_irq_unmap:
164 while (i--)
165 irq_dispose_mapping(priv->txq[i]->irq_no);
166 irq_dispose_mapping(priv->irq);
167err_drv_remove:
168 sxgbe_drv_remove(ndev);
169err_out:
170 return -ENODEV;
171}
172
173
174
175
176
177
178
179static 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
188static 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
195static 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
202static 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
209static 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
216static 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
224static const struct dev_pm_ops sxgbe_platform_pm_ops;
225#endif
226
227static const struct of_device_id sxgbe_dt_ids[] = {
228 { .compatible = "samsung,sxgbe-v2.0a"},
229 { }
230};
231MODULE_DEVICE_TABLE(of, sxgbe_dt_ids);
232
233static 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
243int 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
254void sxgbe_unregister_platform(void)
255{
256 platform_driver_unregister(&sxgbe_platform_driver);
257}
258