RTOS/rtems
1
0
Fork 0
forked from Imagelibrary/rtems
Code Pull Requests Activity

bsps/arm: Fix GIC tm27 support

Browse Source
This commit is contained in:
Sebastian Huber
2014-09-10 10:41:35 +02:00
parent f59e64f268
commit 90f44cd2dd
1 changed files with 29 additions and 15 deletions
Download Patch File Download Diff File Expand all files Collapse all files

44
c/src/lib/libbsp/arm/shared/include/arm-gic-tm27.h
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 * embedded brains GmbH
* Dornierstr. 4 * Dornierstr. 4
@@ -34,17 +34,19 @@
#define MUST_WAIT_FOR_INTERRUPT 1 #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 #define ARM_GIC_TM27_PRIO_HIGH 0x00
static inline void Install_tm27_vector(void (*handler)(rtems_vector_number)) static inline void Install_tm27_vector(void (*handler)(rtems_vector_number))
{ {
rtems_status_code sc = rtems_interrupt_handler_install( rtems_status_code sc = rtems_interrupt_handler_install(
ARM_GIC_TM27_IRQ, ARM_GIC_TM27_IRQ_LOW,
"TM27", "tm27 low",
RTEMS_INTERRUPT_UNIQUE, RTEMS_INTERRUPT_UNIQUE,
(rtems_interrupt_handler) handler, (rtems_interrupt_handler) handler,
NULL NULL
@@ -52,16 +54,31 @@ static inline void Install_tm27_vector(void (*handler)(rtems_vector_number))
assert(sc == RTEMS_SUCCESSFUL); assert(sc == RTEMS_SUCCESSFUL);
sc = arm_gic_irq_set_priority( sc = arm_gic_irq_set_priority(
ARM_GIC_TM27_IRQ, ARM_GIC_TM27_IRQ_LOW,
ARM_GIC_TM27_PRIO_LOW ARM_GIC_TM27_PRIO_LOW
); );
assert(sc == RTEMS_SUCCESSFUL); 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) static inline void Cause_tm27_intr(void)
{ {
rtems_status_code sc = arm_gic_irq_generate_software_irq( 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, ARM_GIC_IRQ_SOFTWARE_IRQ_TO_SELF,
0 0
); );
@@ -70,18 +87,15 @@ static inline void Cause_tm27_intr(void)
static inline void Clear_tm27_intr(void) static inline void Clear_tm27_intr(void)
{ {
rtems_status_code sc = arm_gic_irq_set_priority( /* Nothing to do */
ARM_GIC_TM27_IRQ,
ARM_GIC_TM27_PRIO_LOW
);
assert(sc == RTEMS_SUCCESSFUL);
} }
static inline void Lower_tm27_intr(void) static inline void Lower_tm27_intr(void)
{ {
rtems_status_code sc = arm_gic_irq_set_priority( rtems_status_code sc = arm_gic_irq_generate_software_irq(
ARM_GIC_TM27_IRQ, ARM_GIC_TM27_IRQ_HIGH,
ARM_GIC_TM27_PRIO_HIGH ARM_GIC_IRQ_SOFTWARE_IRQ_TO_SELF,
0
); );
assert(sc == RTEMS_SUCCESSFUL); assert(sc == RTEMS_SUCCESSFUL);
} }