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
27static 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
63static 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 */
77static 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
152err_rx_irq_unmap:
153	while (i--)
154		irq_dispose_mapping(priv->rxq[i]->irq_no);
155	i = SXGBE_TX_QUEUES;
156err_tx_irq_unmap:
157	while (i--)
158		irq_dispose_mapping(priv->txq[i]->irq_no);
159	irq_dispose_mapping(priv->irq);
160err_drv_remove:
161	sxgbe_drv_remove(ndev);
162err_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 */
172static 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
180static 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
187static 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
194static 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
201static 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
208static 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
216static const struct dev_pm_ops sxgbe_platform_pm_ops;
217#endif /* CONFIG_PM */
218
219static const struct of_device_id sxgbe_dt_ids[] = {
220	{ .compatible = "samsung,sxgbe-v2.0a"},
221	{ /* sentinel */ }
222};
223MODULE_DEVICE_TABLE(of, sxgbe_dt_ids);
224
225static 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
235int 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
246void sxgbe_unregister_platform(void)
247{
248	platform_driver_unregister(&sxgbe_platform_driver);
249}
250