irq: clean up code
- using IRQ_X() to print message; - update some comment; - rename some function; - add more strict irq sanity; Change-Id: If5432818d4bc12fc1aa0b8aca6898bbf79dfa9fb Signed-off-by: Joseph Chen <chenjh@rock-chips.com>
This commit is contained in:
Joseph Chen
parent
ebe3d004b5
commit
269512fdf6
|
|
@ -21,16 +21,19 @@ static struct irq_desc irqs_desc[PLATFORM_MAX_IRQS_NR];
|
|||
static struct irq_chip *gic_irq_chip, *gpio_irq_chip;
|
||||
static bool initialized;
|
||||
|
||||
static int irq_bad(int irq)
|
||||
static int bad_irq(int irq)
|
||||
{
|
||||
if (irq >= PLATFORM_MAX_IRQS_NR) {
|
||||
printf("WARN: IRQ %d is out of max supported IRQ %d\n",
|
||||
irq, PLATFORM_MAX_IRQS_NR);
|
||||
IRQ_W("IRQ %d is out of max supported IRQ(%d)\n",
|
||||
irq, PLATFORM_MAX_IRQS_NR);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if (!irqs_desc[irq].handle_irq)
|
||||
return -EINVAL;
|
||||
|
||||
if (!initialized) {
|
||||
printf("WARN: Interrupt framework is not initialized\n");
|
||||
IRQ_W("Interrupt framework is not initialized\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
|
|
@ -38,13 +41,13 @@ static int irq_bad(int irq)
|
|||
}
|
||||
|
||||
/* general interrupt handler for gpio chip */
|
||||
void _generic_gpio_handle_irq(int irq)
|
||||
void __generic_gpio_handle_irq(int irq)
|
||||
{
|
||||
if (irq_bad(irq))
|
||||
if (bad_irq(irq))
|
||||
return;
|
||||
|
||||
if (irq < PLATFORM_GIC_IRQS_NR) {
|
||||
printf("WRAN: IRQ %d is not a GPIO irq\n", irq);
|
||||
IRQ_W("IRQ %d is not a GPIO irq\n", irq);
|
||||
return;
|
||||
}
|
||||
|
||||
|
|
@ -52,7 +55,7 @@ void _generic_gpio_handle_irq(int irq)
|
|||
irqs_desc[irq].handle_irq(irq, irqs_desc[irq].data);
|
||||
}
|
||||
|
||||
void _do_generic_irq_handler(void)
|
||||
void __do_generic_irq_handler(void)
|
||||
{
|
||||
u32 irq = gic_irq_chip->irq_get();
|
||||
|
||||
|
|
@ -69,7 +72,7 @@ int irq_is_busy(int irq)
|
|||
return (irq >= 0 && irqs_desc[irq].handle_irq) ? -EBUSY : 0;
|
||||
}
|
||||
|
||||
static int chip_irq_bad(struct irq_chip *chip)
|
||||
static int bad_irq_chip(struct irq_chip *chip)
|
||||
{
|
||||
if (!chip->name ||
|
||||
!chip->irq_init ||
|
||||
|
|
@ -81,19 +84,19 @@ static int chip_irq_bad(struct irq_chip *chip)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static int _do_arch_irq_init(void)
|
||||
static int __do_arch_irq_init(void)
|
||||
{
|
||||
int irq, err = -EINVAL;
|
||||
|
||||
/* After relocation done, bss data initialized */
|
||||
if (!(gd->flags & GD_FLG_RELOC)) {
|
||||
printf("WARN: interrupt should be init after reloc\n");
|
||||
IRQ_W("Interrupt framework should initialize after reloc\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
/*
|
||||
* should set true before arch_gpio_irq_init(), otherwise
|
||||
* can't request irqs for gpio banks.
|
||||
* We set true before arch_gpio_irq_init() to avoid fail when
|
||||
* request irq for gpio banks.
|
||||
*/
|
||||
initialized = true;
|
||||
|
||||
|
|
@ -103,26 +106,26 @@ static int _do_arch_irq_init(void)
|
|||
}
|
||||
|
||||
gic_irq_chip = arch_gic_irq_init();
|
||||
if (chip_irq_bad(gic_irq_chip)) {
|
||||
printf("ERROR: bad gic irq chip\n");
|
||||
if (bad_irq_chip(gic_irq_chip)) {
|
||||
IRQ_E("Bad gic irq chip\n");
|
||||
goto out;
|
||||
}
|
||||
|
||||
gpio_irq_chip = arch_gpio_irq_init();
|
||||
if (chip_irq_bad(gpio_irq_chip)) {
|
||||
printf("ERROR: bad gpio irq chip\n");
|
||||
if (bad_irq_chip(gpio_irq_chip)) {
|
||||
IRQ_E("Bad gpio irq chip\n");
|
||||
goto out;
|
||||
}
|
||||
|
||||
err = gic_irq_chip->irq_init();
|
||||
if (err) {
|
||||
printf("ERROR: gic interrupt init failed\n");
|
||||
IRQ_E("GIC interrupt initial failed, ret=%d\n", err);
|
||||
goto out;
|
||||
}
|
||||
|
||||
err = gpio_irq_chip->irq_init();
|
||||
if (err) {
|
||||
printf("ERROR: gpio interrupt init failed\n");
|
||||
IRQ_E("GPIO interrupt initial failed, ret=%d\n", err);
|
||||
goto out;
|
||||
}
|
||||
|
||||
|
|
@ -136,7 +139,7 @@ out:
|
|||
|
||||
int irq_handler_enable(int irq)
|
||||
{
|
||||
if (irq_bad(irq))
|
||||
if (bad_irq(irq))
|
||||
return -EINVAL;
|
||||
|
||||
if (irq < PLATFORM_GIC_IRQS_NR)
|
||||
|
|
@ -147,7 +150,7 @@ int irq_handler_enable(int irq)
|
|||
|
||||
int irq_handler_disable(int irq)
|
||||
{
|
||||
if (irq_bad(irq))
|
||||
if (bad_irq(irq))
|
||||
return -EINVAL;
|
||||
|
||||
if (irq < PLATFORM_GIC_IRQS_NR)
|
||||
|
|
@ -158,7 +161,7 @@ int irq_handler_disable(int irq)
|
|||
|
||||
int irq_set_irq_type(int irq, unsigned int type)
|
||||
{
|
||||
if (irq_bad(irq))
|
||||
if (bad_irq(irq))
|
||||
return -EINVAL;
|
||||
|
||||
if (irq < PLATFORM_GIC_IRQS_NR)
|
||||
|
|
@ -169,7 +172,7 @@ int irq_set_irq_type(int irq, unsigned int type)
|
|||
|
||||
int irq_revert_irq_type(int irq)
|
||||
{
|
||||
if (irq_bad(irq))
|
||||
if (bad_irq(irq))
|
||||
return -EINVAL;
|
||||
|
||||
if (irq < PLATFORM_GIC_IRQS_NR)
|
||||
|
|
@ -180,7 +183,7 @@ int irq_revert_irq_type(int irq)
|
|||
|
||||
int irq_get_gpio_level(int irq)
|
||||
{
|
||||
if (irq_bad(irq))
|
||||
if (bad_irq(irq))
|
||||
return -EINVAL;
|
||||
|
||||
if (irq < PLATFORM_GIC_IRQS_NR)
|
||||
|
|
@ -191,8 +194,19 @@ int irq_get_gpio_level(int irq)
|
|||
|
||||
void irq_install_handler(int irq, interrupt_handler_t *handler, void *data)
|
||||
{
|
||||
if (irq_bad(irq))
|
||||
if (irq >= PLATFORM_MAX_IRQS_NR) {
|
||||
IRQ_W("IRQ %d is out of max supported IRQ(%d)\n",
|
||||
irq, PLATFORM_MAX_IRQS_NR);
|
||||
return;
|
||||
}
|
||||
|
||||
if (!handler || irqs_desc[irq].handle_irq)
|
||||
return;
|
||||
|
||||
if (!initialized) {
|
||||
IRQ_W("Interrupt framework is not initialized\n");
|
||||
return;
|
||||
}
|
||||
|
||||
irqs_desc[irq].handle_irq = handler;
|
||||
irqs_desc[irq].data = data;
|
||||
|
|
@ -213,7 +227,7 @@ int irqs_suspend(void)
|
|||
|
||||
err = gic_irq_chip->irq_suspend();
|
||||
if (err) {
|
||||
printf("ERROR: irqs suspend failed\n");
|
||||
IRQ_E("IRQs suspend failed, ret=%d\n", err);
|
||||
return err;
|
||||
}
|
||||
|
||||
|
|
@ -226,7 +240,7 @@ int irqs_resume(void)
|
|||
|
||||
err = gic_irq_chip->irq_resume();
|
||||
if (err) {
|
||||
printf("ERROR: irqs resume failed\n");
|
||||
IRQ_E("IRQs resume failed, ret=%d\n", err);
|
||||
return err;
|
||||
}
|
||||
|
||||
|
|
@ -242,7 +256,6 @@ static void cpu_local_irq_enable(void)
|
|||
static int cpu_local_irq_disable(void)
|
||||
{
|
||||
asm volatile("msr daifset, #0x02");
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
|
@ -253,7 +266,7 @@ void do_irq(struct pt_regs *pt_regs, unsigned int esr)
|
|||
show_regs(pt_regs);
|
||||
#endif
|
||||
|
||||
_do_generic_irq_handler();
|
||||
__do_generic_irq_handler();
|
||||
}
|
||||
#else
|
||||
static void cpu_local_irq_enable(void)
|
||||
|
|
@ -287,7 +300,7 @@ void do_irq(struct pt_regs *pt_regs)
|
|||
show_regs(pt_regs);
|
||||
#endif
|
||||
|
||||
_do_generic_irq_handler();
|
||||
__do_generic_irq_handler();
|
||||
}
|
||||
#endif
|
||||
|
||||
|
|
@ -318,7 +331,7 @@ int arch_interrupt_init(void)
|
|||
: "r" (cpsr)
|
||||
: "memory");
|
||||
#endif
|
||||
return _do_arch_irq_init();
|
||||
return __do_arch_irq_init();
|
||||
}
|
||||
|
||||
int interrupt_init(void)
|
||||
|
|
|
|||
|
|
@ -211,10 +211,8 @@ static void gic_irq_eoi(int irq)
|
|||
#ifdef CONFIG_GICV2
|
||||
gicc_writel(irq, GICC_EOIR);
|
||||
#else
|
||||
asm volatile("msr " __stringify(ICC_EOIR1_EL1) ", %0"
|
||||
: : "r" ((u64)irq));
|
||||
asm volatile("msr " __stringify(ICC_DIR_EL1) ", %0"
|
||||
: : "r" ((u64)irq));
|
||||
asm volatile("msr " __stringify(ICC_EOIR1_EL1) ", %0" : : "r" ((u64)irq));
|
||||
asm volatile("msr " __stringify(ICC_DIR_EL1) ", %0" : : "r" ((u64)irq));
|
||||
isb();
|
||||
#endif
|
||||
}
|
||||
|
|
|
|||
|
|
@ -45,16 +45,18 @@ static struct gpio_bank gpio_banks[GPIO_BANK_NUM] = {
|
|||
|
||||
static int gpio_is_valid(u32 gpio)
|
||||
{
|
||||
if ((gpio == EINVAL_GPIO) || !GPIO_BANK_VALID(gpio) ||
|
||||
if ((gpio == EINVAL_GPIO) ||
|
||||
!GPIO_BANK_VALID(gpio) ||
|
||||
!GPIO_PIN_VALID(gpio)) {
|
||||
printf("gpio = 0x%x is not valid!\n", gpio);
|
||||
IRQ_E("gpio-%d(bank-%d, pin-%d) is invalid!\n",
|
||||
gpio, GPIO_BANK(gpio), GPIO_PIN(gpio));
|
||||
return 0;
|
||||
}
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
static int _hard_gpio_to_irq(u32 gpio)
|
||||
static int __hard_gpio_to_irq(u32 gpio)
|
||||
{
|
||||
int idx, bank = 0, pin = 0;
|
||||
int irq;
|
||||
|
|
@ -77,36 +79,36 @@ static int _hard_gpio_to_irq(u32 gpio)
|
|||
return -EINVAL;
|
||||
}
|
||||
|
||||
static int _phandle_gpio_to_irq(u32 gpio_phandle, u32 offset)
|
||||
static int __phandle_gpio_to_irq(u32 gpio_phandle, u32 offset)
|
||||
{
|
||||
int irq_gpio, bank, ret = EINVAL_GPIO;
|
||||
bool found;
|
||||
const char *name;
|
||||
char *name_tok;
|
||||
bool found;
|
||||
int node;
|
||||
|
||||
node = fdt_node_offset_by_phandle(gd->fdt_blob, gpio_phandle);
|
||||
if (node < 0) {
|
||||
printf("can't find node by gpio_phandle %d, ret=%d\n",
|
||||
gpio_phandle, node);
|
||||
IRQ_E("Can't find node by gpio_phandle=%d, ret=%d\n",
|
||||
gpio_phandle, node);
|
||||
return EINVAL_GPIO;
|
||||
}
|
||||
|
||||
name = fdt_get_name(gd->fdt_blob, node, NULL);
|
||||
if (!name) {
|
||||
printf("can't find device name for the gpio bank\n");
|
||||
IRQ_E("Can't find gpio bank for phandle=%d\n", gpio_phandle);
|
||||
return EINVAL_GPIO;
|
||||
}
|
||||
|
||||
name_tok = strdup(name);
|
||||
if (!name_tok) {
|
||||
printf("Error: strdup in %s failed!\n", __func__);
|
||||
IRQ_E("Strdup '%s' failed!\n", name);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
name = strtok(name_tok, "@");
|
||||
if (!name) {
|
||||
printf("can't find correct device name for the gpio bank\n");
|
||||
IRQ_E("Can't strtok '@' for '%s'\n", name_tok);
|
||||
goto out;
|
||||
}
|
||||
|
||||
|
|
@ -118,24 +120,24 @@ static int _phandle_gpio_to_irq(u32 gpio_phandle, u32 offset)
|
|||
}
|
||||
|
||||
if (!found) {
|
||||
printf("irq gpio framework can't find %s\n", name);
|
||||
IRQ_E("GPIO irq framework can't find '%s'\n", name);
|
||||
goto out;
|
||||
}
|
||||
|
||||
debug("%s: gpio%d-%d\n", __func__, bank, offset);
|
||||
IRQ_D("%s: gpio%d-%d\n", __func__, bank, offset);
|
||||
irq_gpio = RK_IRQ_GPIO(bank, offset);
|
||||
if (!gpio_is_valid(irq_gpio))
|
||||
goto out;
|
||||
|
||||
free(name_tok);
|
||||
return _hard_gpio_to_irq(irq_gpio);
|
||||
return __hard_gpio_to_irq(irq_gpio);
|
||||
|
||||
out:
|
||||
free(name_tok);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int _irq_to_gpio(int irq)
|
||||
static int __irq_to_gpio(int irq)
|
||||
{
|
||||
int bank, pin, idx;
|
||||
|
||||
|
|
@ -155,23 +157,23 @@ static int _irq_to_gpio(int irq)
|
|||
int gpio_to_irq(struct gpio_desc *gpio)
|
||||
{
|
||||
int irq_gpio, bank, ret = EINVAL_GPIO;
|
||||
bool found;
|
||||
char *name, *name_tok;
|
||||
bool found;
|
||||
|
||||
if (!gpio->dev->name) {
|
||||
printf("can't find device name for the gpio bank\n");
|
||||
IRQ_E("Can't find dev name for gpio bank\n");
|
||||
return EINVAL_GPIO;
|
||||
}
|
||||
|
||||
name_tok = strdup(gpio->dev->name);
|
||||
if (!name_tok) {
|
||||
printf("Error: strdup in %s failed!\n", __func__);
|
||||
IRQ_E("Strdup '%s' failed!\n", gpio->dev->name);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
name = strtok(name_tok, "@");
|
||||
if (!name) {
|
||||
printf("can't find correct device name for the gpio bank\n");
|
||||
IRQ_E("Can't strtok '@' for '%s'\n", name_tok);
|
||||
goto out;
|
||||
}
|
||||
|
||||
|
|
@ -183,7 +185,7 @@ int gpio_to_irq(struct gpio_desc *gpio)
|
|||
}
|
||||
|
||||
if (!found) {
|
||||
printf("irq gpio framework can't find %s\n", name);
|
||||
IRQ_E("GPIO irq framework can't find '%s'\n", name);
|
||||
goto out;
|
||||
}
|
||||
|
||||
|
|
@ -192,7 +194,7 @@ int gpio_to_irq(struct gpio_desc *gpio)
|
|||
goto out;
|
||||
|
||||
free(name_tok);
|
||||
return _hard_gpio_to_irq(irq_gpio);
|
||||
return __hard_gpio_to_irq(irq_gpio);
|
||||
|
||||
out:
|
||||
free(name_tok);
|
||||
|
|
@ -204,7 +206,7 @@ int hard_gpio_to_irq(u32 gpio)
|
|||
if (!gpio_is_valid(gpio))
|
||||
return EINVAL_GPIO;
|
||||
|
||||
return _hard_gpio_to_irq(gpio);
|
||||
return __hard_gpio_to_irq(gpio);
|
||||
}
|
||||
|
||||
int phandle_gpio_to_irq(u32 gpio_phandle, u32 pin)
|
||||
|
|
@ -212,12 +214,12 @@ int phandle_gpio_to_irq(u32 gpio_phandle, u32 pin)
|
|||
if (gpio_phandle < 0)
|
||||
return EINVAL_GPIO;
|
||||
|
||||
return _phandle_gpio_to_irq(gpio_phandle, pin);
|
||||
return __phandle_gpio_to_irq(gpio_phandle, pin);
|
||||
}
|
||||
|
||||
int irq_to_gpio(int irq)
|
||||
{
|
||||
return _irq_to_gpio(irq);
|
||||
return __irq_to_gpio(irq);
|
||||
}
|
||||
|
||||
struct gpio_bank *gpio_id_to_bank(u32 id)
|
||||
|
|
|
|||
|
|
@ -101,15 +101,15 @@ static void generic_gpio_handle_irq(int irq, void *data __always_unused)
|
|||
gpio_irq_ack(bank->regbase, offset_to_bit(pin));
|
||||
|
||||
/*
|
||||
* if gpio is edge triggered, clear condition before executing
|
||||
* the handler so that we don't miss edges
|
||||
* If gpio is edge triggered, clear condition before executing
|
||||
* the handler, so that we don't miss next edges trigger.
|
||||
*/
|
||||
if (ilr & (1 << pin)) {
|
||||
unmasked = 1;
|
||||
gpio_irq_unmask(bank->regbase, offset_to_bit(pin));
|
||||
}
|
||||
|
||||
_generic_gpio_handle_irq(gpio_irq + pin);
|
||||
__generic_gpio_handle_irq(gpio_irq + pin);
|
||||
|
||||
isr &= ~(1 << pin);
|
||||
|
||||
|
|
|
|||
|
|
@ -11,6 +11,11 @@
|
|||
#include <common.h>
|
||||
#include <dt-bindings/pinctrl/rockchip.h>
|
||||
|
||||
#define IRQ_I(fmt, args...) printf("IRQ: "fmt, ##args)
|
||||
#define IRQ_W(fmt, args...) printf("IRQ Warn: "fmt, ##args)
|
||||
#define IRQ_E(fmt, args...) printf("IRQ Err: "fmt, ##args)
|
||||
#define IRQ_D(fmt, args...) debug("IRQ Debug "fmt, ##args)
|
||||
|
||||
/*
|
||||
* IRQ line status.
|
||||
*
|
||||
|
|
@ -84,10 +89,11 @@ int gpio_to_irq(struct gpio_desc *gpio);
|
|||
*/
|
||||
#define GPIO_BANK_SHIFT 8
|
||||
#define RK_IRQ_GPIO(bank, pin) (((bank) << GPIO_BANK_SHIFT) | (pin))
|
||||
|
||||
int hard_gpio_to_irq(unsigned gpio);
|
||||
int phandle_gpio_to_irq(u32 gpio_phandle, u32 pin);
|
||||
|
||||
/* only irq-gpio.c can use it */
|
||||
void _generic_gpio_handle_irq(int irq);
|
||||
/* Only irq-gpio.c can call it */
|
||||
void __generic_gpio_handle_irq(int irq);
|
||||
|
||||
#endif /* _IRQ_GENERIC_H */
|
||||
|
|
|
|||
Loading…
Reference in New Issue