1 // SPDX-License-Identifier: GPL-2.0
2 // Copyright (C) 2022 Microchip Technology Inc.
3 
4 #include <linux/mfd/core.h>
5 #include <linux/module.h>
6 #include <linux/pci.h>
7 #include <linux/spinlock.h>
8 #include <linux/gpio/driver.h>
9 #include <linux/interrupt.h>
10 #include <linux/io.h>
11 #include <linux/idr.h>
12 #include "mchp_pci1xxxx_gp.h"
13 
14 struct aux_bus_device {
15 	struct auxiliary_device_wrapper *aux_device_wrapper[2];
16 };
17 
18 static DEFINE_IDA(gp_client_ida);
19 static const char aux_dev_otp_e2p_name[15] = "gp_otp_e2p";
20 static const char aux_dev_gpio_name[15] = "gp_gpio";
21 
gp_auxiliary_device_release(struct device * dev)22 static void gp_auxiliary_device_release(struct device *dev)
23 {
24 	struct auxiliary_device_wrapper *aux_device_wrapper =
25 		(struct auxiliary_device_wrapper *)container_of(dev,
26 				struct auxiliary_device_wrapper, aux_dev.dev);
27 
28 	ida_free(&gp_client_ida, aux_device_wrapper->aux_dev.id);
29 	kfree(aux_device_wrapper);
30 }
31 
gp_aux_bus_probe(struct pci_dev * pdev,const struct pci_device_id * id)32 static int gp_aux_bus_probe(struct pci_dev *pdev, const struct pci_device_id *id)
33 {
34 	struct aux_bus_device *aux_bus;
35 	int retval;
36 
37 	retval = pcim_enable_device(pdev);
38 	if (retval)
39 		return retval;
40 
41 	aux_bus = devm_kzalloc(&pdev->dev, sizeof(*aux_bus), GFP_KERNEL);
42 	if (!aux_bus)
43 		return -ENOMEM;
44 
45 	aux_bus->aux_device_wrapper[0] = kzalloc(sizeof(*aux_bus->aux_device_wrapper[0]),
46 						 GFP_KERNEL);
47 	if (!aux_bus->aux_device_wrapper[0])
48 		return -ENOMEM;
49 
50 	retval = ida_alloc(&gp_client_ida, GFP_KERNEL);
51 	if (retval < 0)
52 		goto err_ida_alloc_0;
53 
54 	aux_bus->aux_device_wrapper[0]->aux_dev.name = aux_dev_otp_e2p_name;
55 	aux_bus->aux_device_wrapper[0]->aux_dev.dev.parent = &pdev->dev;
56 	aux_bus->aux_device_wrapper[0]->aux_dev.dev.release = gp_auxiliary_device_release;
57 	aux_bus->aux_device_wrapper[0]->aux_dev.id = retval;
58 
59 	aux_bus->aux_device_wrapper[0]->gp_aux_data.region_start = pci_resource_start(pdev, 0);
60 	aux_bus->aux_device_wrapper[0]->gp_aux_data.region_length = pci_resource_end(pdev, 0);
61 
62 	retval = auxiliary_device_init(&aux_bus->aux_device_wrapper[0]->aux_dev);
63 	if (retval < 0)
64 		goto err_aux_dev_init_0;
65 
66 	retval = auxiliary_device_add(&aux_bus->aux_device_wrapper[0]->aux_dev);
67 	if (retval)
68 		goto err_aux_dev_add_0;
69 
70 	aux_bus->aux_device_wrapper[1] = kzalloc(sizeof(*aux_bus->aux_device_wrapper[1]),
71 						 GFP_KERNEL);
72 	if (!aux_bus->aux_device_wrapper[1])
73 		return -ENOMEM;
74 
75 	retval = ida_alloc(&gp_client_ida, GFP_KERNEL);
76 	if (retval < 0)
77 		goto err_ida_alloc_1;
78 
79 	aux_bus->aux_device_wrapper[1]->aux_dev.name = aux_dev_gpio_name;
80 	aux_bus->aux_device_wrapper[1]->aux_dev.dev.parent = &pdev->dev;
81 	aux_bus->aux_device_wrapper[1]->aux_dev.dev.release = gp_auxiliary_device_release;
82 	aux_bus->aux_device_wrapper[1]->aux_dev.id = retval;
83 
84 	aux_bus->aux_device_wrapper[1]->gp_aux_data.region_start = pci_resource_start(pdev, 0);
85 	aux_bus->aux_device_wrapper[1]->gp_aux_data.region_length = pci_resource_end(pdev, 0);
86 
87 	retval = pci_alloc_irq_vectors(pdev, 1, 1, PCI_IRQ_ALL_TYPES);
88 
89 	if (retval < 0)
90 		goto err_aux_dev_init_1;
91 
92 	retval = pci_irq_vector(pdev, 0);
93 	if (retval < 0)
94 		goto err_aux_dev_init_1;
95 
96 	pdev->irq = retval;
97 	aux_bus->aux_device_wrapper[1]->gp_aux_data.irq_num = pdev->irq;
98 
99 	retval = auxiliary_device_init(&aux_bus->aux_device_wrapper[1]->aux_dev);
100 	if (retval < 0)
101 		goto err_aux_dev_init_1;
102 
103 	retval = auxiliary_device_add(&aux_bus->aux_device_wrapper[1]->aux_dev);
104 	if (retval)
105 		goto err_aux_dev_add_1;
106 
107 	pci_set_drvdata(pdev, aux_bus);
108 	pci_set_master(pdev);
109 
110 	return 0;
111 
112 err_aux_dev_add_1:
113 	auxiliary_device_uninit(&aux_bus->aux_device_wrapper[1]->aux_dev);
114 
115 err_aux_dev_init_1:
116 	ida_free(&gp_client_ida, aux_bus->aux_device_wrapper[1]->aux_dev.id);
117 
118 err_ida_alloc_1:
119 	kfree(aux_bus->aux_device_wrapper[1]);
120 
121 err_aux_dev_add_0:
122 	auxiliary_device_uninit(&aux_bus->aux_device_wrapper[0]->aux_dev);
123 
124 err_aux_dev_init_0:
125 	ida_free(&gp_client_ida, aux_bus->aux_device_wrapper[0]->aux_dev.id);
126 
127 err_ida_alloc_0:
128 	kfree(aux_bus->aux_device_wrapper[0]);
129 
130 	return retval;
131 }
132 
gp_aux_bus_remove(struct pci_dev * pdev)133 static void gp_aux_bus_remove(struct pci_dev *pdev)
134 {
135 	struct aux_bus_device *aux_bus = pci_get_drvdata(pdev);
136 
137 	auxiliary_device_delete(&aux_bus->aux_device_wrapper[0]->aux_dev);
138 	auxiliary_device_uninit(&aux_bus->aux_device_wrapper[0]->aux_dev);
139 	auxiliary_device_delete(&aux_bus->aux_device_wrapper[1]->aux_dev);
140 	auxiliary_device_uninit(&aux_bus->aux_device_wrapper[1]->aux_dev);
141 }
142 
143 static const struct pci_device_id pci1xxxx_tbl[] = {
144 	{ PCI_DEVICE(0x1055, 0xA005) },
145 	{ PCI_DEVICE(0x1055, 0xA015) },
146 	{ PCI_DEVICE(0x1055, 0xA025) },
147 	{ PCI_DEVICE(0x1055, 0xA035) },
148 	{ PCI_DEVICE(0x1055, 0xA045) },
149 	{ PCI_DEVICE(0x1055, 0xA055) },
150 	{0,}
151 };
152 MODULE_DEVICE_TABLE(pci, pci1xxxx_tbl);
153 
154 static struct pci_driver pci1xxxx_gp_driver = {
155 	.name = "PCI1xxxxGP",
156 	.id_table = pci1xxxx_tbl,
157 	.probe = gp_aux_bus_probe,
158 	.remove = gp_aux_bus_remove,
159 };
160 
161 module_pci_driver(pci1xxxx_gp_driver);
162 
163 MODULE_DESCRIPTION("Microchip Technology Inc. PCI1xxxx GP expander");
164 MODULE_AUTHOR("Kumaravel Thiagarajan <kumaravel.thiagarajan@microchip.com>");
165 MODULE_LICENSE("GPL");
166