Blame view
drivers/irqchip/irq-meson-gpio.c
13.6 KB
38cf0d46f treewide: Replace... |
1 |
// SPDX-License-Identifier: GPL-2.0-only |
215f4cc0f irqchip/meson: Ad... |
2 3 4 5 6 |
/* * Copyright (c) 2015 Endless Mobile, Inc. * Author: Carlo Caione <carlo@endlessm.com> * Copyright (c) 2016 BayLibre, SAS. * Author: Jerome Brunet <jbrunet@baylibre.com> |
215f4cc0f irqchip/meson: Ad... |
7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 |
*/ #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt #include <linux/io.h> #include <linux/module.h> #include <linux/irq.h> #include <linux/irqdomain.h> #include <linux/irqchip.h> #include <linux/of.h> #include <linux/of_address.h> #define NUM_CHANNEL 8 #define MAX_INPUT_MUX 256 #define REG_EDGE_POL 0x00 #define REG_PIN_03_SEL 0x04 #define REG_PIN_47_SEL 0x08 #define REG_FILTER_SEL 0x0c |
8f78bd62b irqchip/meson-gpi... |
26 27 |
/* use for A1 like chips */ #define REG_PIN_A1_SEL 0x04 |
b2fb4b779 irqchip/meson-gpi... |
28 29 30 31 32 33 |
/* * Note: The S905X3 datasheet reports that BOTH_EDGE is controlled by * bits 24 to 31. Tests on the actual HW show that these bits are * stuck at 0. Bits 8 to 15 are responsive and have the expected * effect. */ |
e2514165f irqchip/meson-gpi... |
34 35 36 37 38 39 40 |
#define REG_EDGE_POL_EDGE(params, x) BIT((params)->edge_single_offset + (x)) #define REG_EDGE_POL_LOW(params, x) BIT((params)->pol_low_offset + (x)) #define REG_BOTH_EDGE(params, x) BIT((params)->edge_both_offset + (x)) #define REG_EDGE_POL_MASK(params, x) ( \ REG_EDGE_POL_EDGE(params, x) | \ REG_EDGE_POL_LOW(params, x) | \ REG_BOTH_EDGE(params, x)) |
215f4cc0f irqchip/meson: Ad... |
41 42 |
#define REG_PIN_SEL_SHIFT(x) (((x) % 4) * 8) #define REG_FILTER_SEL_SHIFT(x) ((x) * 4) |
e2514165f irqchip/meson-gpi... |
43 44 45 46 |
struct meson_gpio_irq_controller; static void meson8_gpio_irq_sel_pin(struct meson_gpio_irq_controller *ctl, unsigned int channel, unsigned long hwirq); static void meson_gpio_irq_init_dummy(struct meson_gpio_irq_controller *ctl); |
8f78bd62b irqchip/meson-gpi... |
47 48 49 50 |
static void meson_a1_gpio_irq_sel_pin(struct meson_gpio_irq_controller *ctl, unsigned int channel, unsigned long hwirq); static void meson_a1_gpio_irq_init(struct meson_gpio_irq_controller *ctl); |
e2514165f irqchip/meson-gpi... |
51 52 53 54 55 56 |
struct irq_ctl_ops { void (*gpio_irq_sel_pin)(struct meson_gpio_irq_controller *ctl, unsigned int channel, unsigned long hwirq); void (*gpio_irq_init)(struct meson_gpio_irq_controller *ctl); }; |
215f4cc0f irqchip/meson: Ad... |
57 58 |
struct meson_gpio_irq_params { unsigned int nr_hwirq; |
b2fb4b779 irqchip/meson-gpi... |
59 |
bool support_edge_both; |
e2514165f irqchip/meson-gpi... |
60 61 62 63 64 |
unsigned int edge_both_offset; unsigned int edge_single_offset; unsigned int pol_low_offset; unsigned int pin_sel_mask; struct irq_ctl_ops ops; |
215f4cc0f irqchip/meson: Ad... |
65 |
}; |
e2514165f irqchip/meson-gpi... |
66 67 68 69 70 71 72 73 74 75 76 77 78 |
#define INIT_MESON_COMMON(irqs, init, sel) \ .nr_hwirq = irqs, \ .ops = { \ .gpio_irq_init = init, \ .gpio_irq_sel_pin = sel, \ }, #define INIT_MESON8_COMMON_DATA(irqs) \ INIT_MESON_COMMON(irqs, meson_gpio_irq_init_dummy, \ meson8_gpio_irq_sel_pin) \ .edge_single_offset = 0, \ .pol_low_offset = 16, \ .pin_sel_mask = 0xff, \ |
8f78bd62b irqchip/meson-gpi... |
79 80 81 82 83 84 85 86 |
#define INIT_MESON_A1_COMMON_DATA(irqs) \ INIT_MESON_COMMON(irqs, meson_a1_gpio_irq_init, \ meson_a1_gpio_irq_sel_pin) \ .support_edge_both = true, \ .edge_both_offset = 16, \ .edge_single_offset = 8, \ .pol_low_offset = 0, \ .pin_sel_mask = 0x7f, \ |
4e4cb1b18 irqchip/meson-gpi... |
87 |
static const struct meson_gpio_irq_params meson8_params = { |
e2514165f irqchip/meson-gpi... |
88 |
INIT_MESON8_COMMON_DATA(134) |
4e4cb1b18 irqchip/meson-gpi... |
89 |
}; |
215f4cc0f irqchip/meson: Ad... |
90 |
static const struct meson_gpio_irq_params meson8b_params = { |
e2514165f irqchip/meson-gpi... |
91 |
INIT_MESON8_COMMON_DATA(119) |
215f4cc0f irqchip/meson: Ad... |
92 93 94 |
}; static const struct meson_gpio_irq_params gxbb_params = { |
e2514165f irqchip/meson-gpi... |
95 |
INIT_MESON8_COMMON_DATA(133) |
215f4cc0f irqchip/meson: Ad... |
96 97 98 |
}; static const struct meson_gpio_irq_params gxl_params = { |
e2514165f irqchip/meson-gpi... |
99 |
INIT_MESON8_COMMON_DATA(110) |
215f4cc0f irqchip/meson: Ad... |
100 |
}; |
868c4e075 irqchip/meson-gpi... |
101 |
static const struct meson_gpio_irq_params axg_params = { |
e2514165f irqchip/meson-gpi... |
102 |
INIT_MESON8_COMMON_DATA(100) |
868c4e075 irqchip/meson-gpi... |
103 |
}; |
b2fb4b779 irqchip/meson-gpi... |
104 |
static const struct meson_gpio_irq_params sm1_params = { |
e2514165f irqchip/meson-gpi... |
105 |
INIT_MESON8_COMMON_DATA(100) |
b2fb4b779 irqchip/meson-gpi... |
106 |
.support_edge_both = true, |
e2514165f irqchip/meson-gpi... |
107 |
.edge_both_offset = 8, |
b2fb4b779 irqchip/meson-gpi... |
108 |
}; |
8f78bd62b irqchip/meson-gpi... |
109 110 111 |
static const struct meson_gpio_irq_params a1_params = { INIT_MESON_A1_COMMON_DATA(62) }; |
215f4cc0f irqchip/meson: Ad... |
112 |
static const struct of_device_id meson_irq_gpio_matches[] = { |
4e4cb1b18 irqchip/meson-gpi... |
113 |
{ .compatible = "amlogic,meson8-gpio-intc", .data = &meson8_params }, |
215f4cc0f irqchip/meson: Ad... |
114 115 116 |
{ .compatible = "amlogic,meson8b-gpio-intc", .data = &meson8b_params }, { .compatible = "amlogic,meson-gxbb-gpio-intc", .data = &gxbb_params }, { .compatible = "amlogic,meson-gxl-gpio-intc", .data = &gxl_params }, |
868c4e075 irqchip/meson-gpi... |
117 |
{ .compatible = "amlogic,meson-axg-gpio-intc", .data = &axg_params }, |
c64a9e804 irqchip/meson-gpi... |
118 |
{ .compatible = "amlogic,meson-g12a-gpio-intc", .data = &axg_params }, |
b2fb4b779 irqchip/meson-gpi... |
119 |
{ .compatible = "amlogic,meson-sm1-gpio-intc", .data = &sm1_params }, |
8f78bd62b irqchip/meson-gpi... |
120 |
{ .compatible = "amlogic,meson-a1-gpio-intc", .data = &a1_params }, |
215f4cc0f irqchip/meson: Ad... |
121 122 123 124 |
{ } }; struct meson_gpio_irq_controller { |
b2fb4b779 irqchip/meson-gpi... |
125 |
const struct meson_gpio_irq_params *params; |
215f4cc0f irqchip/meson: Ad... |
126 127 128 129 130 131 132 133 134 |
void __iomem *base; u32 channel_irqs[NUM_CHANNEL]; DECLARE_BITMAP(channel_map, NUM_CHANNEL); spinlock_t lock; }; static void meson_gpio_irq_update_bits(struct meson_gpio_irq_controller *ctl, unsigned int reg, u32 mask, u32 val) { |
0a66d6f90 irqchip/meson-gpi... |
135 |
unsigned long flags; |
215f4cc0f irqchip/meson: Ad... |
136 |
u32 tmp; |
0a66d6f90 irqchip/meson-gpi... |
137 |
spin_lock_irqsave(&ctl->lock, flags); |
215f4cc0f irqchip/meson: Ad... |
138 139 140 141 |
tmp = readl_relaxed(ctl->base + reg); tmp &= ~mask; tmp |= val; writel_relaxed(tmp, ctl->base + reg); |
0a66d6f90 irqchip/meson-gpi... |
142 143 |
spin_unlock_irqrestore(&ctl->lock, flags); |
215f4cc0f irqchip/meson: Ad... |
144 |
} |
e2514165f irqchip/meson-gpi... |
145 |
static void meson_gpio_irq_init_dummy(struct meson_gpio_irq_controller *ctl) |
215f4cc0f irqchip/meson: Ad... |
146 |
{ |
e2514165f irqchip/meson-gpi... |
147 148 149 150 151 152 153 154 155 156 157 158 159 160 |
} static void meson8_gpio_irq_sel_pin(struct meson_gpio_irq_controller *ctl, unsigned int channel, unsigned long hwirq) { unsigned int reg_offset; unsigned int bit_offset; reg_offset = (channel < 4) ? REG_PIN_03_SEL : REG_PIN_47_SEL; bit_offset = REG_PIN_SEL_SHIFT(channel); meson_gpio_irq_update_bits(ctl, reg_offset, ctl->params->pin_sel_mask << bit_offset, hwirq << bit_offset); |
215f4cc0f irqchip/meson: Ad... |
161 |
} |
8f78bd62b irqchip/meson-gpi... |
162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 |
static void meson_a1_gpio_irq_sel_pin(struct meson_gpio_irq_controller *ctl, unsigned int channel, unsigned long hwirq) { unsigned int reg_offset; unsigned int bit_offset; bit_offset = ((channel % 2) == 0) ? 0 : 16; reg_offset = REG_PIN_A1_SEL + ((channel / 2) << 2); meson_gpio_irq_update_bits(ctl, reg_offset, ctl->params->pin_sel_mask << bit_offset, hwirq << bit_offset); } /* For a1 or later chips like a1 there is a switch to enable/disable irq */ static void meson_a1_gpio_irq_init(struct meson_gpio_irq_controller *ctl) { meson_gpio_irq_update_bits(ctl, REG_EDGE_POL, BIT(31), BIT(31)); } |
215f4cc0f irqchip/meson: Ad... |
182 183 184 185 186 |
static int meson_gpio_irq_request_channel(struct meson_gpio_irq_controller *ctl, unsigned long hwirq, u32 **channel_hwirq) { |
0a66d6f90 irqchip/meson-gpi... |
187 |
unsigned long flags; |
e2514165f irqchip/meson-gpi... |
188 |
unsigned int idx; |
215f4cc0f irqchip/meson: Ad... |
189 |
|
0a66d6f90 irqchip/meson-gpi... |
190 |
spin_lock_irqsave(&ctl->lock, flags); |
215f4cc0f irqchip/meson: Ad... |
191 192 193 194 |
/* Find a free channel */ idx = find_first_zero_bit(ctl->channel_map, NUM_CHANNEL); if (idx >= NUM_CHANNEL) { |
0a66d6f90 irqchip/meson-gpi... |
195 |
spin_unlock_irqrestore(&ctl->lock, flags); |
215f4cc0f irqchip/meson: Ad... |
196 197 198 199 200 201 202 |
pr_err("No channel available "); return -ENOSPC; } /* Mark the channel as used */ set_bit(idx, ctl->channel_map); |
0a66d6f90 irqchip/meson-gpi... |
203 |
spin_unlock_irqrestore(&ctl->lock, flags); |
215f4cc0f irqchip/meson: Ad... |
204 205 206 207 |
/* * Setup the mux of the channel to route the signal of the pad * to the appropriate input of the GIC */ |
e2514165f irqchip/meson-gpi... |
208 |
ctl->params->ops.gpio_irq_sel_pin(ctl, idx, hwirq); |
215f4cc0f irqchip/meson: Ad... |
209 210 211 212 213 214 215 216 |
/* * Get the hwirq number assigned to this channel through * a pointer the channel_irq table. The added benifit of this * method is that we can also retrieve the channel index with * it, using the table base. */ *channel_hwirq = &(ctl->channel_irqs[idx]); |
215f4cc0f irqchip/meson: Ad... |
217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 |
pr_debug("hwirq %lu assigned to channel %d - irq %u ", hwirq, idx, **channel_hwirq); return 0; } static unsigned int meson_gpio_irq_get_channel_idx(struct meson_gpio_irq_controller *ctl, u32 *channel_hwirq) { return channel_hwirq - ctl->channel_irqs; } static void meson_gpio_irq_release_channel(struct meson_gpio_irq_controller *ctl, u32 *channel_hwirq) { unsigned int idx; idx = meson_gpio_irq_get_channel_idx(ctl, channel_hwirq); clear_bit(idx, ctl->channel_map); } static int meson_gpio_irq_type_setup(struct meson_gpio_irq_controller *ctl, unsigned int type, u32 *channel_hwirq) { u32 val = 0; unsigned int idx; |
e2514165f irqchip/meson-gpi... |
247 |
const struct meson_gpio_irq_params *params; |
215f4cc0f irqchip/meson: Ad... |
248 |
|
e2514165f irqchip/meson-gpi... |
249 |
params = ctl->params; |
215f4cc0f irqchip/meson: Ad... |
250 251 252 253 254 255 256 257 258 259 |
idx = meson_gpio_irq_get_channel_idx(ctl, channel_hwirq); /* * The controller has a filter block to operate in either LEVEL or * EDGE mode, then signal is sent to the GIC. To enable LEVEL_LOW and * EDGE_FALLING support (which the GIC does not support), the filter * block is also able to invert the input signal it gets before * providing it to the GIC. */ type &= IRQ_TYPE_SENSE_MASK; |
b2fb4b779 irqchip/meson-gpi... |
260 261 262 263 264 |
/* * New controller support EDGE_BOTH trigger. This setting takes * precedence over the other edge/polarity settings */ if (type == IRQ_TYPE_EDGE_BOTH) { |
e2514165f irqchip/meson-gpi... |
265 |
if (!params->support_edge_both) |
b2fb4b779 irqchip/meson-gpi... |
266 |
return -EINVAL; |
215f4cc0f irqchip/meson: Ad... |
267 |
|
e2514165f irqchip/meson-gpi... |
268 |
val |= REG_BOTH_EDGE(params, idx); |
b2fb4b779 irqchip/meson-gpi... |
269 270 |
} else { if (type & (IRQ_TYPE_EDGE_RISING | IRQ_TYPE_EDGE_FALLING)) |
e2514165f irqchip/meson-gpi... |
271 |
val |= REG_EDGE_POL_EDGE(params, idx); |
215f4cc0f irqchip/meson: Ad... |
272 |
|
b2fb4b779 irqchip/meson-gpi... |
273 |
if (type & (IRQ_TYPE_LEVEL_LOW | IRQ_TYPE_EDGE_FALLING)) |
e2514165f irqchip/meson-gpi... |
274 |
val |= REG_EDGE_POL_LOW(params, idx); |
b2fb4b779 irqchip/meson-gpi... |
275 |
} |
215f4cc0f irqchip/meson: Ad... |
276 |
|
215f4cc0f irqchip/meson: Ad... |
277 |
meson_gpio_irq_update_bits(ctl, REG_EDGE_POL, |
e2514165f irqchip/meson-gpi... |
278 |
REG_EDGE_POL_MASK(params, idx), val); |
215f4cc0f irqchip/meson: Ad... |
279 |
|
215f4cc0f irqchip/meson: Ad... |
280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 |
return 0; } static unsigned int meson_gpio_irq_type_output(unsigned int type) { unsigned int sense = type & IRQ_TYPE_SENSE_MASK; type &= ~IRQ_TYPE_SENSE_MASK; /* * The polarity of the signal provided to the GIC should always * be high. */ if (sense & (IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW)) type |= IRQ_TYPE_LEVEL_HIGH; |
b2fb4b779 irqchip/meson-gpi... |
295 |
else |
215f4cc0f irqchip/meson: Ad... |
296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 |
type |= IRQ_TYPE_EDGE_RISING; return type; } static int meson_gpio_irq_set_type(struct irq_data *data, unsigned int type) { struct meson_gpio_irq_controller *ctl = data->domain->host_data; u32 *channel_hwirq = irq_data_get_irq_chip_data(data); int ret; ret = meson_gpio_irq_type_setup(ctl, type, channel_hwirq); if (ret) return ret; return irq_chip_set_type_parent(data, meson_gpio_irq_type_output(type)); } static struct irq_chip meson_gpio_irq_chip = { .name = "meson-gpio-irqchip", .irq_mask = irq_chip_mask_parent, .irq_unmask = irq_chip_unmask_parent, .irq_eoi = irq_chip_eoi_parent, .irq_set_type = meson_gpio_irq_set_type, .irq_retrigger = irq_chip_retrigger_hierarchy, #ifdef CONFIG_SMP .irq_set_affinity = irq_chip_set_affinity_parent, #endif .flags = IRQCHIP_SET_TYPE_MASKED, }; static int meson_gpio_irq_domain_translate(struct irq_domain *domain, struct irq_fwspec *fwspec, unsigned long *hwirq, unsigned int *type) { if (is_of_node(fwspec->fwnode) && fwspec->param_count == 2) { *hwirq = fwspec->param[0]; *type = fwspec->param[1]; return 0; } return -EINVAL; } static int meson_gpio_irq_allocate_gic_irq(struct irq_domain *domain, unsigned int virq, u32 hwirq, unsigned int type) { struct irq_fwspec fwspec; fwspec.fwnode = domain->parent->fwnode; fwspec.param_count = 3; fwspec.param[0] = 0; /* SPI */ fwspec.param[1] = hwirq; fwspec.param[2] = meson_gpio_irq_type_output(type); return irq_domain_alloc_irqs_parent(domain, virq, 1, &fwspec); } static int meson_gpio_irq_domain_alloc(struct irq_domain *domain, unsigned int virq, unsigned int nr_irqs, void *data) { struct irq_fwspec *fwspec = data; struct meson_gpio_irq_controller *ctl = domain->host_data; unsigned long hwirq; u32 *channel_hwirq; unsigned int type; int ret; if (WARN_ON(nr_irqs != 1)) return -EINVAL; ret = meson_gpio_irq_domain_translate(domain, fwspec, &hwirq, &type); if (ret) return ret; ret = meson_gpio_irq_request_channel(ctl, hwirq, &channel_hwirq); if (ret) return ret; ret = meson_gpio_irq_allocate_gic_irq(domain, virq, *channel_hwirq, type); if (ret < 0) { pr_err("failed to allocate gic irq %u ", *channel_hwirq); meson_gpio_irq_release_channel(ctl, channel_hwirq); return ret; } irq_domain_set_hwirq_and_chip(domain, virq, hwirq, &meson_gpio_irq_chip, channel_hwirq); return 0; } static void meson_gpio_irq_domain_free(struct irq_domain *domain, unsigned int virq, unsigned int nr_irqs) { struct meson_gpio_irq_controller *ctl = domain->host_data; struct irq_data *irq_data; u32 *channel_hwirq; if (WARN_ON(nr_irqs != 1)) return; irq_domain_free_irqs_parent(domain, virq, 1); irq_data = irq_domain_get_irq_data(domain, virq); channel_hwirq = irq_data_get_irq_chip_data(irq_data); meson_gpio_irq_release_channel(ctl, channel_hwirq); } static const struct irq_domain_ops meson_gpio_irq_domain_ops = { .alloc = meson_gpio_irq_domain_alloc, .free = meson_gpio_irq_domain_free, .translate = meson_gpio_irq_domain_translate, }; static int __init meson_gpio_irq_parse_dt(struct device_node *node, struct meson_gpio_irq_controller *ctl) { const struct of_device_id *match; |
215f4cc0f irqchip/meson: Ad... |
425 426 427 428 429 |
int ret; match = of_match_node(meson_irq_gpio_matches, node); if (!match) return -ENODEV; |
b2fb4b779 irqchip/meson-gpi... |
430 |
ctl->params = match->data; |
215f4cc0f irqchip/meson: Ad... |
431 432 433 434 435 436 437 438 439 440 441 |
ret = of_property_read_variable_u32_array(node, "amlogic,channel-interrupts", ctl->channel_irqs, NUM_CHANNEL, NUM_CHANNEL); if (ret < 0) { pr_err("can't get %d channel interrupts ", NUM_CHANNEL); return ret; } |
e2514165f irqchip/meson-gpi... |
442 |
ctl->params->ops.gpio_irq_init(ctl); |
215f4cc0f irqchip/meson: Ad... |
443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 |
return 0; } static int __init meson_gpio_irq_of_init(struct device_node *node, struct device_node *parent) { struct irq_domain *domain, *parent_domain; struct meson_gpio_irq_controller *ctl; int ret; if (!parent) { pr_err("missing parent interrupt node "); return -ENODEV; } parent_domain = irq_find_host(parent); if (!parent_domain) { pr_err("unable to obtain parent domain "); return -ENXIO; } ctl = kzalloc(sizeof(*ctl), GFP_KERNEL); if (!ctl) return -ENOMEM; spin_lock_init(&ctl->lock); ctl->base = of_iomap(node, 0); if (!ctl->base) { ret = -ENOMEM; goto free_ctl; } ret = meson_gpio_irq_parse_dt(node, ctl); if (ret) goto free_channel_irqs; |
b2fb4b779 irqchip/meson-gpi... |
481 482 |
domain = irq_domain_create_hierarchy(parent_domain, 0, ctl->params->nr_hwirq, |
215f4cc0f irqchip/meson: Ad... |
483 484 485 486 487 488 489 490 491 492 493 494 |
of_node_to_fwnode(node), &meson_gpio_irq_domain_ops, ctl); if (!domain) { pr_err("failed to add domain "); ret = -ENODEV; goto free_channel_irqs; } pr_info("%d to %d gpio interrupt mux initialized ", |
b2fb4b779 irqchip/meson-gpi... |
495 |
ctl->params->nr_hwirq, NUM_CHANNEL); |
215f4cc0f irqchip/meson: Ad... |
496 497 498 499 500 501 502 503 504 505 506 507 508 |
return 0; free_channel_irqs: iounmap(ctl->base); free_ctl: kfree(ctl); return ret; } IRQCHIP_DECLARE(meson_gpio_intc, "amlogic,meson-gpio-intc", meson_gpio_irq_of_init); |