GNU Linux-libre 5.19-rc6-gnu
[releases.git] / drivers / mfd / max8998-irq.c
1 // SPDX-License-Identifier: GPL-2.0+
2 //
3 // Interrupt controller support for MAX8998
4 //
5 // Copyright (C) 2010 Samsung Electronics Co.Ltd
6 // Author: Joonyoung Shim <jy0922.shim@samsung.com>
7
8 #include <linux/device.h>
9 #include <linux/interrupt.h>
10 #include <linux/irq.h>
11 #include <linux/irqdomain.h>
12 #include <linux/mfd/max8998-private.h>
13
14 struct max8998_irq_data {
15         int reg;
16         int mask;
17 };
18
19 static struct max8998_irq_data max8998_irqs[] = {
20         [MAX8998_IRQ_DCINF] = {
21                 .reg = 1,
22                 .mask = MAX8998_IRQ_DCINF_MASK,
23         },
24         [MAX8998_IRQ_DCINR] = {
25                 .reg = 1,
26                 .mask = MAX8998_IRQ_DCINR_MASK,
27         },
28         [MAX8998_IRQ_JIGF] = {
29                 .reg = 1,
30                 .mask = MAX8998_IRQ_JIGF_MASK,
31         },
32         [MAX8998_IRQ_JIGR] = {
33                 .reg = 1,
34                 .mask = MAX8998_IRQ_JIGR_MASK,
35         },
36         [MAX8998_IRQ_PWRONF] = {
37                 .reg = 1,
38                 .mask = MAX8998_IRQ_PWRONF_MASK,
39         },
40         [MAX8998_IRQ_PWRONR] = {
41                 .reg = 1,
42                 .mask = MAX8998_IRQ_PWRONR_MASK,
43         },
44         [MAX8998_IRQ_WTSREVNT] = {
45                 .reg = 2,
46                 .mask = MAX8998_IRQ_WTSREVNT_MASK,
47         },
48         [MAX8998_IRQ_SMPLEVNT] = {
49                 .reg = 2,
50                 .mask = MAX8998_IRQ_SMPLEVNT_MASK,
51         },
52         [MAX8998_IRQ_ALARM1] = {
53                 .reg = 2,
54                 .mask = MAX8998_IRQ_ALARM1_MASK,
55         },
56         [MAX8998_IRQ_ALARM0] = {
57                 .reg = 2,
58                 .mask = MAX8998_IRQ_ALARM0_MASK,
59         },
60         [MAX8998_IRQ_ONKEY1S] = {
61                 .reg = 3,
62                 .mask = MAX8998_IRQ_ONKEY1S_MASK,
63         },
64         [MAX8998_IRQ_TOPOFFR] = {
65                 .reg = 3,
66                 .mask = MAX8998_IRQ_TOPOFFR_MASK,
67         },
68         [MAX8998_IRQ_DCINOVPR] = {
69                 .reg = 3,
70                 .mask = MAX8998_IRQ_DCINOVPR_MASK,
71         },
72         [MAX8998_IRQ_CHGRSTF] = {
73                 .reg = 3,
74                 .mask = MAX8998_IRQ_CHGRSTF_MASK,
75         },
76         [MAX8998_IRQ_DONER] = {
77                 .reg = 3,
78                 .mask = MAX8998_IRQ_DONER_MASK,
79         },
80         [MAX8998_IRQ_CHGFAULT] = {
81                 .reg = 3,
82                 .mask = MAX8998_IRQ_CHGFAULT_MASK,
83         },
84         [MAX8998_IRQ_LOBAT1] = {
85                 .reg = 4,
86                 .mask = MAX8998_IRQ_LOBAT1_MASK,
87         },
88         [MAX8998_IRQ_LOBAT2] = {
89                 .reg = 4,
90                 .mask = MAX8998_IRQ_LOBAT2_MASK,
91         },
92 };
93
94 static inline struct max8998_irq_data *
95 irq_to_max8998_irq(struct max8998_dev *max8998, struct irq_data *data)
96 {
97         return &max8998_irqs[data->hwirq];
98 }
99
100 static void max8998_irq_lock(struct irq_data *data)
101 {
102         struct max8998_dev *max8998 = irq_data_get_irq_chip_data(data);
103
104         mutex_lock(&max8998->irqlock);
105 }
106
107 static void max8998_irq_sync_unlock(struct irq_data *data)
108 {
109         struct max8998_dev *max8998 = irq_data_get_irq_chip_data(data);
110         int i;
111
112         for (i = 0; i < ARRAY_SIZE(max8998->irq_masks_cur); i++) {
113                 /*
114                  * If there's been a change in the mask write it back
115                  * to the hardware.
116                  */
117                 if (max8998->irq_masks_cur[i] != max8998->irq_masks_cache[i]) {
118                         max8998->irq_masks_cache[i] = max8998->irq_masks_cur[i];
119                         max8998_write_reg(max8998->i2c, MAX8998_REG_IRQM1 + i,
120                                         max8998->irq_masks_cur[i]);
121                 }
122         }
123
124         mutex_unlock(&max8998->irqlock);
125 }
126
127 static void max8998_irq_unmask(struct irq_data *data)
128 {
129         struct max8998_dev *max8998 = irq_data_get_irq_chip_data(data);
130         struct max8998_irq_data *irq_data = irq_to_max8998_irq(max8998, data);
131
132         max8998->irq_masks_cur[irq_data->reg - 1] &= ~irq_data->mask;
133 }
134
135 static void max8998_irq_mask(struct irq_data *data)
136 {
137         struct max8998_dev *max8998 = irq_data_get_irq_chip_data(data);
138         struct max8998_irq_data *irq_data = irq_to_max8998_irq(max8998, data);
139
140         max8998->irq_masks_cur[irq_data->reg - 1] |= irq_data->mask;
141 }
142
143 static struct irq_chip max8998_irq_chip = {
144         .name = "max8998",
145         .irq_bus_lock = max8998_irq_lock,
146         .irq_bus_sync_unlock = max8998_irq_sync_unlock,
147         .irq_mask = max8998_irq_mask,
148         .irq_unmask = max8998_irq_unmask,
149 };
150
151 static irqreturn_t max8998_irq_thread(int irq, void *data)
152 {
153         struct max8998_dev *max8998 = data;
154         u8 irq_reg[MAX8998_NUM_IRQ_REGS];
155         int ret;
156         int i;
157
158         ret = max8998_bulk_read(max8998->i2c, MAX8998_REG_IRQ1,
159                         MAX8998_NUM_IRQ_REGS, irq_reg);
160         if (ret < 0) {
161                 dev_err(max8998->dev, "Failed to read interrupt register: %d\n",
162                                 ret);
163                 return IRQ_NONE;
164         }
165
166         /* Apply masking */
167         for (i = 0; i < MAX8998_NUM_IRQ_REGS; i++)
168                 irq_reg[i] &= ~max8998->irq_masks_cur[i];
169
170         /* Report */
171         for (i = 0; i < MAX8998_IRQ_NR; i++) {
172                 if (irq_reg[max8998_irqs[i].reg - 1] & max8998_irqs[i].mask) {
173                         irq = irq_find_mapping(max8998->irq_domain, i);
174                         if (WARN_ON(!irq)) {
175                                 disable_irq_nosync(max8998->irq);
176                                 return IRQ_NONE;
177                         }
178                         handle_nested_irq(irq);
179                 }
180         }
181
182         return IRQ_HANDLED;
183 }
184
185 int max8998_irq_resume(struct max8998_dev *max8998)
186 {
187         if (max8998->irq && max8998->irq_domain)
188                 max8998_irq_thread(max8998->irq, max8998);
189         return 0;
190 }
191
192 static int max8998_irq_domain_map(struct irq_domain *d, unsigned int irq,
193                                         irq_hw_number_t hw)
194 {
195         struct max8997_dev *max8998 = d->host_data;
196
197         irq_set_chip_data(irq, max8998);
198         irq_set_chip_and_handler(irq, &max8998_irq_chip, handle_edge_irq);
199         irq_set_nested_thread(irq, 1);
200         irq_set_noprobe(irq);
201
202         return 0;
203 }
204
205 static const struct irq_domain_ops max8998_irq_domain_ops = {
206         .map = max8998_irq_domain_map,
207 };
208
209 int max8998_irq_init(struct max8998_dev *max8998)
210 {
211         int i;
212         int ret;
213         struct irq_domain *domain;
214
215         if (!max8998->irq) {
216                 dev_warn(max8998->dev,
217                          "No interrupt specified, no interrupts\n");
218                 return 0;
219         }
220
221         mutex_init(&max8998->irqlock);
222
223         /* Mask the individual interrupt sources */
224         for (i = 0; i < MAX8998_NUM_IRQ_REGS; i++) {
225                 max8998->irq_masks_cur[i] = 0xff;
226                 max8998->irq_masks_cache[i] = 0xff;
227                 max8998_write_reg(max8998->i2c, MAX8998_REG_IRQM1 + i, 0xff);
228         }
229
230         max8998_write_reg(max8998->i2c, MAX8998_REG_STATUSM1, 0xff);
231         max8998_write_reg(max8998->i2c, MAX8998_REG_STATUSM2, 0xff);
232
233         domain = irq_domain_add_simple(NULL, MAX8998_IRQ_NR,
234                         max8998->irq_base, &max8998_irq_domain_ops, max8998);
235         if (!domain) {
236                 dev_err(max8998->dev, "could not create irq domain\n");
237                 return -ENODEV;
238         }
239         max8998->irq_domain = domain;
240
241         ret = request_threaded_irq(max8998->irq, NULL, max8998_irq_thread,
242                                    IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
243                                    "max8998-irq", max8998);
244         if (ret) {
245                 dev_err(max8998->dev, "Failed to request IRQ %d: %d\n",
246                         max8998->irq, ret);
247                 return ret;
248         }
249
250         if (!max8998->ono)
251                 return 0;
252
253         ret = request_threaded_irq(max8998->ono, NULL, max8998_irq_thread,
254                                    IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING |
255                                    IRQF_ONESHOT, "max8998-ono", max8998);
256         if (ret)
257                 dev_err(max8998->dev, "Failed to request IRQ %d: %d\n",
258                         max8998->ono, ret);
259
260         return 0;
261 }
262
263 void max8998_irq_exit(struct max8998_dev *max8998)
264 {
265         if (max8998->ono)
266                 free_irq(max8998->ono, max8998);
267
268         if (max8998->irq)
269                 free_irq(max8998->irq, max8998);
270 }