1 // SPDX-License-Identifier: GPL-2.0
2 // Copyright (C) 2023 Cirrus Logic, Inc. and
3 //                    Cirrus Logic International Semiconductor Ltd.
4 
5 #include <linux/device.h>
6 #include <linux/fwnode.h>
7 #include <linux/irq.h>
8 #include <linux/irqdomain.h>
9 #include <linux/soundwire/sdw.h>
10 #include "irq.h"
11 
sdw_irq_map(struct irq_domain * h,unsigned int virq,irq_hw_number_t hw)12 static int sdw_irq_map(struct irq_domain *h, unsigned int virq,
13 		       irq_hw_number_t hw)
14 {
15 	struct sdw_bus *bus = h->host_data;
16 
17 	irq_set_chip_data(virq, bus);
18 	irq_set_chip(virq, &bus->irq_chip);
19 	irq_set_nested_thread(virq, 1);
20 	irq_set_noprobe(virq);
21 
22 	return 0;
23 }
24 
25 static const struct irq_domain_ops sdw_domain_ops = {
26 	.map	= sdw_irq_map,
27 };
28 
sdw_irq_create(struct sdw_bus * bus,struct fwnode_handle * fwnode)29 int sdw_irq_create(struct sdw_bus *bus,
30 		   struct fwnode_handle *fwnode)
31 {
32 	bus->irq_chip.name = dev_name(bus->dev);
33 
34 	bus->domain = irq_domain_create_linear(fwnode, SDW_MAX_DEVICES,
35 					       &sdw_domain_ops, bus);
36 	if (!bus->domain) {
37 		dev_err(bus->dev, "Failed to add IRQ domain\n");
38 		return -EINVAL;
39 	}
40 
41 	return 0;
42 }
43 
sdw_irq_delete(struct sdw_bus * bus)44 void sdw_irq_delete(struct sdw_bus *bus)
45 {
46 	irq_domain_remove(bus->domain);
47 }
48 
sdw_irq_create_mapping(struct sdw_slave * slave)49 void sdw_irq_create_mapping(struct sdw_slave *slave)
50 {
51 	slave->irq = irq_create_mapping(slave->bus->domain, slave->dev_num);
52 	if (!slave->irq)
53 		dev_warn(&slave->dev, "Failed to map IRQ\n");
54 }
55 
sdw_irq_dispose_mapping(struct sdw_slave * slave)56 void sdw_irq_dispose_mapping(struct sdw_slave *slave)
57 {
58 	irq_dispose_mapping(irq_find_mapping(slave->bus->domain, slave->dev_num));
59 }
60