bsps/arm: Fix GIC tm27 support

This commit is contained in:
Sebastian Huber
2014-09-10 10:41:35 +02:00
parent f59e64f268
commit 90f44cd2dd

View File

@@ -7,7 +7,7 @@
*/
/*
* Copyright (c) 2013 embedded brains GmbH. All rights reserved.
* Copyright (c) 2013-2014 embedded brains GmbH. All rights reserved.
*
* embedded brains GmbH
* Dornierstr. 4
@@ -34,17 +34,19 @@
#define MUST_WAIT_FOR_INTERRUPT 1
#define ARM_GIC_TM27_IRQ ARM_GIC_IRQ_SGI_13
#define ARM_GIC_TM27_IRQ_LOW ARM_GIC_IRQ_SGI_12
#define ARM_GIC_TM27_PRIO_LOW 0xfe
#define ARM_GIC_TM27_IRQ_HIGH ARM_GIC_IRQ_SGI_13
#define ARM_GIC_TM27_PRIO_LOW 0x80
#define ARM_GIC_TM27_PRIO_HIGH 0x00
static inline void Install_tm27_vector(void (*handler)(rtems_vector_number))
{
rtems_status_code sc = rtems_interrupt_handler_install(
ARM_GIC_TM27_IRQ,
"TM27",
ARM_GIC_TM27_IRQ_LOW,
"tm27 low",
RTEMS_INTERRUPT_UNIQUE,
(rtems_interrupt_handler) handler,
NULL
@@ -52,16 +54,31 @@ static inline void Install_tm27_vector(void (*handler)(rtems_vector_number))
assert(sc == RTEMS_SUCCESSFUL);
sc = arm_gic_irq_set_priority(
ARM_GIC_TM27_IRQ,
ARM_GIC_TM27_IRQ_LOW,
ARM_GIC_TM27_PRIO_LOW
);
assert(sc == RTEMS_SUCCESSFUL);
sc = rtems_interrupt_handler_install(
ARM_GIC_TM27_IRQ_HIGH,
"tm27 high",
RTEMS_INTERRUPT_UNIQUE,
(rtems_interrupt_handler) handler,
NULL
);
assert(sc == RTEMS_SUCCESSFUL);
sc = arm_gic_irq_set_priority(
ARM_GIC_TM27_IRQ_HIGH,
ARM_GIC_TM27_PRIO_HIGH
);
assert(sc == RTEMS_SUCCESSFUL);
}
static inline void Cause_tm27_intr(void)
{
rtems_status_code sc = arm_gic_irq_generate_software_irq(
ARM_GIC_TM27_IRQ,
ARM_GIC_TM27_IRQ_LOW,
ARM_GIC_IRQ_SOFTWARE_IRQ_TO_SELF,
0
);
@@ -70,18 +87,15 @@ static inline void Cause_tm27_intr(void)
static inline void Clear_tm27_intr(void)
{
rtems_status_code sc = arm_gic_irq_set_priority(
ARM_GIC_TM27_IRQ,
ARM_GIC_TM27_PRIO_LOW
);
assert(sc == RTEMS_SUCCESSFUL);
/* Nothing to do */
}
static inline void Lower_tm27_intr(void)
{
rtems_status_code sc = arm_gic_irq_set_priority(
ARM_GIC_TM27_IRQ,
ARM_GIC_TM27_PRIO_HIGH
rtems_status_code sc = arm_gic_irq_generate_software_irq(
ARM_GIC_TM27_IRQ_HIGH,
ARM_GIC_IRQ_SOFTWARE_IRQ_TO_SELF,
0
);
assert(sc == RTEMS_SUCCESSFUL);
}