1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * DOC: Cadence GEM PCI wrapper.
4 *
5 * Copyright (C) 2016 Cadence Design Systems - https://www.cadence.com
6 *
7 * Authors: Rafal Ozieblo <rafalo@cadence.com>
8 * Bartosz Folta <bfolta@cadence.com>
9 */
10
11 #include <linux/clk.h>
12 #include <linux/clk-provider.h>
13 #include <linux/etherdevice.h>
14 #include <linux/module.h>
15 #include <linux/pci.h>
16 #include <linux/platform_device.h>
17 #include "macb.h"
18
19 #define PCI_DRIVER_NAME "macb_pci"
20 #define PLAT_DRIVER_NAME "macb"
21
22 #define PCI_DEVICE_ID_CDNS_MACB 0xe007
23
24 #define GEM_PCLK_RATE 50000000
25 #define GEM_HCLK_RATE 50000000
26
macb_probe(struct pci_dev * pci,const struct pci_device_id * id)27 static int macb_probe(struct pci_dev *pci, const struct pci_device_id *id)
28 {
29 int err;
30 struct platform_device *pdev;
31 struct platform_device_info plat_info;
32 struct macb_platform_data plat_data;
33 struct resource res[2];
34
35 /* enable pci device */
36 err = pcim_enable_device(pci);
37 if (err < 0) {
38 dev_err(&pci->dev, "Enabling PCI device has failed: %d", err);
39 return err;
40 }
41
42 pci_set_master(pci);
43
44 /* set up resources */
45 memset(res, 0x00, sizeof(struct resource) * ARRAY_SIZE(res));
46 res[0].start = pci_resource_start(pci, 0);
47 res[0].end = pci_resource_end(pci, 0);
48 res[0].name = PCI_DRIVER_NAME;
49 res[0].flags = IORESOURCE_MEM;
50 res[1].start = pci_irq_vector(pci, 0);
51 res[1].name = PCI_DRIVER_NAME;
52 res[1].flags = IORESOURCE_IRQ;
53
54 dev_info(&pci->dev, "EMAC physical base addr: %pa\n",
55 &res[0].start);
56
57 /* set up macb platform data */
58 memset(&plat_data, 0, sizeof(plat_data));
59
60 /* initialize clocks */
61 plat_data.pclk = clk_register_fixed_rate(&pci->dev, "pclk", NULL, 0,
62 GEM_PCLK_RATE);
63 if (IS_ERR(plat_data.pclk)) {
64 err = PTR_ERR(plat_data.pclk);
65 goto err_pclk_register;
66 }
67
68 plat_data.hclk = clk_register_fixed_rate(&pci->dev, "hclk", NULL, 0,
69 GEM_HCLK_RATE);
70 if (IS_ERR(plat_data.hclk)) {
71 err = PTR_ERR(plat_data.hclk);
72 goto err_hclk_register;
73 }
74
75 /* set up platform device info */
76 memset(&plat_info, 0, sizeof(plat_info));
77 plat_info.parent = &pci->dev;
78 plat_info.fwnode = pci->dev.fwnode;
79 plat_info.name = PLAT_DRIVER_NAME;
80 plat_info.id = pci->devfn;
81 plat_info.res = res;
82 plat_info.num_res = ARRAY_SIZE(res);
83 plat_info.data = &plat_data;
84 plat_info.size_data = sizeof(plat_data);
85 plat_info.dma_mask = pci->dma_mask;
86
87 /* register platform device */
88 pdev = platform_device_register_full(&plat_info);
89 if (IS_ERR(pdev)) {
90 err = PTR_ERR(pdev);
91 goto err_plat_dev_register;
92 }
93
94 pci_set_drvdata(pci, pdev);
95
96 return 0;
97
98 err_plat_dev_register:
99 clk_unregister_fixed_rate(plat_data.hclk);
100
101 err_hclk_register:
102 clk_unregister_fixed_rate(plat_data.pclk);
103
104 err_pclk_register:
105 return err;
106 }
107
macb_remove(struct pci_dev * pci)108 static void macb_remove(struct pci_dev *pci)
109 {
110 struct platform_device *pdev = pci_get_drvdata(pci);
111 struct macb_platform_data *plat_data = dev_get_platdata(&pdev->dev);
112 struct clk *pclk = plat_data->pclk;
113 struct clk *hclk = plat_data->hclk;
114
115 platform_device_unregister(pdev);
116 clk_unregister_fixed_rate(pclk);
117 clk_unregister_fixed_rate(hclk);
118 }
119
120 static const struct pci_device_id dev_id_table[] = {
121 { PCI_VDEVICE(CDNS, PCI_DEVICE_ID_CDNS_MACB) },
122 { 0, }
123 };
124
125 static struct pci_driver macb_pci_driver = {
126 .name = PCI_DRIVER_NAME,
127 .id_table = dev_id_table,
128 .probe = macb_probe,
129 .remove = macb_remove,
130 };
131
132 module_pci_driver(macb_pci_driver);
133 MODULE_DEVICE_TABLE(pci, dev_id_table);
134 MODULE_LICENSE("GPL");
135 MODULE_DESCRIPTION("Cadence NIC PCI wrapper");
136