irq.c

 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
12static 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
25static const struct irq_domain_ops sdw_domain_ops = {
26	.map	= sdw_irq_map,
27};
28
29int 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_FW_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
44void sdw_irq_delete(struct sdw_bus *bus)
45{
46	irq_domain_remove(bus->domain);
47}
48
49static void sdw_irq_dispose_mapping(void *data)
50{
51	struct sdw_slave *slave = data;
52
53	irq_dispose_mapping(slave->irq);
54}
55
56void sdw_irq_create_mapping(struct sdw_slave *slave)
57{
58	slave->irq = irq_create_mapping(slave->bus->domain, slave->index);
59	if (!slave->irq)
60		dev_warn(&slave->dev, "Failed to map IRQ\n");
61
62	devm_add_action_or_reset(&slave->dev, sdw_irq_dispose_mapping, slave);
63}