Changeset 266a5c92 in rtems for c/src/lib/libbsp/powerpc/mvme5500/include/tm27.h

Timestamp:

05/20/05 19:22:26 (18 years ago)

Author:

Joel Sherrill <joel.sherrill@…>

Branches:

4.10, 4.11, 4.8, 4.9, 5, master

Children:

15113c4

Parents:

5c1af4c

Message:

2005-05-20 Jennifer Averett <jennifer@…>

PR 702/bsps

• include/tm27.h: Add better tm27.h support. Uses decrementer register interrupt -- copied from psim.

File:

• c/src/lib/libbsp/powerpc/mvme5500/include/tm27.h (modified) (1 diff)

c/src/lib/libbsp/powerpc/mvme5500/include/tm27.h

@@ -16 +16 @@
 #define __tm27_h
 
+#include <bsp/irq.h>
+
 /*
  *  Stuff for Time Test 27
  */
 
-#define MUST_WAIT_FOR_INTERRUPT 0
+#define MUST_WAIT_FOR_INTERRUPT 1
 
-#define Install_tm27_vector( handler ) /* empty */
+void nullFunc() {}
+static rtems_irq_connect_data clockIrqData = {BSP_DECREMENTER,
+                                              0,
+                                              (rtems_irq_enable)nullFunc,
+                                              (rtems_irq_disable)nullFunc,
+                                              (rtems_irq_is_enabled) nullFunc};
 
-#define Cause_tm27_intr() /* empty */
+void Install_tm27_vector(void (*_handler)())
+{
+  clockIrqData.hdl = _handler;
+  if (!BSP_install_rtems_irq_handler (&clockIrqData)) {
+        printk("Error installing clock interrupt handler!\n");
+        rtems_fatal_error_occurred(1);
+  }
+}
 
-#define Clear_tm27_intr() /* empty */
+#define Cause_tm27_intr()  \
+  do { \
+    uint32_t _clicks = 1; \
+    asm volatile( "mtdec %0" : "=r" ((_clicks)) : "r" ((_clicks)) ); \
+  } while (0)
 
-#define Lower_tm27_intr() /* empty */
+
+#define Clear_tm27_intr() \
+  do { \
+    uint32_t _clicks = 0xffffffff; \
+    asm volatile( "mtdec %0" : "=r" ((_clicks)) : "r" ((_clicks)) ); \
+  } while (0)
+
+#define Lower_tm27_intr() \
+  do { \
+    uint32_t _msr = 0; \
+    _ISR_Set_level( 0 ); \
+    asm volatile( "mfmsr %0 ;" : "=r" (_msr) : "r" (_msr) ); \
+    _msr |=  0x8002; \
+    asm volatile( "mtmsr %0 ;" : "=r" (_msr) : "r" (_msr) ); \
+  } while (0)
 
 #endif