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