xref: /linux/drivers/mfd/ioc3.c (revision 762f99f4f3cb41a775b5157dd761217beba65873)
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * SGI IOC3 multifunction device driver
4  *
5  * Copyright (C) 2018, 2019 Thomas Bogendoerfer <tbogendoerfer@suse.de>
6  *
7  * Based on work by:
8  *   Stanislaw Skowronek <skylark@unaligned.org>
9  *   Joshua Kinard <kumba@gentoo.org>
10  *   Brent Casavant <bcasavan@sgi.com> - IOC4 master driver
11  *   Pat Gefre <pfg@sgi.com> - IOC3 serial port IRQ demuxer
12  */
13 
14 #include <linux/delay.h>
15 #include <linux/errno.h>
16 #include <linux/interrupt.h>
17 #include <linux/irqdomain.h>
18 #include <linux/mfd/core.h>
19 #include <linux/module.h>
20 #include <linux/pci.h>
21 #include <linux/platform_device.h>
22 #include <linux/platform_data/sgi-w1.h>
23 #include <linux/rtc/ds1685.h>
24 
25 #include <asm/pci/bridge.h>
26 #include <asm/sn/ioc3.h>
27 
28 #define IOC3_IRQ_SERIAL_A	6
29 #define IOC3_IRQ_SERIAL_B	15
30 #define IOC3_IRQ_KBD		22
31 
32 /* Bitmask for selecting which IRQs are level triggered */
33 #define IOC3_LVL_MASK	(BIT(IOC3_IRQ_SERIAL_A) | BIT(IOC3_IRQ_SERIAL_B))
34 
35 #define M48T35_REG_SIZE	32768	/* size of m48t35 registers */
36 
37 /* 1.2 us latency timer (40 cycles at 33 MHz) */
38 #define IOC3_LATENCY	40
39 
40 struct ioc3_priv_data {
41 	struct irq_domain *domain;
42 	struct ioc3 __iomem *regs;
43 	struct pci_dev *pdev;
44 	int domain_irq;
45 };
46 
ioc3_irq_ack(struct irq_data * d)47 static void ioc3_irq_ack(struct irq_data *d)
48 {
49 	struct ioc3_priv_data *ipd = irq_data_get_irq_chip_data(d);
50 	unsigned int hwirq = irqd_to_hwirq(d);
51 
52 	writel(BIT(hwirq), &ipd->regs->sio_ir);
53 }
54 
ioc3_irq_mask(struct irq_data * d)55 static void ioc3_irq_mask(struct irq_data *d)
56 {
57 	struct ioc3_priv_data *ipd = irq_data_get_irq_chip_data(d);
58 	unsigned int hwirq = irqd_to_hwirq(d);
59 
60 	writel(BIT(hwirq), &ipd->regs->sio_iec);
61 }
62 
ioc3_irq_unmask(struct irq_data * d)63 static void ioc3_irq_unmask(struct irq_data *d)
64 {
65 	struct ioc3_priv_data *ipd = irq_data_get_irq_chip_data(d);
66 	unsigned int hwirq = irqd_to_hwirq(d);
67 
68 	writel(BIT(hwirq), &ipd->regs->sio_ies);
69 }
70 
71 static struct irq_chip ioc3_irq_chip = {
72 	.name		= "IOC3",
73 	.irq_ack	= ioc3_irq_ack,
74 	.irq_mask	= ioc3_irq_mask,
75 	.irq_unmask	= ioc3_irq_unmask,
76 };
77 
ioc3_irq_domain_map(struct irq_domain * d,unsigned int irq,irq_hw_number_t hwirq)78 static int ioc3_irq_domain_map(struct irq_domain *d, unsigned int irq,
79 			      irq_hw_number_t hwirq)
80 {
81 	/* Set level IRQs for every interrupt contained in IOC3_LVL_MASK */
82 	if (BIT(hwirq) & IOC3_LVL_MASK)
83 		irq_set_chip_and_handler(irq, &ioc3_irq_chip, handle_level_irq);
84 	else
85 		irq_set_chip_and_handler(irq, &ioc3_irq_chip, handle_edge_irq);
86 
87 	irq_set_chip_data(irq, d->host_data);
88 	return 0;
89 }
90 
ioc3_irq_domain_unmap(struct irq_domain * d,unsigned int irq)91 static void ioc3_irq_domain_unmap(struct irq_domain *d, unsigned int irq)
92 {
93 	irq_set_chip_and_handler(irq, NULL, NULL);
94 	irq_set_chip_data(irq, NULL);
95 }
96 
97 static const struct irq_domain_ops ioc3_irq_domain_ops = {
98 	.map = ioc3_irq_domain_map,
99 	.unmap = ioc3_irq_domain_unmap,
100 };
101 
ioc3_irq_handler(struct irq_desc * desc)102 static void ioc3_irq_handler(struct irq_desc *desc)
103 {
104 	struct irq_domain *domain = irq_desc_get_handler_data(desc);
105 	struct ioc3_priv_data *ipd = domain->host_data;
106 	struct ioc3 __iomem *regs = ipd->regs;
107 	u32 pending, mask;
108 
109 	pending = readl(&regs->sio_ir);
110 	mask = readl(&regs->sio_ies);
111 	pending &= mask; /* Mask off not enabled interrupts */
112 
113 	if (pending)
114 		generic_handle_domain_irq(domain, __ffs(pending));
115 	else
116 		spurious_interrupt();
117 }
118 
119 /*
120  * System boards/BaseIOs use more interrupt pins of the bridge ASIC
121  * to which the IOC3 is connected. Since the IOC3 MFD driver
122  * knows wiring of these extra pins, we use the map_irq function
123  * to get interrupts activated
124  */
ioc3_map_irq(struct pci_dev * pdev,int slot,int pin)125 static int ioc3_map_irq(struct pci_dev *pdev, int slot, int pin)
126 {
127 	struct pci_host_bridge *hbrg = pci_find_host_bridge(pdev->bus);
128 
129 	return hbrg->map_irq(pdev, slot, pin);
130 }
131 
ioc3_irq_domain_setup(struct ioc3_priv_data * ipd,int irq)132 static int ioc3_irq_domain_setup(struct ioc3_priv_data *ipd, int irq)
133 {
134 	struct irq_domain *domain;
135 	struct fwnode_handle *fn;
136 
137 	fn = irq_domain_alloc_named_fwnode("IOC3");
138 	if (!fn)
139 		goto err;
140 
141 	domain = irq_domain_create_linear(fn, 24, &ioc3_irq_domain_ops, ipd);
142 	if (!domain) {
143 		irq_domain_free_fwnode(fn);
144 		goto err;
145 	}
146 
147 	ipd->domain = domain;
148 
149 	irq_set_chained_handler_and_data(irq, ioc3_irq_handler, domain);
150 	ipd->domain_irq = irq;
151 	return 0;
152 
153 err:
154 	dev_err(&ipd->pdev->dev, "irq domain setup failed\n");
155 	return -ENOMEM;
156 }
157 
158 static const struct resource ioc3_uarta_resources[] = {
159 	DEFINE_RES_MEM(offsetof(struct ioc3, sregs.uarta),
160 		       sizeof_field(struct ioc3, sregs.uarta)),
161 	DEFINE_RES_IRQ(IOC3_IRQ_SERIAL_A)
162 };
163 
164 static const struct resource ioc3_uartb_resources[] = {
165 	DEFINE_RES_MEM(offsetof(struct ioc3, sregs.uartb),
166 		       sizeof_field(struct ioc3, sregs.uartb)),
167 	DEFINE_RES_IRQ(IOC3_IRQ_SERIAL_B)
168 };
169 
170 static struct mfd_cell ioc3_serial_cells[] = {
171 	{
172 		.name = "ioc3-serial8250",
173 		.resources = ioc3_uarta_resources,
174 		.num_resources = ARRAY_SIZE(ioc3_uarta_resources),
175 	},
176 	{
177 		.name = "ioc3-serial8250",
178 		.resources = ioc3_uartb_resources,
179 		.num_resources = ARRAY_SIZE(ioc3_uartb_resources),
180 	}
181 };
182 
ioc3_serial_setup(struct ioc3_priv_data * ipd)183 static int ioc3_serial_setup(struct ioc3_priv_data *ipd)
184 {
185 	int ret;
186 
187 	/* Set gpio pins for RS232/RS422 mode selection */
188 	writel(GPCR_UARTA_MODESEL | GPCR_UARTB_MODESEL,
189 		&ipd->regs->gpcr_s);
190 	/* Select RS232 mode for uart a */
191 	writel(0, &ipd->regs->gppr[6]);
192 	/* Select RS232 mode for uart b */
193 	writel(0, &ipd->regs->gppr[7]);
194 
195 	/* Switch both ports to 16650 mode */
196 	writel(readl(&ipd->regs->port_a.sscr) & ~SSCR_DMA_EN,
197 	       &ipd->regs->port_a.sscr);
198 	writel(readl(&ipd->regs->port_b.sscr) & ~SSCR_DMA_EN,
199 	       &ipd->regs->port_b.sscr);
200 	udelay(1000); /* Wait until mode switch is done */
201 
202 	ret = mfd_add_devices(&ipd->pdev->dev, PLATFORM_DEVID_AUTO,
203 			      ioc3_serial_cells, ARRAY_SIZE(ioc3_serial_cells),
204 			      &ipd->pdev->resource[0], 0, ipd->domain);
205 	if (ret) {
206 		dev_err(&ipd->pdev->dev, "Failed to add 16550 subdevs\n");
207 		return ret;
208 	}
209 
210 	return 0;
211 }
212 
213 static const struct resource ioc3_kbd_resources[] = {
214 	DEFINE_RES_MEM(offsetof(struct ioc3, serio),
215 		       sizeof_field(struct ioc3, serio)),
216 	DEFINE_RES_IRQ(IOC3_IRQ_KBD)
217 };
218 
219 static struct mfd_cell ioc3_kbd_cells[] = {
220 	{
221 		.name = "ioc3-kbd",
222 		.resources = ioc3_kbd_resources,
223 		.num_resources = ARRAY_SIZE(ioc3_kbd_resources),
224 	}
225 };
226 
ioc3_kbd_setup(struct ioc3_priv_data * ipd)227 static int ioc3_kbd_setup(struct ioc3_priv_data *ipd)
228 {
229 	int ret;
230 
231 	ret = mfd_add_devices(&ipd->pdev->dev, PLATFORM_DEVID_AUTO,
232 			      ioc3_kbd_cells, ARRAY_SIZE(ioc3_kbd_cells),
233 			      &ipd->pdev->resource[0], 0, ipd->domain);
234 	if (ret) {
235 		dev_err(&ipd->pdev->dev, "Failed to add 16550 subdevs\n");
236 		return ret;
237 	}
238 
239 	return 0;
240 }
241 
242 static const struct resource ioc3_eth_resources[] = {
243 	DEFINE_RES_MEM(offsetof(struct ioc3, eth),
244 		       sizeof_field(struct ioc3, eth)),
245 	DEFINE_RES_MEM(offsetof(struct ioc3, ssram),
246 		       sizeof_field(struct ioc3, ssram)),
247 	DEFINE_RES_IRQ(0)
248 };
249 
250 static const struct resource ioc3_w1_resources[] = {
251 	DEFINE_RES_MEM(offsetof(struct ioc3, mcr),
252 		       sizeof_field(struct ioc3, mcr)),
253 };
254 static struct sgi_w1_platform_data ioc3_w1_platform_data;
255 
256 static struct mfd_cell ioc3_eth_cells[] = {
257 	{
258 		.name = "ioc3-eth",
259 		.resources = ioc3_eth_resources,
260 		.num_resources = ARRAY_SIZE(ioc3_eth_resources),
261 	},
262 	{
263 		.name = "sgi_w1",
264 		.resources = ioc3_w1_resources,
265 		.num_resources = ARRAY_SIZE(ioc3_w1_resources),
266 		.platform_data = &ioc3_w1_platform_data,
267 		.pdata_size = sizeof(ioc3_w1_platform_data),
268 	}
269 };
270 
ioc3_eth_setup(struct ioc3_priv_data * ipd)271 static int ioc3_eth_setup(struct ioc3_priv_data *ipd)
272 {
273 	int ret;
274 
275 	/* Enable One-Wire bus */
276 	writel(GPCR_MLAN_EN, &ipd->regs->gpcr_s);
277 
278 	/* Generate unique identifier */
279 	snprintf(ioc3_w1_platform_data.dev_id,
280 		 sizeof(ioc3_w1_platform_data.dev_id), "ioc3-%012llx",
281 		 ipd->pdev->resource->start);
282 
283 	ret = mfd_add_devices(&ipd->pdev->dev, PLATFORM_DEVID_AUTO,
284 			      ioc3_eth_cells, ARRAY_SIZE(ioc3_eth_cells),
285 			      &ipd->pdev->resource[0], ipd->pdev->irq, NULL);
286 	if (ret) {
287 		dev_err(&ipd->pdev->dev, "Failed to add ETH/W1 subdev\n");
288 		return ret;
289 	}
290 
291 	return 0;
292 }
293 
294 static const struct resource ioc3_m48t35_resources[] = {
295 	DEFINE_RES_MEM(IOC3_BYTEBUS_DEV0, M48T35_REG_SIZE)
296 };
297 
298 static struct mfd_cell ioc3_m48t35_cells[] = {
299 	{
300 		.name = "rtc-m48t35",
301 		.resources = ioc3_m48t35_resources,
302 		.num_resources = ARRAY_SIZE(ioc3_m48t35_resources),
303 	}
304 };
305 
ioc3_m48t35_setup(struct ioc3_priv_data * ipd)306 static int ioc3_m48t35_setup(struct ioc3_priv_data *ipd)
307 {
308 	int ret;
309 
310 	ret = mfd_add_devices(&ipd->pdev->dev, PLATFORM_DEVID_AUTO,
311 			      ioc3_m48t35_cells, ARRAY_SIZE(ioc3_m48t35_cells),
312 			      &ipd->pdev->resource[0], 0, ipd->domain);
313 	if (ret)
314 		dev_err(&ipd->pdev->dev, "Failed to add M48T35 subdev\n");
315 
316 	return ret;
317 }
318 
319 static struct ds1685_rtc_platform_data ip30_rtc_platform_data = {
320 	.bcd_mode = false,
321 	.no_irq = false,
322 	.uie_unsupported = true,
323 	.access_type = ds1685_reg_indirect,
324 };
325 
326 static const struct resource ioc3_rtc_ds1685_resources[] = {
327 	DEFINE_RES_MEM(IOC3_BYTEBUS_DEV1, 1),
328 	DEFINE_RES_MEM(IOC3_BYTEBUS_DEV2, 1),
329 	DEFINE_RES_IRQ(0)
330 };
331 
332 static struct mfd_cell ioc3_ds1685_cells[] = {
333 	{
334 		.name = "rtc-ds1685",
335 		.resources = ioc3_rtc_ds1685_resources,
336 		.num_resources = ARRAY_SIZE(ioc3_rtc_ds1685_resources),
337 		.platform_data = &ip30_rtc_platform_data,
338 		.pdata_size = sizeof(ip30_rtc_platform_data),
339 		.id = PLATFORM_DEVID_NONE,
340 	}
341 };
342 
ioc3_ds1685_setup(struct ioc3_priv_data * ipd)343 static int ioc3_ds1685_setup(struct ioc3_priv_data *ipd)
344 {
345 	int ret, irq;
346 
347 	irq = ioc3_map_irq(ipd->pdev, 6, 0);
348 
349 	ret = mfd_add_devices(&ipd->pdev->dev, 0, ioc3_ds1685_cells,
350 			      ARRAY_SIZE(ioc3_ds1685_cells),
351 			      &ipd->pdev->resource[0], irq, NULL);
352 	if (ret)
353 		dev_err(&ipd->pdev->dev, "Failed to add DS1685 subdev\n");
354 
355 	return ret;
356 };
357 
358 
359 static const struct resource ioc3_leds_resources[] = {
360 	DEFINE_RES_MEM(offsetof(struct ioc3, gppr[0]),
361 		       sizeof_field(struct ioc3, gppr[0])),
362 	DEFINE_RES_MEM(offsetof(struct ioc3, gppr[1]),
363 		       sizeof_field(struct ioc3, gppr[1])),
364 };
365 
366 static struct mfd_cell ioc3_led_cells[] = {
367 	{
368 		.name = "ip30-leds",
369 		.resources = ioc3_leds_resources,
370 		.num_resources = ARRAY_SIZE(ioc3_leds_resources),
371 		.id = PLATFORM_DEVID_NONE,
372 	}
373 };
374 
ioc3_led_setup(struct ioc3_priv_data * ipd)375 static int ioc3_led_setup(struct ioc3_priv_data *ipd)
376 {
377 	int ret;
378 
379 	ret = mfd_add_devices(&ipd->pdev->dev, 0, ioc3_led_cells,
380 			      ARRAY_SIZE(ioc3_led_cells),
381 			      &ipd->pdev->resource[0], 0, ipd->domain);
382 	if (ret)
383 		dev_err(&ipd->pdev->dev, "Failed to add LED subdev\n");
384 
385 	return ret;
386 }
387 
ip27_baseio_setup(struct ioc3_priv_data * ipd)388 static int ip27_baseio_setup(struct ioc3_priv_data *ipd)
389 {
390 	int ret, io_irq;
391 
392 	io_irq = ioc3_map_irq(ipd->pdev, PCI_SLOT(ipd->pdev->devfn),
393 			      PCI_INTERRUPT_INTB);
394 	ret = ioc3_irq_domain_setup(ipd, io_irq);
395 	if (ret)
396 		return ret;
397 
398 	ret = ioc3_eth_setup(ipd);
399 	if (ret)
400 		return ret;
401 
402 	ret = ioc3_serial_setup(ipd);
403 	if (ret)
404 		return ret;
405 
406 	return ioc3_m48t35_setup(ipd);
407 }
408 
ip27_baseio6g_setup(struct ioc3_priv_data * ipd)409 static int ip27_baseio6g_setup(struct ioc3_priv_data *ipd)
410 {
411 	int ret, io_irq;
412 
413 	io_irq = ioc3_map_irq(ipd->pdev, PCI_SLOT(ipd->pdev->devfn),
414 			      PCI_INTERRUPT_INTB);
415 	ret = ioc3_irq_domain_setup(ipd, io_irq);
416 	if (ret)
417 		return ret;
418 
419 	ret = ioc3_eth_setup(ipd);
420 	if (ret)
421 		return ret;
422 
423 	ret = ioc3_serial_setup(ipd);
424 	if (ret)
425 		return ret;
426 
427 	ret = ioc3_m48t35_setup(ipd);
428 	if (ret)
429 		return ret;
430 
431 	return ioc3_kbd_setup(ipd);
432 }
433 
ip27_mio_setup(struct ioc3_priv_data * ipd)434 static int ip27_mio_setup(struct ioc3_priv_data *ipd)
435 {
436 	int ret;
437 
438 	ret = ioc3_irq_domain_setup(ipd, ipd->pdev->irq);
439 	if (ret)
440 		return ret;
441 
442 	ret = ioc3_serial_setup(ipd);
443 	if (ret)
444 		return ret;
445 
446 	return ioc3_kbd_setup(ipd);
447 }
448 
ip30_sysboard_setup(struct ioc3_priv_data * ipd)449 static int ip30_sysboard_setup(struct ioc3_priv_data *ipd)
450 {
451 	int ret, io_irq;
452 
453 	io_irq = ioc3_map_irq(ipd->pdev, PCI_SLOT(ipd->pdev->devfn),
454 			      PCI_INTERRUPT_INTB);
455 	ret = ioc3_irq_domain_setup(ipd, io_irq);
456 	if (ret)
457 		return ret;
458 
459 	ret = ioc3_eth_setup(ipd);
460 	if (ret)
461 		return ret;
462 
463 	ret = ioc3_serial_setup(ipd);
464 	if (ret)
465 		return ret;
466 
467 	ret = ioc3_kbd_setup(ipd);
468 	if (ret)
469 		return ret;
470 
471 	ret = ioc3_ds1685_setup(ipd);
472 	if (ret)
473 		return ret;
474 
475 	return ioc3_led_setup(ipd);
476 }
477 
ioc3_menet_setup(struct ioc3_priv_data * ipd)478 static int ioc3_menet_setup(struct ioc3_priv_data *ipd)
479 {
480 	int ret, io_irq;
481 
482 	io_irq = ioc3_map_irq(ipd->pdev, PCI_SLOT(ipd->pdev->devfn),
483 			      PCI_INTERRUPT_INTB);
484 	ret = ioc3_irq_domain_setup(ipd, io_irq);
485 	if (ret)
486 		return ret;
487 
488 	ret = ioc3_eth_setup(ipd);
489 	if (ret)
490 		return ret;
491 
492 	return ioc3_serial_setup(ipd);
493 }
494 
ioc3_menet4_setup(struct ioc3_priv_data * ipd)495 static int ioc3_menet4_setup(struct ioc3_priv_data *ipd)
496 {
497 	return ioc3_eth_setup(ipd);
498 }
499 
ioc3_cad_duo_setup(struct ioc3_priv_data * ipd)500 static int ioc3_cad_duo_setup(struct ioc3_priv_data *ipd)
501 {
502 	int ret, io_irq;
503 
504 	io_irq = ioc3_map_irq(ipd->pdev, PCI_SLOT(ipd->pdev->devfn),
505 			      PCI_INTERRUPT_INTB);
506 	ret = ioc3_irq_domain_setup(ipd, io_irq);
507 	if (ret)
508 		return ret;
509 
510 	ret = ioc3_eth_setup(ipd);
511 	if (ret)
512 		return ret;
513 
514 	return ioc3_kbd_setup(ipd);
515 }
516 
517 /* Helper macro for filling ioc3_info array */
518 #define IOC3_SID(_name, _sid, _setup) \
519 	{								   \
520 		.name = _name,						   \
521 		.sid = PCI_VENDOR_ID_SGI | (IOC3_SUBSYS_ ## _sid << 16),   \
522 		.setup = _setup,					   \
523 	}
524 
525 static struct {
526 	const char *name;
527 	u32 sid;
528 	int (*setup)(struct ioc3_priv_data *ipd);
529 } ioc3_infos[] = {
530 	IOC3_SID("IP27 BaseIO6G", IP27_BASEIO6G, &ip27_baseio6g_setup),
531 	IOC3_SID("IP27 MIO", IP27_MIO, &ip27_mio_setup),
532 	IOC3_SID("IP27 BaseIO", IP27_BASEIO, &ip27_baseio_setup),
533 	IOC3_SID("IP29 System Board", IP29_SYSBOARD, &ip27_baseio6g_setup),
534 	IOC3_SID("IP30 System Board", IP30_SYSBOARD, &ip30_sysboard_setup),
535 	IOC3_SID("MENET", MENET, &ioc3_menet_setup),
536 	IOC3_SID("MENET4", MENET4, &ioc3_menet4_setup)
537 };
538 #undef IOC3_SID
539 
ioc3_setup(struct ioc3_priv_data * ipd)540 static int ioc3_setup(struct ioc3_priv_data *ipd)
541 {
542 	u32 sid;
543 	int i;
544 
545 	/* Clear IRQs */
546 	writel(~0, &ipd->regs->sio_iec);
547 	writel(~0, &ipd->regs->sio_ir);
548 	writel(0, &ipd->regs->eth.eier);
549 	writel(~0, &ipd->regs->eth.eisr);
550 
551 	/* Read subsystem vendor id and subsystem id */
552 	pci_read_config_dword(ipd->pdev, PCI_SUBSYSTEM_VENDOR_ID, &sid);
553 
554 	for (i = 0; i < ARRAY_SIZE(ioc3_infos); i++)
555 		if (sid == ioc3_infos[i].sid) {
556 			pr_info("ioc3: %s\n", ioc3_infos[i].name);
557 			return ioc3_infos[i].setup(ipd);
558 		}
559 
560 	/* Treat everything not identified by PCI subid as CAD DUO */
561 	pr_info("ioc3: CAD DUO\n");
562 	return ioc3_cad_duo_setup(ipd);
563 }
564 
ioc3_mfd_probe(struct pci_dev * pdev,const struct pci_device_id * pci_id)565 static int ioc3_mfd_probe(struct pci_dev *pdev,
566 			  const struct pci_device_id *pci_id)
567 {
568 	struct ioc3_priv_data *ipd;
569 	struct ioc3 __iomem *regs;
570 	int ret;
571 
572 	ret = pci_enable_device(pdev);
573 	if (ret)
574 		return ret;
575 
576 	pci_write_config_byte(pdev, PCI_LATENCY_TIMER, IOC3_LATENCY);
577 	pci_set_master(pdev);
578 
579 	ret = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
580 	if (ret) {
581 		pr_err("%s: No usable DMA configuration, aborting.\n",
582 		       pci_name(pdev));
583 		goto out_disable_device;
584 	}
585 
586 	/* Set up per-IOC3 data */
587 	ipd = devm_kzalloc(&pdev->dev, sizeof(struct ioc3_priv_data),
588 			   GFP_KERNEL);
589 	if (!ipd) {
590 		ret = -ENOMEM;
591 		goto out_disable_device;
592 	}
593 	ipd->pdev = pdev;
594 
595 	/*
596 	 * Map all IOC3 registers.  These are shared between subdevices
597 	 * so the main IOC3 module manages them.
598 	 */
599 	regs = pci_ioremap_bar(pdev, 0);
600 	if (!regs) {
601 		dev_warn(&pdev->dev, "ioc3: Unable to remap PCI BAR for %s.\n",
602 			 pci_name(pdev));
603 		ret = -ENOMEM;
604 		goto out_disable_device;
605 	}
606 	ipd->regs = regs;
607 
608 	/* Track PCI-device specific data */
609 	pci_set_drvdata(pdev, ipd);
610 
611 	ret = ioc3_setup(ipd);
612 	if (ret) {
613 		/* Remove all already added MFD devices */
614 		mfd_remove_devices(&ipd->pdev->dev);
615 		if (ipd->domain) {
616 			struct fwnode_handle *fn = ipd->domain->fwnode;
617 
618 			irq_domain_remove(ipd->domain);
619 			irq_domain_free_fwnode(fn);
620 			free_irq(ipd->domain_irq, (void *)ipd);
621 		}
622 		pci_iounmap(pdev, regs);
623 		goto out_disable_device;
624 	}
625 
626 	return 0;
627 
628 out_disable_device:
629 	pci_disable_device(pdev);
630 	return ret;
631 }
632 
ioc3_mfd_remove(struct pci_dev * pdev)633 static void ioc3_mfd_remove(struct pci_dev *pdev)
634 {
635 	struct ioc3_priv_data *ipd;
636 
637 	ipd = pci_get_drvdata(pdev);
638 
639 	/* Clear and disable all IRQs */
640 	writel(~0, &ipd->regs->sio_iec);
641 	writel(~0, &ipd->regs->sio_ir);
642 
643 	/* Release resources */
644 	mfd_remove_devices(&ipd->pdev->dev);
645 	if (ipd->domain) {
646 		struct fwnode_handle *fn = ipd->domain->fwnode;
647 
648 		irq_domain_remove(ipd->domain);
649 		irq_domain_free_fwnode(fn);
650 		free_irq(ipd->domain_irq, (void *)ipd);
651 	}
652 	pci_iounmap(pdev, ipd->regs);
653 	pci_disable_device(pdev);
654 }
655 
656 static struct pci_device_id ioc3_mfd_id_table[] = {
657 	{ PCI_VENDOR_ID_SGI, PCI_DEVICE_ID_SGI_IOC3, PCI_ANY_ID, PCI_ANY_ID },
658 	{ 0, },
659 };
660 MODULE_DEVICE_TABLE(pci, ioc3_mfd_id_table);
661 
662 static struct pci_driver ioc3_mfd_driver = {
663 	.name = "IOC3",
664 	.id_table = ioc3_mfd_id_table,
665 	.probe = ioc3_mfd_probe,
666 	.remove = ioc3_mfd_remove,
667 };
668 
669 module_pci_driver(ioc3_mfd_driver);
670 
671 MODULE_AUTHOR("Thomas Bogendoerfer <tbogendoerfer@suse.de>");
672 MODULE_DESCRIPTION("SGI IOC3 MFD driver");
673 MODULE_LICENSE("GPL v2");
674