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

bsp/qoriq: Fix tm27 support

Browse Source
This commit is contained in:
Sebastian Huber
2014-09-09 15:18:01 +02:00
parent 8028089000
commit 5674767fd8
1 changed files with 52 additions and 21 deletions
Download Patch File Download Diff File Expand all files Collapse all files

73
c/src/lib/libbsp/powerpc/qoriq/include/tm27.h
View File

@@ -7,10 +7,10 @@
*/ */
/* /*
* Copyright (c) 2010 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>
@@ -27,39 +27,70 @@
#ifndef TMTESTS_TM27_H #ifndef TMTESTS_TM27_H
#define TMTESTS_TM27_H #define TMTESTS_TM27_H
#include <assert.h>
#include <libcpu/powerpc-utility.h> #include <libcpu/powerpc-utility.h>
#include <bsp/vectors.h>
#include <bsp/irq.h>
#include <bsp/qoriq.h>
#define MUST_WAIT_FOR_INTERRUPT 1 #define MUST_WAIT_FOR_INTERRUPT 1
static void (*tm27_interrupt_handler)(rtems_vector_number); #define IPI_INDEX_LOW 1
static int tm27_exception_handler( BSP_Exception_frame *frame, unsigned number) #define IPI_INDEX_HIGH 2
static void Install_tm27_vector(void (*handler)(rtems_vector_number))
{ {
(*tm27_interrupt_handler)( 0); rtems_status_code sc;
rtems_vector_number low = QORIQ_IRQ_IPI_0 + IPI_INDEX_LOW;
rtems_vector_number high = QORIQ_IRQ_IPI_0 + IPI_INDEX_HIGH;
return 0; sc = rtems_interrupt_handler_install(
low,
"tm17 low",
RTEMS_INTERRUPT_UNIQUE,
(rtems_interrupt_handler) handler,
NULL
);
assert(sc == RTEMS_SUCCESSFUL);
sc = qoriq_pic_set_priority(low, 1, NULL);
assert(sc == RTEMS_SUCCESSFUL);
sc = rtems_interrupt_handler_install(
high,
"tm17 high",
RTEMS_INTERRUPT_UNIQUE,
(rtems_interrupt_handler) handler,
NULL
);
assert(sc == RTEMS_SUCCESSFUL);
sc = qoriq_pic_set_priority(high, 2, NULL);
assert(sc == RTEMS_SUCCESSFUL);
} }
void Install_tm27_vector( void (*handler)(rtems_vector_number)) static void qoriq_tm27_cause(uint32_t ipi_index)
{ {
int rv = 0; uint32_t self = ppc_processor_id();
tm27_interrupt_handler = handler; qoriq.pic.per_cpu[self].ipidr[ipi_index].reg = UINT32_C(1) << self;
rv = ppc_exc_set_handler( ASM_DEC_VECTOR, tm27_exception_handler);
if (rv < 0) {
printk( "Error installing clock interrupt handler!\n");
}
} }
#define Cause_tm27_intr() \ static void Cause_tm27_intr()
ppc_set_decrementer_register( 8) {
qoriq_tm27_cause(IPI_INDEX_LOW);
}
#define Clear_tm27_intr() \ static void Clear_tm27_intr()
ppc_set_decrementer_register( UINT32_MAX) {
/* Nothing to do */
}
#define Lower_tm27_intr() \ static void Lower_tm27_intr(void)
(void) ppc_external_exceptions_enable() {
qoriq_tm27_cause(IPI_INDEX_HIGH);
}
#endif /* TMTESTS_TM27_H */ #endif /* TMTESTS_TM27_H */