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

bsp/qoriq: SMP support for IRQ support

Browse Source
This commit is contained in:
Sebastian Huber
2014-04-15 13:36:35 +02:00
parent 487b94e7ad
commit b80f920860
1 changed files with 11 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

19
c/src/lib/libbsp/powerpc/qoriq/irq/irq.c
View File

@@ -7,10 +7,10 @@
*/ */
/* /*
* Copyright (c) 2010, 2012 embedded brains GmbH. All rights reserved. * Copyright (c) 2010-2014 embedded brains GmbH. All rights reserved.
* *
* embedded brains GmbH * embedded brains GmbH
* Obere Lagerstr. 30 * Dornierstr. 4
* 82178 Puchheim * 82178 Puchheim
* Germany * Germany
* <rtems@embedded-brains.de> * <rtems@embedded-brains.de>
@@ -47,6 +47,9 @@
#define SPURIOUS 0xffff #define SPURIOUS 0xffff
static rtems_interrupt_lock lock =
RTEMS_INTERRUPT_LOCK_INITIALIZER("QorIQ IRQ");
static const uint16_t vpr_and_dr_offsets [] = { static const uint16_t vpr_and_dr_offsets [] = {
[0] = 0x10200 >> 4, [0] = 0x10200 >> 4,
[1] = 0x10220 >> 4, [1] = 0x10220 >> 4,
@@ -168,12 +171,12 @@ rtems_status_code qoriq_pic_set_priority(
volatile uint32_t *vpr = (volatile uint32_t *) &qoriq.pic + offs; volatile uint32_t *vpr = (volatile uint32_t *) &qoriq.pic + offs;
if (QORIQ_PIC_PRIORITY_IS_VALID(new_priority)) { if (QORIQ_PIC_PRIORITY_IS_VALID(new_priority)) {
rtems_interrupt_level level; rtems_interrupt_lock_context lock_context;
rtems_interrupt_disable(level); rtems_interrupt_lock_acquire(&lock, &lock_context);
old_vpr = *vpr; old_vpr = *vpr;
*vpr = VPR_PRIORITY_SET(old_vpr, (uint32_t) new_priority); *vpr = VPR_PRIORITY_SET(old_vpr, (uint32_t) new_priority);
rtems_interrupt_enable(level); rtems_interrupt_lock_release(&lock, &lock_context);
} else if (new_priority < 0) { } else if (new_priority < 0) {
old_vpr = *vpr; old_vpr = *vpr;
} else { } else {
@@ -220,11 +223,11 @@ static rtems_status_code pic_vector_enable(rtems_vector_number vector, uint32_t
if (bsp_interrupt_is_valid_vector(vector)) { if (bsp_interrupt_is_valid_vector(vector)) {
int offs = vpr_and_dr_offsets [vector] << 2; int offs = vpr_and_dr_offsets [vector] << 2;
volatile uint32_t *vpr = (volatile uint32_t *) &qoriq.pic + offs; volatile uint32_t *vpr = (volatile uint32_t *) &qoriq.pic + offs;
rtems_interrupt_level level; rtems_interrupt_lock_context lock_context;
rtems_interrupt_disable(level); rtems_interrupt_lock_acquire(&lock, &lock_context);
*vpr = (*vpr & ~VPR_MSK) | msk; *vpr = (*vpr & ~VPR_MSK) | msk;
rtems_interrupt_enable(level); rtems_interrupt_lock_release(&lock, &lock_context);
} }
return sc; return sc;