summaryrefslogtreecommitdiffstats
path: root/c/src/lib/libbsp/powerpc/ss555/clock/p_clock.c
diff options
context:
space:
mode:
authorJoel Sherrill <joel.sherrill@OARcorp.com>2004-04-12 21:52:13 +0000
committerJoel Sherrill <joel.sherrill@OARcorp.com>2004-04-12 21:52:13 +0000
commita800d09cc79100fb8e10e10fa344c5218ce91d69 (patch)
tree353ae933c659bd80b1c37430448b2d8e3992b2cb /c/src/lib/libbsp/powerpc/ss555/clock/p_clock.c
parent2004-04-12 Ralf Corsepius <ralf_corsepius@rtems.org> (diff)
downloadrtems-a800d09cc79100fb8e10e10fa344c5218ce91d69.tar.bz2
2004-04-12 David Querbach <querbach@realtime.bc.ca>
* .cvsignore, ChangeLog, Makefile.am, README, bsp_specs, configure.ac, times, clock/p_clock.c, console/console.c, include/.cvsignore, include/bsp.h, include/coverhd.h, irq/irq.h, startup/bspstart.c, startup/iss555.c, startup/linkcmds, startup/start.S, wrapup/.cvsignore, wrapup/Makefile.am: New files.
Diffstat (limited to 'c/src/lib/libbsp/powerpc/ss555/clock/p_clock.c')
-rw-r--r--c/src/lib/libbsp/powerpc/ss555/clock/p_clock.c68
1 files changed, 68 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/powerpc/ss555/clock/p_clock.c b/c/src/lib/libbsp/powerpc/ss555/clock/p_clock.c
new file mode 100644
index 0000000000..0a3b92c4c3
--- /dev/null
+++ b/c/src/lib/libbsp/powerpc/ss555/clock/p_clock.c
@@ -0,0 +1,68 @@
+/*
+ * Clock Tick interrupt conexion code.
+ *
+ * COPYRIGHT (c) 1989-1997.
+ * On-Line Applications Research Corporation (OAR).
+ *
+ * The license and distribution terms for this file may in
+ * the file LICENSE in this distribution or at
+ * http://www.rtems.com/license/LICENSE.
+ *
+ * SS555 port sponsored by Defence Research and Development Canada - Suffield
+ * Copyright (C) 2004, Real-Time Systems Inc. (querbach@realtime.bc.ca)
+ *
+ * Derived from c/src/lib/libbsp/powerpc/mbx8xx/clock/p_clock.c:
+ *
+ * Modified to support the MPC750.
+ * Modifications Copyright (c) 1999 Eric Valette valette@crf.canon.fr
+ *
+ * $Id$
+ */
+
+#include <bsp.h>
+#include <bsp/irq.h>
+#include <rtems/bspIo.h>
+
+extern void clockOn(void*);
+extern void clockOff (void*);
+extern int clockIsOn(void*);
+extern void Clock_isr();
+
+static rtems_irq_connect_data clockIrqData = {
+ CPU_PERIODIC_TIMER,
+ (rtems_irq_hdl)Clock_isr,
+ (rtems_irq_enable)clockOn,
+ (rtems_irq_disable)clockOff,
+ (rtems_irq_is_enabled)clockIsOn
+};
+
+int BSP_disconnect_clock_handler (void)
+{
+ if (!BSP_get_current_rtems_irq_handler(&clockIrqData)) {
+ printk("Unable to stop system clock\n");
+ rtems_fatal_error_occurred(1);
+ }
+ return BSP_remove_rtems_irq_handler (&clockIrqData);
+}
+
+int BSP_connect_clock_handler (rtems_irq_hdl hdl)
+{
+ if (!BSP_get_current_rtems_irq_handler(&clockIrqData)) {
+ printk("Unable to get system clock handler\n");
+ rtems_fatal_error_occurred(1);
+ }
+ if (!BSP_remove_rtems_irq_handler (&clockIrqData)) {
+ printk("Unable to remove current system clock handler\n");
+ rtems_fatal_error_occurred(1);
+ }
+ /*
+ * Reinit structure
+ */
+ clockIrqData.name = CPU_PERIODIC_TIMER;
+ clockIrqData.hdl = (rtems_irq_hdl) hdl;
+ clockIrqData.on = (rtems_irq_enable)clockOn;
+ clockIrqData.off = (rtems_irq_enable)clockOff;
+ clockIrqData.isOn = (rtems_irq_is_enabled)clockIsOn;
+
+ return BSP_install_rtems_irq_handler (&clockIrqData);
+}