Provide SWI(9) and TIMEOUT(9)

21 files changed, 1994 insertions, 322 deletions

diff --git a/Makefile b/Makefile
index 53385923..f93e38ba 100644
--- a/Makefile
+++ b/Makefile
@@ -36,7 +36,6 @@ C_FILES += rtemsbsd/src/rtems-bsd-generic.c
 C_FILES += rtemsbsd/src/rtems-bsd-panic.c
 C_FILES += rtemsbsd/src/rtems-bsd-synch.c
 C_FILES += rtemsbsd/src/rtems-bsd-signal.c
-C_FILES += rtemsbsd/src/rtems-bsd-callout.c
 C_FILES += rtemsbsd/src/rtems-bsd-init.c
 C_FILES += rtemsbsd/src/rtems-bsd-init-with-irq.c
 C_FILES += rtemsbsd/src/rtems-bsd-assert.c
@@ -52,7 +51,6 @@ C_FILES += rtemsbsd/src/rtems-bsd-sysctl.c
 C_FILES += rtemsbsd/src/rtems-bsd-sysctlbyname.c
 C_FILES += rtemsbsd/src/rtems-bsd-sysctlnametomib.c
 C_FILES += rtemsbsd/src/rtems-bsd-taskqueue.c
-C_FILES += rtemsbsd/src/rtems-bsd-timeout.c
 C_FILES += rtemsbsd/src/rtems-bsd-timesupport.c
 C_FILES += rtemsbsd/src/rtems-bsd-newproc.c
 C_FILES += rtemsbsd/src/rtems-bsd-vm_glue.c
@@ -322,6 +320,7 @@ C_FILES += freebsd/local/pcib_if.c
 C_FILES += freebsd/kern/init_main.c
 C_FILES += freebsd/kern/kern_linker.c
 C_FILES += freebsd/kern/kern_mib.c
+C_FILES += freebsd/kern/kern_timeout.c
 C_FILES += freebsd/kern/kern_mbuf.c
 C_FILES += freebsd/kern/kern_module.c
 C_FILES += freebsd/kern/kern_sysctl.c
diff --git a/freebsd-to-rtems.py b/freebsd-to-rtems.py
index 43597b47..ef31a87e 100755
--- a/freebsd-to-rtems.py
+++ b/freebsd-to-rtems.py
@@ -529,7 +529,6 @@ rtems.addRTEMSSourceFiles(
 		'src/rtems-bsd-panic.c',
 		'src/rtems-bsd-synch.c',
 		'src/rtems-bsd-signal.c',
-		'src/rtems-bsd-callout.c',
 		'src/rtems-bsd-init.c',
 		'src/rtems-bsd-init-with-irq.c',
 		'src/rtems-bsd-assert.c',
@@ -547,7 +546,6 @@ rtems.addRTEMSSourceFiles(
 		'src/rtems-bsd-sysctlbyname.c',
 		'src/rtems-bsd-sysctlnametomib.c',
 		'src/rtems-bsd-taskqueue.c',
-		'src/rtems-bsd-timeout.c',
 		'src/rtems-bsd-timesupport.c',
 		'src/rtems-bsd-newproc.c',
 		'src/rtems-bsd-vm_glue.c',
@@ -575,6 +573,7 @@ rtems.addEmptyHeaderFiles(
 		'sys/exec.h',
 		'sys/fail.h',
 		'sys/limits.h',
+		'sys/sleepqueue.h',
 		'sys/namei.h',
 		'sys/_pthreadtypes.h',
 		#'sys/resourcevar.h',
@@ -1119,6 +1118,7 @@ devUsbBase.addSourceFiles(
 		'kern/init_main.c',
 		'kern/kern_linker.c',
 		'kern/kern_mib.c',
+		'kern/kern_timeout.c',
 		'kern/kern_mbuf.c',
 		'kern/kern_module.c',
 		'kern/kern_sysctl.c',
diff --git a/freebsd/kern/kern_intr.c b/freebsd/kern/kern_intr.c
index f93a72c6..982d5e82 100644
--- a/freebsd/kern/kern_intr.c
+++ b/freebsd/kern/kern_intr.c
@@ -55,19 +55,22 @@ __FBSDID("$FreeBSD$");
 #include <freebsd/sys/sysctl.h>
 #include <freebsd/sys/syslog.h>
 #include <freebsd/sys/unistd.h>
-#ifndef __rtems__
 #include <freebsd/sys/vmmeter.h>
-#endif /* __rtems__ */
 #include <freebsd/machine/atomic.h>
 #include <freebsd/machine/cpu.h>
 #ifndef __rtems__
 #include <freebsd/machine/md_var.h>
 #include <freebsd/machine/stdarg.h>
+#else /* __rtems__ */
+  #ifdef INTR_FILTER
+    #error INTR_FILTER is currently not suppported with RTEMS
+  #endif
+  #define RTEMSBSD_SWI_WAKEUP_EVENT RTEMS_EVENT_31
+#endif /* __rtems__ */
 #ifdef DDB
 #include <freebsd/ddb/ddb.h>
 #include <freebsd/ddb/db_sym.h>
 #endif
-#endif /* __rtems__ */
 
 /*
  * Describe an interrupt thread.  There is one of these per interrupt event.
@@ -88,24 +91,27 @@ struct	intr_entropy {
 };
 
 struct	intr_event *clk_intr_event;
+#ifndef __rtems__
 struct	intr_event *tty_intr_event;
 void	*vm_ih;
+#endif /* __rtems__ */ 
 struct proc *intrproc;
 
 static MALLOC_DEFINE(M_ITHREAD, "ithread", "Interrupt Threads");
 
 static int intr_storm_threshold = 1000;
+#ifndef __rtems__
 TUNABLE_INT("hw.intr_storm_threshold", &intr_storm_threshold);
 SYSCTL_INT(_hw, OID_AUTO, intr_storm_threshold, CTLFLAG_RW,
     &intr_storm_threshold, 0,
     "Number of consecutive interrupts before storm protection is enabled");
+#endif /* __rtems__ */
 static TAILQ_HEAD(, intr_event) event_list =
     TAILQ_HEAD_INITIALIZER(event_list);
 static struct mtx event_lock;
 MTX_SYSINIT(intr_event_list, &event_lock, "intr event list", MTX_DEF);
 
 static void	intr_event_update(struct intr_event *ie);
-#ifndef __rtems__
 #ifdef INTR_FILTER
 static int	intr_event_schedule_thread(struct intr_event *ie,
 		    struct intr_thread *ithd);
@@ -117,7 +123,9 @@ static struct intr_thread *ithread_create(const char *name,
 static int	intr_event_schedule_thread(struct intr_event *ie);
 static struct intr_thread *ithread_create(const char *name);
 #endif
+#ifndef __rtems__
 static void	ithread_destroy(struct intr_thread *ithread);
+#endif /* __rtems__ */
 static void	ithread_execute_handlers(struct proc *p, 
 		    struct intr_event *ie);
 #ifdef INTR_FILTER
@@ -125,7 +133,6 @@ static void	priv_ithread_execute_handler(struct proc *p,
 		    struct intr_handler *ih);
 #endif
 static void	ithread_loop(void *);
-#endif /* __rtems__ */
 static void	ithread_update(struct intr_thread *ithd);
 #ifndef __rtems__
 static void	start_softintr(void *);
@@ -172,6 +179,7 @@ intr_priority(enum intr_type flags)
 	return pri;
 }
 
+#endif /* __rtems__ */
 /*
  * Update an ithread based on the associated intr_event.
  */
@@ -194,10 +202,13 @@ ithread_update(struct intr_thread *ithd)
 	/* Update name and priority. */
 	strlcpy(td->td_name, ie->ie_fullname, sizeof(td->td_name));
 	thread_lock(td);
+#ifndef __rtems__
 	sched_prio(td, pri);
+#else /* __rtems__ */
+#warning TODO: set thread priority
+#endif /* __rtems__ */
 	thread_unlock(td);
 }
-#endif /* __rtems__ */
 
 /*
  * Regenerate the full name of an interrupt event and update its priority.
@@ -257,7 +268,6 @@ intr_event_update(struct intr_event *ie)
 		ithread_update(ie->ie_thread);
 	CTR2(KTR_INTR, "%s: updated %s", __func__, ie->ie_fullname);
 }
-#ifndef __rtems__
 
 int
 intr_event_create(struct intr_event **event, void *source, int flags, int irq,
@@ -296,6 +306,7 @@ intr_event_create(struct intr_event **event, void *source, int flags, int irq,
 	return (0);
 }
 
+#ifndef __rtems__
 /*
  * Bind an interrupt event to the specified CPU.  Note that not all
  * platforms support binding an interrupt to a CPU.  For those
@@ -453,6 +464,7 @@ intr_event_destroy(struct intr_event *ie)
 	return (0);
 }
 
+#endif /* __rtems__ */
 #ifndef INTR_FILTER
 static struct intr_thread *
 ithread_create(const char *name)
@@ -469,15 +481,20 @@ ithread_create(const char *name)
 	if (error)
 		panic("kproc_create() failed with %d", error);
 	thread_lock(td);
+#ifndef __rtems__
 	sched_class(td, PRI_ITHD);
 	TD_SET_IWAIT(td);
+#endif /* __rtems__ */
 	thread_unlock(td);
+#ifndef __rtems__
 	td->td_pflags |= TDP_ITHREAD;
+#endif /* __rtems__ */
 	ithd->it_thread = td;
 	CTR2(KTR_INTR, "%s: created %s", __func__, name);
 	return (ithd);
 }
 #else
+#ifndef __rtems__
 static struct intr_thread *
 ithread_create(const char *name, struct intr_handler *ih)
 {
@@ -501,7 +518,9 @@ ithread_create(const char *name, struct intr_handler *ih)
 	CTR2(KTR_INTR, "%s: created %s", __func__, name);
 	return (ithd);
 }
+#endif /* __rtems__ */
 #endif
+#ifndef __rtems__
 
 static void
 ithread_destroy(struct intr_thread *ithread)
@@ -518,8 +537,8 @@ ithread_destroy(struct intr_thread *ithread)
 	}
 	thread_unlock(td);
 }
-#endif /* __rtems__ */
 
+#endif /* __rtems__ */ 
 #ifndef INTR_FILTER
 int
 intr_event_add_handler(struct intr_event *ie, const char *name,
@@ -594,6 +613,7 @@ intr_event_add_handler(struct intr_event *ie, const char *name,
 	return (0);
 }
 #else
+#ifndef __rtems__
 int
 intr_event_add_handler(struct intr_event *ie, const char *name,
     driver_filter_t filter, driver_intr_t handler, void *arg, u_char pri,
@@ -675,6 +695,7 @@ intr_event_add_handler(struct intr_event *ie, const char *name,
 		*cookiep = ih;
 	return (0);
 }
+#endif /* __rtems__ */
 #endif
 
 #ifndef __rtems__
@@ -753,7 +774,9 @@ intr_handler_source(void *cookie)
 	return (ie->ie_source);
 }
 
+#endif /* __rtems__ */ 
 #ifndef INTR_FILTER
+#ifndef __rtems__
 int
 intr_event_remove_handler(void *cookie)
 {
@@ -843,6 +866,7 @@ ok:
 	return (0);
 }
 
+#endif /* __rtems__ */ 
 static int
 intr_event_schedule_thread(struct intr_event *ie)
 {
@@ -886,6 +910,7 @@ intr_event_schedule_thread(struct intr_event *ie)
 	 */
 	it->it_need = 1;
 	thread_lock(td);
+#ifndef __rtems__
 	if (TD_AWAITING_INTR(td)) {
 		CTR3(KTR_INTR, "%s: schedule pid %d (%s)", __func__, p->p_pid,
 		    td->td_name);
@@ -895,11 +920,19 @@ intr_event_schedule_thread(struct intr_event *ie)
 		CTR5(KTR_INTR, "%s: pid %d (%s): it_need %d, state %d",
 		    __func__, p->p_pid, td->td_name, it->it_need, td->td_state);
 	}
+#else /* __rtems__ */
+	/* Send event to wake the thread up.
+	 * TODO: eventually replace event by a better mechanism
+	 */
+	rtems_status_code sc = rtems_event_send(td->td_id, RTEMSBSD_SWI_WAKEUP_EVENT);
+	BSD_ASSERT(sc == RTEMS_SUCCESSFUL);
+#endif /* __rtems__ */
 	thread_unlock(td);
 
 	return (0);
 }
 #else
+#ifndef __rtems__
 int
 intr_event_remove_handler(void *cookie)
 {
@@ -1053,8 +1086,8 @@ intr_event_schedule_thread(struct intr_event *ie, struct intr_thread *it)
 
 	return (0);
 }
-#endif
 #endif /* __rtems__ */
+#endif
 
 /*
  * Allow interrupt event binding for software interrupt handlers -- a no-op,
@@ -1099,19 +1132,20 @@ swi_add(struct intr_event **eventp, const char *name, driver_intr_t handler,
 	    (pri * RQ_PPQ) + PI_SOFT, flags, cookiep);
 	if (error)
 		return (error);
+#ifndef __rtems__
 	if (pri == SWI_CLOCK) {
 		struct proc *p;
 		p = ie->ie_thread->it_thread->td_proc;
 		PROC_LOCK(p);
-#ifndef __rtems__
 		p->p_flag |= P_NOLOAD;
-#endif /* __rtems__ */
 		PROC_UNLOCK(p);
 	}
+#else /* __rtems__ */
+	// Do _not_ ignore the thread in the load avarage
+#endif /* __rtems__ */
 	return (0);
 }
 
-#ifndef __rtems__
 /*
  * Schedule a software interrupt thread.
  */
@@ -1133,7 +1167,9 @@ swi_sched(void *cookie, int flags)
 	atomic_store_rel_int(&ih->ih_need, 1);
 
 	if (!(flags & SWI_DELAY)) {
+#ifndef __rtems__
 		PCPU_INC(cnt.v_soft);
+#endif /* __rtems__ */ 
 #ifdef INTR_FILTER
 		error = intr_event_schedule_thread(ie, ie->ie_thread);
 #else
@@ -1143,6 +1179,7 @@ swi_sched(void *cookie, int flags)
 	}
 }
 
+#ifndef __rtems__
 /*
  * Remove a software interrupt handler.  Currently this code does not
  * remove the associated interrupt event if it becomes empty.  Calling code
@@ -1189,6 +1226,7 @@ priv_ithread_execute_handler(struct proc *p, struct intr_handler *ih)
 }
 #endif
 
+#endif /* __rtems__ */
 /*
  * This is a public function for use by drivers that mux interrupt
  * handlers for child devices from their interrupt handler.
@@ -1245,12 +1283,17 @@ static void
 ithread_execute_handlers(struct proc *p, struct intr_event *ie)
 {
 
+#ifndef __rtems__
 	/* Interrupt handlers should not sleep. */
 	if (!(ie->ie_flags & IE_SOFT))
 		THREAD_NO_SLEEPING();
 	intr_event_execute_handlers(p, ie);
 	if (!(ie->ie_flags & IE_SOFT))
 		THREAD_SLEEPING_OK();
+#else /* __rtems__ */
+	/* We only have soft-threads, so the two queries are not necessary. */
+	intr_event_execute_handlers(p, ie);
+#endif /* __rtems__ */
 
 	/*
 	 * Interrupt storm handling:
@@ -1264,12 +1307,14 @@ ithread_execute_handlers(struct proc *p, struct intr_event *ie)
 	 */
 	if (intr_storm_threshold != 0 && ie->ie_count >= intr_storm_threshold &&
 	    !(ie->ie_flags & IE_SOFT)) {
+#ifndef __rtems__
 		/* Report the message only once every second. */
 		if (ppsratecheck(&ie->ie_warntm, &ie->ie_warncnt, 1)) {
 			printf(
 	"interrupt storm detected on \"%s\"; throttling interrupt source\n",
 			    ie->ie_name);
 		}
+#endif /* __rtems__ */
 		pause("istorm", 1);
 	} else
 		ie->ie_count++;
@@ -1342,13 +1387,27 @@ ithread_loop(void *arg)
 		 */
 		thread_lock(td);
 		if (!ithd->it_need && !(ithd->it_flags & IT_DEAD)) {
+#ifndef __rtems__
 			TD_SET_IWAIT(td);
 			ie->ie_count = 0;
 			mi_switch(SW_VOL | SWT_IWAIT, NULL);
+#else /* __rtems__ */
+			/* wait for wakeup event
+			 * TODO: eventually replace event by a better mechanism
+			 */
+			rtems_event_set event_out;
+			rtems_status_code sc = rtems_event_receive(
+				RTEMSBSD_SWI_WAKEUP_EVENT,
+				RTEMS_WAIT | RTEMS_EVENT_ALL,
+				RTEMS_NO_TIMEOUT,
+				&event_out);
+			BSD_ASSERT(sc == RTEMS_SUCCESSFUL);
+#endif /* __rtems__ */
 		}
 		thread_unlock(td);
 	}
 }
+#ifndef __rtems__
 
 /*
  * Main interrupt handling body.
@@ -1444,7 +1503,9 @@ intr_event_handle(struct intr_event *ie, struct trapframe *frame)
 	td->td_intr_nesting_level--;
 	return (0);
 }
+#endif /* __rtems__ */
 #else
+#ifndef __rtems__
 /*
  * This is the main code for interrupt threads.
  */
@@ -1647,7 +1708,9 @@ intr_event_handle(struct intr_event *ie, struct trapframe *frame)
 	td->td_intr_nesting_level--;
 	return (0);
 }
+#endif /* __rtems__ */
 #endif
+#ifndef __rtems__
 
 #ifdef DDB
 /*
diff --git a/freebsd/kern/kern_timeout.c b/freebsd/kern/kern_timeout.c
new file mode 100644
index 00000000..536ca3f3
--- /dev/null
+++ b/freebsd/kern/kern_timeout.c
@@ -0,0 +1,927 @@
+#include <freebsd/machine/rtems-bsd-config.h>
+
+/*-
+ * Copyright (c) 1982, 1986, 1991, 1993
+ *	The Regents of the University of California.  All rights reserved.
+ * (c) UNIX System Laboratories, Inc.
+ * All or some portions of this file are derived from material licensed
+ * to the University of California by American Telephone and Telegraph
+ * Co. or Unix System Laboratories, Inc. and are reproduced herein with
+ * the permission of UNIX System Laboratories, Inc.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ * 4. Neither the name of the University nor the names of its contributors
+ *    may be used to endorse or promote products derived from this software
+ *    without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ *
+ *	From: @(#)kern_clock.c	8.5 (Berkeley) 1/21/94
+ */
+
+#include <freebsd/sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <freebsd/local/opt_kdtrace.h>
+
+#include <freebsd/sys/param.h>
+#include <freebsd/sys/systm.h>
+#include <freebsd/sys/bus.h>
+#include <freebsd/sys/callout.h>
+#include <freebsd/sys/condvar.h>
+#include <freebsd/sys/interrupt.h>
+#include <freebsd/sys/kernel.h>
+#include <freebsd/sys/ktr.h>
+#include <freebsd/sys/lock.h>
+#include <freebsd/sys/malloc.h>
+#include <freebsd/sys/mutex.h>
+#include <freebsd/sys/proc.h>
+#include <freebsd/sys/sdt.h>
+#include <freebsd/sys/sleepqueue.h>
+#include <freebsd/sys/sysctl.h>
+#include <freebsd/sys/smp.h>
+
+#ifdef __rtems__
+int ncallout = 16;
+#endif /* __rtems__ */ 
+SDT_PROVIDER_DEFINE(callout_execute);
+SDT_PROBE_DEFINE(callout_execute, kernel, , callout_start);
+SDT_PROBE_ARGTYPE(callout_execute, kernel, , callout_start, 0,
+    "struct callout *");
+SDT_PROBE_DEFINE(callout_execute, kernel, , callout_end); 
+SDT_PROBE_ARGTYPE(callout_execute, kernel, , callout_end, 0,
+    "struct callout *");
+
+static int avg_depth;
+SYSCTL_INT(_debug, OID_AUTO, to_avg_depth, CTLFLAG_RD, &avg_depth, 0,
+    "Average number of items examined per softclock call. Units = 1/1000");
+static int avg_gcalls;
+SYSCTL_INT(_debug, OID_AUTO, to_avg_gcalls, CTLFLAG_RD, &avg_gcalls, 0,
+    "Average number of Giant callouts made per softclock call. Units = 1/1000");
+static int avg_lockcalls;
+SYSCTL_INT(_debug, OID_AUTO, to_avg_lockcalls, CTLFLAG_RD, &avg_lockcalls, 0,
+    "Average number of lock callouts made per softclock call. Units = 1/1000");
+static int avg_mpcalls;
+SYSCTL_INT(_debug, OID_AUTO, to_avg_mpcalls, CTLFLAG_RD, &avg_mpcalls, 0,
+    "Average number of MP callouts made per softclock call. Units = 1/1000");
+/*
+ * TODO:
+ *	allocate more timeout table slots when table overflows.
+ */
+int callwheelsize, callwheelbits, callwheelmask;
+
+/*
+ * There is one struct callout_cpu per cpu, holding all relevant
+ * state for the callout processing thread on the individual CPU.
+ * In particular:
+ *	cc_ticks is incremented once per tick in callout_cpu().
+ *	It tracks the global 'ticks' but in a way that the individual
+ *	threads should not worry about races in the order in which
+ *	hardclock() and hardclock_cpu() run on the various CPUs.
+ *	cc_softclock is advanced in callout_cpu() to point to the
+ *	first entry in cc_callwheel that may need handling. In turn,
+ *	a softclock() is scheduled so it can serve the various entries i
+ *	such that cc_softclock <= i <= cc_ticks .
+ *	XXX maybe cc_softclock and cc_ticks should be volatile ?
+ *
+ *	cc_ticks is also used in callout_reset_cpu() to determine
+ *	when the callout should be served.
+ */
+struct callout_cpu {
+	struct mtx		cc_lock;
+	struct callout		*cc_callout;
+	struct callout_tailq	*cc_callwheel;
+	struct callout_list	cc_callfree;
+	struct callout		*cc_next;
+	struct callout		*cc_curr;
+	void			*cc_cookie;
+	int 			cc_ticks;
+	int 			cc_softticks;
+	int			cc_cancel;
+	int			cc_waiting;
+};
+
+#ifdef SMP
+struct callout_cpu cc_cpu[MAXCPU];
+#define	CC_CPU(cpu)	(&cc_cpu[(cpu)])
+#define	CC_SELF()	CC_CPU(PCPU_GET(cpuid))
+#else
+struct callout_cpu cc_cpu;
+#define	CC_CPU(cpu)	&cc_cpu
+#define	CC_SELF()	&cc_cpu
+#endif
+#define	CC_LOCK(cc)	mtx_lock_spin(&(cc)->cc_lock)
+#define	CC_UNLOCK(cc)	mtx_unlock_spin(&(cc)->cc_lock)
+
+static int timeout_cpu;
+
+MALLOC_DEFINE(M_CALLOUT, "callout", "Callout datastructures");
+
+/**
+ * Locked by cc_lock:
+ *   cc_curr         - If a callout is in progress, it is curr_callout.
+ *                     If curr_callout is non-NULL, threads waiting in
+ *                     callout_drain() will be woken up as soon as the
+ *                     relevant callout completes.
+ *   cc_cancel       - Changing to 1 with both callout_lock and c_lock held
+ *                     guarantees that the current callout will not run.
+ *                     The softclock() function sets this to 0 before it
+ *                     drops callout_lock to acquire c_lock, and it calls
+ *                     the handler only if curr_cancelled is still 0 after
+ *                     c_lock is successfully acquired.
+ *   cc_waiting      - If a thread is waiting in callout_drain(), then
+ *                     callout_wait is nonzero.  Set only when
+ *                     curr_callout is non-NULL.
+ */
+
+/*
+ * kern_timeout_callwheel_alloc() - kernel low level callwheel initialization 
+ *
+ *	This code is called very early in the kernel initialization sequence,
+ *	and may be called more then once.
+ */
+caddr_t
+kern_timeout_callwheel_alloc(caddr_t v)
+{
+	struct callout_cpu *cc;
+
+	timeout_cpu = PCPU_GET(cpuid);
+	cc = CC_CPU(timeout_cpu);
+	/*
+	 * Calculate callout wheel size
+	 */
+	for (callwheelsize = 1, callwheelbits = 0;
+	     callwheelsize < ncallout;
+	     callwheelsize <<= 1, ++callwheelbits)
+		;
+	callwheelmask = callwheelsize - 1;
+
+	cc->cc_callout = (struct callout *)v;
+	v = (caddr_t)(cc->cc_callout + ncallout);
+	cc->cc_callwheel = (struct callout_tailq *)v;
+	v = (caddr_t)(cc->cc_callwheel + callwheelsize);
+	return(v);
+}
+
+static void
+callout_cpu_init(struct callout_cpu *cc)
+{
+	struct callout *c;
+	int i;
+
+	mtx_init(&cc->cc_lock, "callout", NULL, MTX_SPIN | MTX_RECURSE);
+	SLIST_INIT(&cc->cc_callfree);
+	for (i = 0; i < callwheelsize; i++) {
+		TAILQ_INIT(&cc->cc_callwheel[i]);
+	}
+	if (cc->cc_callout == NULL)
+		return;
+	for (i = 0; i < ncallout; i++) {
+		c = &cc->cc_callout[i];
+		callout_init(c, 0);
+		c->c_flags = CALLOUT_LOCAL_ALLOC;
+		SLIST_INSERT_HEAD(&cc->cc_callfree, c, c_links.sle);
+	}
+}
+
+/*
+ * kern_timeout_callwheel_init() - initialize previously reserved callwheel
+ *				   space.
+ *
+ *	This code is called just once, after the space reserved for the
+ *	callout wheel has been finalized.
+ */
+void
+kern_timeout_callwheel_init(void)
+{
+	callout_cpu_init(CC_CPU(timeout_cpu));
+}
+
+/*
+ * Start standard softclock thread.
+ */
+void    *softclock_ih;
+
+static void
+start_softclock(void *dummy)
+{
+	struct callout_cpu *cc;
+#ifdef SMP
+	int cpu;
+#endif
+
+	cc = CC_CPU(timeout_cpu);
+	if (swi_add(&clk_intr_event, "clock", softclock, cc, SWI_CLOCK,
+	    INTR_MPSAFE, &softclock_ih))
+		panic("died while creating standard software ithreads");
+	cc->cc_cookie = softclock_ih;
+#ifdef SMP
+	for (cpu = 0; cpu <= mp_maxid; cpu++) {
+		if (cpu == timeout_cpu)
+			continue;
+		if (CPU_ABSENT(cpu))
+			continue;
+		cc = CC_CPU(cpu);
+		if (swi_add(NULL, "clock", softclock, cc, SWI_CLOCK,
+		    INTR_MPSAFE, &cc->cc_cookie))
+			panic("died while creating standard software ithreads");
+		cc->cc_callout = NULL;	/* Only cpu0 handles timeout(). */
+		cc->cc_callwheel = malloc(
+		    sizeof(struct callout_tailq) * callwheelsize, M_CALLOUT,
+		    M_WAITOK);
+		callout_cpu_init(cc);
+	}
+#endif
+}
+
+SYSINIT(start_softclock, SI_SUB_SOFTINTR, SI_ORDER_FIRST, start_softclock, NULL);
+
+void
+callout_tick(void)
+{
+	struct callout_cpu *cc;
+	int need_softclock;
+	int bucket;
+
+	/*
+	 * Process callouts at a very low cpu priority, so we don't keep the
+	 * relatively high clock interrupt priority any longer than necessary.
+	 */
+	need_softclock = 0;
+	cc = CC_SELF();
+	mtx_lock_spin_flags(&cc->cc_lock, MTX_QUIET);
+	cc->cc_ticks++;
+	for (; (cc->cc_softticks - cc->cc_ticks) <= 0; cc->cc_softticks++) {
+		bucket = cc->cc_softticks & callwheelmask;
+		if (!TAILQ_EMPTY(&cc->cc_callwheel[bucket])) {
+			need_softclock = 1;
+			break;
+		}
+	}
+	mtx_unlock_spin_flags(&cc->cc_lock, MTX_QUIET);
+	/*
+	 * swi_sched acquires the thread lock, so we don't want to call it
+	 * with cc_lock held; incorrect locking order.
+	 */
+	if (need_softclock)
+		swi_sched(cc->cc_cookie, 0);
+}
+
+static struct callout_cpu *
+callout_lock(struct callout *c)
+{
+	struct callout_cpu *cc;
+	int cpu;
+
+	for (;;) {
+		cpu = c->c_cpu;
+		cc = CC_CPU(cpu);
+		CC_LOCK(cc);
+		if (cpu == c->c_cpu)
+			break;
+		CC_UNLOCK(cc);
+	}
+	return (cc);
+}
+
+/*
+ * The callout mechanism is based on the work of Adam M. Costello and 
+ * George Varghese, published in a technical report entitled "Redesigning
+ * the BSD Callout and Timer Facilities" and modified slightly for inclusion
+ * in FreeBSD by Justin T. Gibbs.  The original work on the data structures
+ * used in this implementation was published by G. Varghese and T. Lauck in
+ * the paper "Hashed and Hierarchical Timing Wheels: Data Structures for
+ * the Efficient Implementation of a Timer Facility" in the Proceedings of
+ * the 11th ACM Annual Symposium on Operating Systems Principles,
+ * Austin, Texas Nov 1987.
+ */
+
+/*
+ * Software (low priority) clock interrupt.
+ * Run periodic events from timeout queue.
+ */
+void
+softclock(void *arg)
+{
+	struct callout_cpu *cc;
+	struct callout *c;
+	struct callout_tailq *bucket;
+	int curticks;
+	int steps;	/* #steps since we last allowed interrupts */
+	int depth;
+	int mpcalls;
+	int lockcalls;
+	int gcalls;
+#ifdef DIAGNOSTIC
+	struct bintime bt1, bt2;
+	struct timespec ts2;
+	static uint64_t maxdt = 36893488147419102LL;	/* 2 msec */
+	static timeout_t *lastfunc;
+#endif
+
+#ifndef MAX_SOFTCLOCK_STEPS
+#define MAX_SOFTCLOCK_STEPS 100 /* Maximum allowed value of steps. */
+#endif /* MAX_SOFTCLOCK_STEPS */
+
+	mpcalls = 0;
+	lockcalls = 0;
+	gcalls = 0;
+	depth = 0;
+	steps = 0;
+	cc = (struct callout_cpu *)arg;
+	CC_LOCK(cc);
+	while (cc->cc_softticks - 1 != cc->cc_ticks) {
+		/*
+		 * cc_softticks may be modified by hard clock, so cache
+		 * it while we work on a given bucket.
+		 */
+		curticks = cc->cc_softticks;
+		cc->cc_softticks++;
+		bucket = &cc->cc_callwheel[curticks & callwheelmask];
+		c = TAILQ_FIRST(bucket);
+		while (c) {
+			depth++;
+			if (c->c_time != curticks) {
+				c = TAILQ_NEXT(c, c_links.tqe);
+				++steps;
+				if (steps >= MAX_SOFTCLOCK_STEPS) {
+					cc->cc_next = c;
+					/* Give interrupts a chance. */
+					CC_UNLOCK(cc);
+					;	/* nothing */
+					CC_LOCK(cc);
+					c = cc->cc_next;
+					steps = 0;
+				}
+			} else {
+				void (*c_func)(void *);
+				void *c_arg;
+				struct lock_class *class;
+				struct lock_object *c_lock;
+				int c_flags, sharedlock;
+
+				cc->cc_next = TAILQ_NEXT(c, c_links.tqe);
+				TAILQ_REMOVE(bucket, c, c_links.tqe);
+				class = (c->c_lock != NULL) ?
+				    LOCK_CLASS(c->c_lock) : NULL;
+				sharedlock = (c->c_flags & CALLOUT_SHAREDLOCK) ?
+				    0 : 1;
+				c_lock = c->c_lock;
+				c_func = c->c_func;
+				c_arg = c->c_arg;
+				c_flags = c->c_flags;
+				if (c->c_flags & CALLOUT_LOCAL_ALLOC) {
+					c->c_flags = CALLOUT_LOCAL_ALLOC;
+				} else {
+					c->c_flags =
+					    (c->c_flags & ~CALLOUT_PENDING);
+				}
+				cc->cc_curr = c;
+				cc->cc_cancel = 0;
+				CC_UNLOCK(cc);
+				if (c_lock != NULL) {
+					class->lc_lock(c_lock, sharedlock);
+					/*
+					 * The callout may have been cancelled
+					 * while we switched locks.
+					 */
+					if (cc->cc_cancel) {
+						class->lc_unlock(c_lock);
+						goto skip;
+					}
+					/* The callout cannot be stopped now. */
+					cc->cc_cancel = 1;
+
+					if (c_lock == &Giant.lock_object) {
+						gcalls++;
+						CTR3(KTR_CALLOUT,
+						    "callout %p func %p arg %p",
+						    c, c_func, c_arg);
+					} else {
+						lockcalls++;
+						CTR3(KTR_CALLOUT, "callout lock"
+						    " %p func %p arg %p",
+						    c, c_func, c_arg);
+					}
+				} else {
+					mpcalls++;
+					CTR3(KTR_CALLOUT,
+					    "callout mpsafe %p func %p arg %p",
+					    c, c_func, c_arg);
+				}
+#ifdef DIAGNOSTIC
+				binuptime(&bt1);
+#endif
+#ifndef __rtems__
+				THREAD_NO_SLEEPING();
+				SDT_PROBE(callout_execute, kernel, ,
+				    callout_start, c, 0, 0, 0, 0);
+#endif /* __rtems__ */ 
+				c_func(c_arg);
+#ifndef __rtems__
+				SDT_PROBE(callout_execute, kernel, ,
+				    callout_end, c, 0, 0, 0, 0);
+				THREAD_SLEEPING_OK();
+#endif /* __rtems__ */ 
+#ifdef DIAGNOSTIC
+				binuptime(&bt2);
+				bintime_sub(&bt2, &bt1);
+				if (bt2.frac > maxdt) {
+					if (lastfunc != c_func ||
+					    bt2.frac > maxdt * 2) {
+						bintime2timespec(&bt2, &ts2);
+						printf(
+			"Expensive timeout(9) function: %p(%p) %jd.%09ld s\n",
+						    c_func, c_arg,
+						    (intmax_t)ts2.tv_sec,
+						    ts2.tv_nsec);
+					}
+					maxdt = bt2.frac;
+					lastfunc = c_func;
+				}
+#endif
+				CTR1(KTR_CALLOUT, "callout %p finished", c);
+				if ((c_flags & CALLOUT_RETURNUNLOCKED) == 0)
+					class->lc_unlock(c_lock);
+			skip:
+				CC_LOCK(cc);
+				/*
+				 * If the current callout is locally
+				 * allocated (from timeout(9))
+				 * then put it on the freelist.
+				 *
+				 * Note: we need to check the cached
+				 * copy of c_flags because if it was not
+				 * local, then it's not safe to deref the
+				 * callout pointer.
+				 */
+				if (c_flags & CALLOUT_LOCAL_ALLOC) {
+					KASSERT(c->c_flags ==
+					    CALLOUT_LOCAL_ALLOC,
+					    ("corrupted callout"));
+					c->c_func = NULL;
+					SLIST_INSERT_HEAD(&cc->cc_callfree, c,
+					    c_links.sle);
+				}
+				cc->cc_curr = NULL;
+				if (cc->cc_waiting) {
+					/*
+					 * There is someone waiting
+					 * for the callout to complete.
+					 */
+					cc->cc_waiting = 0;
+					CC_UNLOCK(cc);
+					wakeup(&cc->cc_waiting);
+					CC_LOCK(cc);
+				}
+				steps = 0;
+				c = cc->cc_next;
+			}
+		}
+	}
+	avg_depth += (depth * 1000 - avg_depth) >> 8;
+	avg_mpcalls += (mpcalls * 1000 - avg_mpcalls) >> 8;
+	avg_lockcalls += (lockcalls * 1000 - avg_lockcalls) >> 8;
+	avg_gcalls += (gcalls * 1000 - avg_gcalls) >> 8;
+	cc->cc_next = NULL;
+	CC_UNLOCK(cc);
+}
+
+/*
+ * timeout --
+ *	Execute a function after a specified length of time.
+ *
+ * untimeout --
+ *	Cancel previous timeout function call.
+ *
+ * callout_handle_init --
+ *	Initialize a handle so that using it with untimeout is benign.
+ *
+ *	See AT&T BCI Driver Reference Manual for specification.  This
+ *	implementation differs from that one in that although an 
+ *	identification value is returned from timeout, the original
+ *	arguments to timeout as well as the identifier are used to
+ *	identify entries for untimeout.
+ */
+struct callout_handle
+timeout(ftn, arg, to_ticks)
+	timeout_t *ftn;
+	void *arg;
+	int to_ticks;
+{
+	struct callout_cpu *cc;
+	struct callout *new;
+	struct callout_handle handle;
+
+	cc = CC_CPU(timeout_cpu);
+	CC_LOCK(cc);
+	/* Fill in the next free callout structure. */
+	new = SLIST_FIRST(&cc->cc_callfree);
+	if (new == NULL)
+		/* XXX Attempt to malloc first */
+		panic("timeout table full");
+	SLIST_REMOVE_HEAD(&cc->cc_callfree, c_links.sle);
+	callout_reset(new, to_ticks, ftn, arg);
+	handle.callout = new;
+	CC_UNLOCK(cc);
+
+	return (handle);
+}
+
+void
+untimeout(ftn, arg, handle)
+	timeout_t *ftn;
+	void *arg;
+	struct callout_handle handle;
+{
+	struct callout_cpu *cc;
+
+	/*
+	 * Check for a handle that was initialized
+	 * by callout_handle_init, but never used
+	 * for a real timeout.
+	 */
+	if (handle.callout == NULL)
+		return;
+
+	cc = callout_lock(handle.callout);
+	if (handle.callout->c_func == ftn && handle.callout->c_arg == arg)
+		callout_stop(handle.callout);
+	CC_UNLOCK(cc);
+}
+
+void
+callout_handle_init(struct callout_handle *handle)
+{
+	handle->callout = NULL;
+}
+
+/*
+ * New interface; clients allocate their own callout structures.
+ *
+ * callout_reset() - establish or change a timeout
+ * callout_stop() - disestablish a timeout
+ * callout_init() - initialize a callout structure so that it can
+ *	safely be passed to callout_reset() and callout_stop()
+ *
+ * <sys/callout.h> defines three convenience macros:
+ *
+ * callout_active() - returns truth if callout has not been stopped,
+ *	drained, or deactivated since the last time the callout was
+ *	reset.
+ * callout_pending() - returns truth if callout is still waiting for timeout
+ * callout_deactivate() - marks the callout as having been serviced
+ */
+int
+callout_reset_on(struct callout *c, int to_ticks, void (*ftn)(void *),
+    void *arg, int cpu)
+{
+	struct callout_cpu *cc;
+	int cancelled = 0;
+
+	/*
+	 * Don't allow migration of pre-allocated callouts lest they
+	 * become unbalanced.
+	 */
+	if (c->c_flags & CALLOUT_LOCAL_ALLOC)
+		cpu = c->c_cpu;
+retry:
+	cc = callout_lock(c);
+	if (cc->cc_curr == c) {
+		/*
+		 * We're being asked to reschedule a callout which is
+		 * currently in progress.  If there is a lock then we
+		 * can cancel the callout if it has not really started.
+		 */
+		if (c->c_lock != NULL && !cc->cc_cancel)
+			cancelled = cc->cc_cancel = 1;
+		if (cc->cc_waiting) {
+			/*
+			 * Someone has called callout_drain to kill this
+			 * callout.  Don't reschedule.
+			 */
+			CTR4(KTR_CALLOUT, "%s %p func %p arg %p",
+			    cancelled ? "cancelled" : "failed to cancel",
+			    c, c->c_func, c->c_arg);
+			CC_UNLOCK(cc);
+			return (cancelled);
+		}
+	}
+	if (c->c_flags & CALLOUT_PENDING) {
+		if (cc->cc_next == c) {
+			cc->cc_next = TAILQ_NEXT(c, c_links.tqe);
+		}
+		TAILQ_REMOVE(&cc->cc_callwheel[c->c_time & callwheelmask], c,
+		    c_links.tqe);
+
+		cancelled = 1;
+		c->c_flags &= ~(CALLOUT_ACTIVE | CALLOUT_PENDING);
+	}
+	/*
+	 * If the lock must migrate we have to check the state again as
+	 * we can't hold both the new and old locks simultaneously.
+	 */
+	if (c->c_cpu != cpu) {
+		c->c_cpu = cpu;
+		CC_UNLOCK(cc);
+		goto retry;
+	}
+
+	if (to_ticks <= 0)
+		to_ticks = 1;
+
+	c->c_arg = arg;
+	c->c_flags |= (CALLOUT_ACTIVE | CALLOUT_PENDING);
+	c->c_func = ftn;
+	c->c_time = cc->cc_ticks + to_ticks;
+	TAILQ_INSERT_TAIL(&cc->cc_callwheel[c->c_time & callwheelmask], 
+			  c, c_links.tqe);
+	CTR5(KTR_CALLOUT, "%sscheduled %p func %p arg %p in %d",
+	    cancelled ? "re" : "", c, c->c_func, c->c_arg, to_ticks);
+	CC_UNLOCK(cc);
+
+	return (cancelled);
+}
+
+/*
+ * Common idioms that can be optimized in the future.
+ */
+int
+callout_schedule_on(struct callout *c, int to_ticks, int cpu)
+{
+	return callout_reset_on(c, to_ticks, c->c_func, c->c_arg, cpu);
+}
+
+int
+callout_schedule(struct callout *c, int to_ticks)
+{
+	return callout_reset_on(c, to_ticks, c->c_func, c->c_arg, c->c_cpu);
+}
+
+int
+_callout_stop_safe(c, safe)
+	struct	callout *c;
+	int	safe;
+{
+	struct callout_cpu *cc;
+	struct lock_class *class;
+#ifndef __rtems__
+	int use_lock, sq_locked;
+#else /* __rtems__ */
+	int use_lock;
+#endif /* __rtems__ */ 
+
+	/*
+	 * Some old subsystems don't hold Giant while running a callout_stop(),
+	 * so just discard this check for the moment.
+	 */
+	if (!safe && c->c_lock != NULL) {
+		if (c->c_lock == &Giant.lock_object)
+			use_lock = mtx_owned(&Giant);
+		else {
+			use_lock = 1;
+			class = LOCK_CLASS(c->c_lock);
+			class->lc_assert(c->c_lock, LA_XLOCKED);
+		}
+	} else
+		use_lock = 0;
+
+#ifndef __rtems__
+	sq_locked = 0;
+again:
+#endif /* __rtems__ */ 
+	cc = callout_lock(c);
+	/*
+	 * If the callout isn't pending, it's not on the queue, so
+	 * don't attempt to remove it from the queue.  We can try to
+	 * stop it by other means however.
+	 */
+	if (!(c->c_flags & CALLOUT_PENDING)) {
+		c->c_flags &= ~CALLOUT_ACTIVE;
+
+		/*
+		 * If it wasn't on the queue and it isn't the current
+		 * callout, then we can't stop it, so just bail.
+		 */
+		if (cc->cc_curr != c) {
+			CTR3(KTR_CALLOUT, "failed to stop %p func %p arg %p",
+			    c, c->c_func, c->c_arg);
+			CC_UNLOCK(cc);
+#ifndef __rtems__
+			if (sq_locked)
+				sleepq_release(&cc->cc_waiting);
+#endif /* __rtems__ */ 
+			return (0);
+		}
+
+		if (safe) {
+			/*
+			 * The current callout is running (or just
+			 * about to run) and blocking is allowed, so
+			 * just wait for the current invocation to
+			 * finish.
+			 */
+			while (cc->cc_curr == c) {
+#ifndef __rtems__
+
+				/*
+				 * Use direct calls to sleepqueue interface
+				 * instead of cv/msleep in order to avoid
+				 * a LOR between cc_lock and sleepqueue
+				 * chain spinlocks.  This piece of code
+				 * emulates a msleep_spin() call actually.
+				 *
+				 * If we already have the sleepqueue chain
+				 * locked, then we can safely block.  If we
+				 * don't already have it locked, however,
+				 * we have to drop the cc_lock to lock
+				 * it.  This opens several races, so we
+				 * restart at the beginning once we have
+				 * both locks.  If nothing has changed, then
+				 * we will end up back here with sq_locked
+				 * set.
+				 */
+				if (!sq_locked) {
+					CC_UNLOCK(cc);
+					sleepq_lock(&cc->cc_waiting);
+					sq_locked = 1;
+					goto again;
+				}
+				cc->cc_waiting = 1;
+				DROP_GIANT();
+				CC_UNLOCK(cc);
+				sleepq_add(&cc->cc_waiting,
+				    &cc->cc_lock.lock_object, "codrain",
+				    SLEEPQ_SLEEP, 0);
+				sleepq_wait(&cc->cc_waiting, 0);
+				sq_locked = 0;
+
+				/* Reacquire locks previously released. */
+				PICKUP_GIANT();
+				CC_LOCK(cc);
+#else /* __rtems__ */
+				BSD_ASSERT(0);
+#endif /* __rtems__ */ 
+			}
+		} else if (use_lock && !cc->cc_cancel) {
+			/*
+			 * The current callout is waiting for its
+			 * lock which we hold.  Cancel the callout
+			 * and return.  After our caller drops the
+			 * lock, the callout will be skipped in
+			 * softclock().
+			 */
+			cc->cc_cancel = 1;
+			CTR3(KTR_CALLOUT, "cancelled %p func %p arg %p",
+			    c, c->c_func, c->c_arg);
+			CC_UNLOCK(cc);
+			KASSERT(!sq_locked, ("sleepqueue chain locked"));
+			return (1);
+		}
+		CTR3(KTR_CALLOUT, "failed to stop %p func %p arg %p",
+		    c, c->c_func, c->c_arg);
+		CC_UNLOCK(cc);
+		KASSERT(!sq_locked, ("sleepqueue chain still locked"));
+		return (0);
+	}
+#ifndef __rtems__
+	if (sq_locked)
+		sleepq_release(&cc->cc_waiting);
+#endif /* __rtems__ */ 
+
+	c->c_flags &= ~(CALLOUT_ACTIVE | CALLOUT_PENDING);
+
+	if (cc->cc_next == c) {
+		cc->cc_next = TAILQ_NEXT(c, c_links.tqe);
+	}
+	TAILQ_REMOVE(&cc->cc_callwheel[c->c_time & callwheelmask], c,
+	    c_links.tqe);
+
+	CTR3(KTR_CALLOUT, "cancelled %p func %p arg %p",
+	    c, c->c_func, c->c_arg);
+
+	if (c->c_flags & CALLOUT_LOCAL_ALLOC) {
+		c->c_func = NULL;
+		SLIST_INSERT_HEAD(&cc->cc_callfree, c, c_links.sle);
+	}
+	CC_UNLOCK(cc);
+	return (1);
+}
+
+void
+callout_init(c, mpsafe)
+	struct	callout *c;
+	int mpsafe;
+{
+	bzero(c, sizeof *c);
+	if (mpsafe) {
+		c->c_lock = NULL;
+		c->c_flags = CALLOUT_RETURNUNLOCKED;
+	} else {
+		c->c_lock = &Giant.lock_object;
+		c->c_flags = 0;
+	}
+	c->c_cpu = timeout_cpu;
+}
+
+void
+_callout_init_lock(c, lock, flags)
+	struct	callout *c;
+	struct	lock_object *lock;
+	int flags;
+{
+	bzero(c, sizeof *c);
+	c->c_lock = lock;
+	KASSERT((flags & ~(CALLOUT_RETURNUNLOCKED | CALLOUT_SHAREDLOCK)) == 0,
+	    ("callout_init_lock: bad flags %d", flags));
+	KASSERT(lock != NULL || (flags & CALLOUT_RETURNUNLOCKED) == 0,
+	    ("callout_init_lock: CALLOUT_RETURNUNLOCKED with no lock"));
+	KASSERT(lock == NULL || !(LOCK_CLASS(lock)->lc_flags &
+	    (LC_SPINLOCK | LC_SLEEPABLE)), ("%s: invalid lock class",
+	    __func__));
+	c->c_flags = flags & (CALLOUT_RETURNUNLOCKED | CALLOUT_SHAREDLOCK);
+	c->c_cpu = timeout_cpu;
+}
+
+#ifdef APM_FIXUP_CALLTODO
+/* 
+ * Adjust the kernel calltodo timeout list.  This routine is used after 
+ * an APM resume to recalculate the calltodo timer list values with the 
+ * number of hz's we have been sleeping.  The next hardclock() will detect 
+ * that there are fired timers and run softclock() to execute them.
+ *
+ * Please note, I have not done an exhaustive analysis of what code this
+ * might break.  I am motivated to have my select()'s and alarm()'s that
+ * have expired during suspend firing upon resume so that the applications
+ * which set the timer can do the maintanence the timer was for as close
+ * as possible to the originally intended time.  Testing this code for a 
+ * week showed that resuming from a suspend resulted in 22 to 25 timers 
+ * firing, which seemed independant on whether the suspend was 2 hours or
+ * 2 days.  Your milage may vary.   - Ken Key <key@cs.utk.edu>
+ */
+void
+adjust_timeout_calltodo(time_change)
+    struct timeval *time_change;
+{
+	register struct callout *p;
+	unsigned long delta_ticks;
+
+	/* 
+	 * How many ticks were we asleep?
+	 * (stolen from tvtohz()).
+	 */
+
+	/* Don't do anything */
+	if (time_change->tv_sec < 0)
+		return;
+	else if (time_change->tv_sec <= LONG_MAX / 1000000)
+		delta_ticks = (time_change->tv_sec * 1000000 +
+			       time_change->tv_usec + (tick - 1)) / tick + 1;
+	else if (time_change->tv_sec <= LONG_MAX / hz)
+		delta_ticks = time_change->tv_sec * hz +
+			      (time_change->tv_usec + (tick - 1)) / tick + 1;
+	else
+		delta_ticks = LONG_MAX;
+
+	if (delta_ticks > INT_MAX)
+		delta_ticks = INT_MAX;
+
+	/* 
+	 * Now rip through the timer calltodo list looking for timers
+	 * to expire.
+	 */
+
+	/* don't collide with softclock() */
+	CC_LOCK(cc);
+	for (p = calltodo.c_next; p != NULL; p = p->c_next) {
+		p->c_time -= delta_ticks;
+
+		/* Break if the timer had more time on it than delta_ticks */
+		if (p->c_time > 0)
+			break;
+
+		/* take back the ticks the timer didn't use (p->c_time <= 0) */
+		delta_ticks = -p->c_time;
+	}
+	CC_UNLOCK(cc);
+
+	return;
+}
+#endif /* APM_FIXUP_CALLTODO */
diff --git a/freebsd/sys/callout.h b/freebsd/sys/callout.h
index ed4e20eb..4686a4db 100644
--- a/freebsd/sys/callout.h
+++ b/freebsd/sys/callout.h
@@ -46,23 +46,16 @@ SLIST_HEAD(callout_list, callout);
 TAILQ_HEAD(callout_tailq, callout);
 
 struct callout {
-#ifndef __rtems__
 	union {
 		SLIST_ENTRY(callout) sle;
 		TAILQ_ENTRY(callout) tqe;
 	} c_links;
 	int	c_time;				/* ticks to the event */
-#else /* __rtems__ */
-	rtems_chain_node c_node;
-	rtems_id c_id;
-#endif /* __rtems__ */
 	void	*c_arg;				/* function argument */
 	void	(*c_func)(void *);		/* function to call */
 	struct lock_object *c_lock;		/* lock to handle */
 	int	c_flags;			/* state of this entry */
-#ifndef __rtems__
 	volatile int c_cpu;			/* CPU we're scheduled on */
-#endif /* __rtems__ */
 };
 
 #define	CALLOUT_LOCAL_ALLOC	0x0001 /* was allocated from callfree */
@@ -92,12 +85,8 @@ void	_callout_init_lock(struct callout *, struct lock_object *, int);
 	   NULL, (flags))
 #define	callout_pending(c)	((c)->c_flags & CALLOUT_PENDING)
 int	callout_reset_on(struct callout *, int, void (*)(void *), void *, int);
-#ifndef __rtems__
 #define	callout_reset(c, on_tick, fn, arg)				\
     callout_reset_on((c), (on_tick), (fn), (arg), (c)->c_cpu)
-#else /* __rtems__ */
-int callout_reset(struct callout *, int, void (*)(void *), void *);
-#endif /* __rtems__ */
 #define	callout_reset_curcpu(c, on_tick, fn, arg)			\
     callout_reset_on((c), (on_tick), (fn), (arg), PCPU_GET(cpuid))
 int	callout_schedule(struct callout *, int);
diff --git a/freebsd/sys/mutex.h b/freebsd/sys/mutex.h
index 434a1eaf..0e8e1739 100644
--- a/freebsd/sys/mutex.h
+++ b/freebsd/sys/mutex.h
@@ -122,10 +122,15 @@ void	_mtx_unlock_spin(struct mtx *m, int opts, const char *file, int line);
 int	_mtx_trylock(struct mtx *m, int opts, const char *file, int line);
 void	_mtx_lock_flags(struct mtx *m, int opts, const char *file, int line);
 void	_mtx_unlock_flags(struct mtx *m, int opts, const char *file, int line);
+#ifndef __rtems__
 void	_mtx_lock_spin_flags(struct mtx *m, int opts, const char *file,
 	     int line);
 void	_mtx_unlock_spin_flags(struct mtx *m, int opts, const char *file,
 	     int line);
+#else /* __rtems__ */
+#define _mtx_lock_spin_flags _mtx_lock_flags
+#define _mtx_unlock_spin_flags _mtx_unlock_flags
+#endif /* __rtems__ */ 
 #if defined(INVARIANTS) || defined(INVARIANT_SUPPORT)
 void	_mtx_assert(struct mtx *m, int what, const char *file, int line);
 #endif
diff --git a/freebsd/sys/sleepqueue.h b/freebsd/sys/sleepqueue.h
new file mode 100644
index 00000000..936ffd88
--- /dev/null
+++ b/freebsd/sys/sleepqueue.h
@@ -0,0 +1 @@
+/* EMPTY */
diff --git a/rtemsbsd/freebsd/machine/rtems-bsd-symbols.h b/rtemsbsd/freebsd/machine/rtems-bsd-symbols.h
index 0fdfda52..c58259dc 100644
--- a/rtemsbsd/freebsd/machine/rtems-bsd-symbols.h
+++ b/rtemsbsd/freebsd/machine/rtems-bsd-symbols.h
@@ -136,11 +136,6 @@
 #define bus_teardown_intr_method_default _bsd_bus_teardown_intr_method_default
 #define bus_write_ivar_desc _bsd_bus_write_ivar_desc
 #define bus_write_ivar_method_default _bsd_bus_write_ivar_method_default
-#define callout_init _bsd_callout_init
-#define _callout_init_lock _bsd__callout_init_lock
-#define callout_reset _bsd_callout_reset
-#define callout_schedule _bsd_callout_schedule
-#define _callout_stop_safe _bsd__callout_stop_safe
 #define cam_fetch_status_entry _bsd_cam_fetch_status_entry
 #define cam_quirkmatch _bsd_cam_quirkmatch
 #define cam_sim_alloc _bsd_cam_sim_alloc
diff --git a/rtemsbsd/src/rtems-bsd-callout.c b/rtemsbsd/src/rtems-bsd-callout.c
deleted file mode 100644
index 25fd4106..00000000
--- a/rtemsbsd/src/rtems-bsd-callout.c
+++ /dev/null
@@ -1,140 +0,0 @@
-/**
- * @file
- *
- * @ingroup rtems_bsd_rtems
- *
- * @brief TODO.
- */
-
-/*
- * Copyright (c) 2009, 2010 embedded brains GmbH.  
- * All rights reserved.
- *
- *  embedded brains GmbH
- *  Obere Lagerstr. 30
- *  82178 Puchheim
- *  Germany
- *  <rtems@embedded-brains.de>
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- * 1. Redistributions of source code must retain the above copyright
- *    notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- *    notice, this list of conditions and the following disclaimer in the
- *    documentation and/or other materials provided with the distribution.
- *
- * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
- * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
- * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
- * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
- * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
- * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
- * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
- * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
- * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
- * SUCH DAMAGE.
- */
-
-#include <freebsd/machine/rtems-bsd-config.h>
-
-#include <freebsd/sys/param.h>
-#include <freebsd/sys/types.h>
-#include <freebsd/sys/systm.h>
-#include <freebsd/sys/callout.h>
-#include <freebsd/sys/lock.h>
-#include <freebsd/sys/mutex.h>
-
-RTEMS_CHAIN_DEFINE_EMPTY(rtems_bsd_callout_chain);
-
-static void
-rtems_bsd_callout_dispatch(rtems_id id, void *arg)
-{
-	rtems_status_code sc = RTEMS_SUCCESSFUL;
-	struct callout *c = arg;
-
-	if (c->c_lock != NULL) {
-		sc = rtems_semaphore_obtain(c->c_lock->lo_id, RTEMS_WAIT, RTEMS_NO_TIMEOUT);
-		BSD_ASSERT_SC(sc);
-	}
-
-	if (c->c_func != NULL) {
-		(*c->c_func)(c->c_arg);
-	}
-
-	if (c->c_lock != NULL && (c->c_flags & CALLOUT_RETURNUNLOCKED) == 0) {
-		sc = rtems_semaphore_release(c->c_lock->lo_id);
-		BSD_ASSERT_SC(sc);
-	}
-}
-
-void
-callout_init(struct callout *c, int mpsafe)
-{
-	_callout_init_lock(c, mpsafe ? NULL : &Giant.lock_object, mpsafe ? CALLOUT_RETURNUNLOCKED : 0);
-}
-
-void
-_callout_init_lock(struct callout *c, struct lock_object *lock, int flags)
-{
-	rtems_status_code sc = RTEMS_SUCCESSFUL;
-	rtems_id id = RTEMS_ID_NONE;
-
-	sc = rtems_timer_create(rtems_build_name('_', 'T', 'M', 'R'), &id);
-	BSD_ASSERT_SC(sc);
-
-	c->c_id = id;
-	c->c_lock = lock;
-	c->c_flags = flags;
-	c->c_func = NULL;
-	c->c_arg = NULL;
-
-	rtems_chain_append(&rtems_bsd_callout_chain, &c->c_node);
-}
-
-int
-callout_reset(struct callout *c, int to_ticks, void (*ftn)(void *), void *arg)
-{
-	/* FIXME: Integer conversions */
-
-	rtems_status_code sc = RTEMS_SUCCESSFUL;
-
-	if (to_ticks <= 0) {
-		to_ticks = 1;
-	}
-
-	c->c_func = ftn;
-	c->c_arg = arg;
-
-	sc = rtems_timer_server_fire_after(c->c_id, (rtems_interval) to_ticks, rtems_bsd_callout_dispatch, c);
-	BSD_ASSERT_SC(sc);
-
-	return 0;
-}
-
-int
-callout_schedule(struct callout *c, int to_ticks)
-{
-	return callout_reset(c, to_ticks, c->c_func, c->c_arg);
-}
-
-int
-_callout_stop_safe(struct callout *c, int safe)
-{
-	rtems_status_code sc = RTEMS_SUCCESSFUL;
-
-	if (!safe) {
-		sc = rtems_timer_cancel(c->c_id);
-		BSD_ASSERT_SC(sc);
-	} else {
-		sc = rtems_timer_delete(c->c_id);
-		BSD_ASSERT_SC(sc);
-
-		c->c_id = RTEMS_ID_NONE;
-		rtems_chain_extract(&c->c_node);
-	}
-
-	return 0;
-}
diff --git a/rtemsbsd/src/rtems-bsd-shell.c b/rtemsbsd/src/rtems-bsd-shell.c
index 786b7124..f80e9371 100644
--- a/rtemsbsd/src/rtems-bsd-shell.c
+++ b/rtemsbsd/src/rtems-bsd-shell.c
@@ -52,23 +52,6 @@
 #include <rtems/shell.h>
 
 static void
-rtems_bsd_dump_callout(void)
-{
-	rtems_chain_control *chain = &rtems_bsd_callout_chain;
-	rtems_chain_node *node = rtems_chain_first(chain);
-
-	printf("callout dump:\n");
-
-	while (!rtems_chain_is_tail(chain, node)) {
-		struct callout *c = (struct callout *) node;
-
-		printf("\t%08x\n", c->c_id);
-
-		node = rtems_chain_next(node);
-	}
-}
-
-static void
 rtems_bsd_dump_mtx(void)
 {
 	rtems_chain_control *chain = &rtems_bsd_mtx_chain;
@@ -169,10 +152,6 @@ rtems_bsd_info(int argc, char **argv)
 			rtems_bsd_dump_thread();
 			usage = false;
 		}
-		if (CMP("callout")) {
-			rtems_bsd_dump_callout();
-			usage = false;
-		}
 	}
 
 	if (usage) {
diff --git a/rtemsbsd/src/rtems-bsd-timeout.c b/rtemsbsd/src/rtems-bsd-timeout.c
deleted file mode 100644
index 0055c42e..00000000
--- a/rtemsbsd/src/rtems-bsd-timeout.c
+++ /dev/null
@@ -1,129 +0,0 @@
-/**
- * @file
- *
- * @ingroup rtems_bsd_rtems
- *
- * @brief TODO.
- */
-
-/*
- * COPYRIGHT (c) 2012.
- * On-Line Applications Research Corporation (OAR).
- * All rights reserved.
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- * 1. Redistributions of source code must retain the above copyright
- *    notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- *    notice, this list of conditions and the following disclaimer in the
- *    documentation and/or other materials provided with the distribution.
- *
- * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
- * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
- * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
- * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
- * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
- * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
- * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
- * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
- * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
- * SUCH DAMAGE.
- */
-
-#include <freebsd/machine/rtems-bsd-config.h>
-#include <freebsd/sys/cdefs.h>
-__FBSDID("$FreeBSD$");
-
-#include <freebsd/sys/param.h>
-#include <freebsd/sys/systm.h>
-#include <freebsd/sys/bus.h>
-#include <freebsd/sys/callout.h>
-#include <freebsd/sys/condvar.h>
-#include <freebsd/sys/interrupt.h>
-#include <freebsd/sys/kernel.h>
-#include <freebsd/sys/ktr.h>
-#include <freebsd/sys/lock.h>
-#include <freebsd/sys/malloc.h>
-#include <freebsd/sys/mutex.h>
-#include <freebsd/sys/proc.h>
-#include <freebsd/sys/sdt.h>
-
-static int timeout_cpu;
-/*
- * There is one struct callout_cpu per cpu, holding all relevant
- * state for the callout processing thread on the individual CPU.
- * In particular:
- *	cc_ticks is incremented once per tick in callout_cpu().
- *	It tracks the global 'ticks' but in a way that the individual
- *	threads should not worry about races in the order in which
- *	hardclock() and hardclock_cpu() run on the various CPUs.
- *	cc_softclock is advanced in callout_cpu() to point to the
- *	first entry in cc_callwheel that may need handling. In turn,
- *	a softclock() is scheduled so it can serve the various entries i
- *	such that cc_softclock <= i <= cc_ticks .
- *	XXX maybe cc_softclock and cc_ticks should be volatile ?
- *
- *	cc_ticks is also used in callout_reset_cpu() to determine
- *	when the callout should be served.
- */
-struct callout_cpu {
-	struct mtx		cc_lock;
-	struct callout		*cc_callout;
-	struct callout_tailq	*cc_callwheel;
-	struct callout_list	cc_callfree;
-	struct callout		*cc_next;
-	struct callout		*cc_curr;
-	void			*cc_cookie;
-	int 			cc_ticks;
-	int 			cc_softticks;
-	int			cc_cancel;
-	int			cc_waiting;
-};
-
-/*
- * timeout --
- *	Execute a function after a specified length of time.
- *
- * untimeout --
- *	Cancel previous timeout function call.
- *
- * callout_handle_init --
- *	Initialize a handle so that using it with untimeout is benign.
- *
- *	See AT&T BCI Driver Reference Manual for specification.  This
- *	implementation differs from that one in that although an 
- *	identification value is returned from timeout, the original
- *	arguments to timeout as well as the identifier are used to
- *	identify entries for untimeout.
- */
-
-struct callout_handle
-timeout(ftn, arg, to_ticks)
-	timeout_t *ftn;
-	void *arg;
-	int to_ticks;
-{
-	struct callout_cpu *cc;
-	struct callout *new;
-	struct callout_handle handle;
-
-#if 0
-	cc = CC_CPU(timeout_cpu);
-	CC_LOCK(cc);
-	/* Fill in the next free callout structure. */
-	new = SLIST_FIRST(&cc->cc_callfree);
-	if (new == NULL)
-		/* XXX Attempt to malloc first */
-		panic("timeout table full");
-	SLIST_REMOVE_HEAD(&cc->cc_callfree, c_links.sle);
-	callout_reset(new, to_ticks, ftn, arg);
-	handle.callout = new;
-	CC_UNLOCK(cc);
-#endif
-	return (handle);
-}
-
-
diff --git a/testsuite/swi01/Makefile b/testsuite/swi01/Makefile
new file mode 100644
index 00000000..dd7c6882
--- /dev/null
+++ b/testsuite/swi01/Makefile
@@ -0,0 +1,29 @@
+include ../../config.inc
+
+include $(RTEMS_MAKEFILE_PATH)/Makefile.inc
+include $(RTEMS_CUSTOM)
+include $(PROJECT_ROOT)/make/leaf.cfg
+
+APP_PIECES = init swi_test
+
+APP_O_FILES = $(APP_PIECES:%=%.o)
+APP_DEP_FILES = $(APP_PIECES:%=%.dep)
+
+APP = app.exe
+
+DEPFLAGS = -MT $@ -MD -MP -MF $*.dep
+AM_CPPFLAGS += -I $(INSTALL_BASE)/include -I.
+
+CFLAGS += $(DEPFLAGS) $(GCCFLAGS) $(AM_CPPFLAGS) -Wno-unused -Wl,-Map,app.map
+
+LINK_LIBS += $(INSTALL_BASE)/libbsd.a
+
+all: $(APP)
+
+$(APP): $(APP_O_FILES)
+	$(CC) $(CFLAGS) $^ $(LINK_LIBS) -o $(APP)
+
+clean:
+	rm -f app.map $(APP) $(APP_O_FILES) $(APP_DEP_FILES)
+
+-include $(APP_DEP_FILES)
diff --git a/testsuite/swi01/init.c b/testsuite/swi01/init.c
new file mode 100644
index 00000000..9bc13dc6
--- /dev/null
+++ b/testsuite/swi01/init.c
@@ -0,0 +1,76 @@
+/*
+ * Copyright (c) 2012 embedded brains GmbH.  All rights reserved.
+ *
+ *  embedded brains GmbH
+ *  Obere Lagerstr. 30
+ *  82178 Puchheim
+ *  Germany
+ *  <rtems@embedded-brains.de>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+#include <stdlib.h>
+#include <assert.h>
+
+#include <rtems.h>
+
+#include <freebsd/bsd.h>
+
+#include "swi_test.h"
+
+static void Init(rtems_task_argument arg)
+{
+	rtems_status_code sc;
+
+	puts("\n\n*** TEST SOFTWARE INTERRUPT 1 ***");
+
+	sc = rtems_bsd_initialize();
+	assert(sc == RTEMS_SUCCESSFUL);
+
+	swi_test();
+
+	puts("*** END OF TEST SOFTWARE INTERRUPT 1 ***");
+
+	exit(0);
+}
+
+#define CONFIGURE_APPLICATION_NEEDS_CLOCK_DRIVER
+#define CONFIGURE_APPLICATION_NEEDS_CONSOLE_DRIVER
+
+#define CONFIGURE_USE_IMFS_AS_BASE_FILESYSTEM
+
+#define CONFIGURE_FILESYSTEM_IMFS
+
+#define CONFIGURE_LIBIO_MAXIMUM_FILE_DESCRIPTORS 32
+
+#define CONFIGURE_UNLIMITED_OBJECTS
+
+#define CONFIGURE_UNIFIED_WORK_AREAS
+
+#define CONFIGURE_RTEMS_INIT_TASKS_TABLE
+
+#define CONFIGURE_STACK_CHECKER_ENABLED
+
+#define CONFIGURE_INIT
+
+#include <rtems/confdefs.h>
diff --git a/testsuite/swi01/swi_test.c b/testsuite/swi01/swi_test.c
new file mode 100644
index 00000000..99ba94f4
--- /dev/null
+++ b/testsuite/swi01/swi_test.c
@@ -0,0 +1,208 @@
+/*
+ * Copyright (c) 2012 embedded brains GmbH.  All rights reserved.
+ *
+ *  embedded brains GmbH
+ *  Obere Lagerstr. 30
+ *  82178 Puchheim
+ *  Germany
+ *  <rtems@embedded-brains.de>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+#include <assert.h>
+
+#include <stdio.h>
+#include <unistd.h>
+
+#include <freebsd/machine/rtems-bsd-config.h>
+
+#include <freebsd/sys/types.h>
+#include <freebsd/sys/systm.h>
+
+#include <freebsd/sys/param.h>
+#include <freebsd/sys/bus.h>
+#include <freebsd/sys/interrupt.h>
+
+#define SWI_TEST_THREAD_PRIO (0)
+
+// Time to wait for swi-test-handler
+#define SWI_SLEEP_TIME (100)
+
+enum arg {
+	HANDLER_NOT_VISITED,
+	HANDLER_VISITED,
+};
+
+// The swi handler function, that will be called by all tests.
+void swi_test_handler(void *arg)
+{
+	enum arg* argument = arg;
+
+	printf("This is swi_test_handler.\n");
+
+	*argument = HANDLER_VISITED;
+}
+
+void swi_test_normal_handler()
+{
+	struct intr_event *test_intr_event = NULL;
+	enum arg argument = HANDLER_NOT_VISITED;
+	void *test_ih = NULL;
+	int retval = 0;
+
+	printf("== Create thread and install a functional handler.\n");
+
+	retval = swi_add(&test_intr_event, "swi_test", swi_test_handler, &argument,
+		SWI_TEST_THREAD_PRIO, 0, &test_ih);
+	assert(retval == 0);
+
+	swi_sched(test_ih, 0);
+
+	usleep(SWI_SLEEP_TIME);
+	
+	assert(argument == HANDLER_VISITED);
+}
+
+void swi_test_exclusive_handler()
+{
+	struct intr_event *test_intr_event = NULL;
+	enum arg argument = HANDLER_NOT_VISITED;
+	void *test_ih = NULL;
+	int retval = 0;
+
+	printf("== Create a thread with a exclusive handler.\n");
+
+	retval = swi_add(&test_intr_event, "swi_test", swi_test_handler, &argument,
+		SWI_TEST_THREAD_PRIO, INTR_EXCL, &test_ih);
+	assert(retval == 0);
+
+	swi_sched(test_ih, 0);
+	
+	usleep(SWI_SLEEP_TIME);
+	
+	assert(argument == HANDLER_VISITED);
+}
+
+void swi_test_error_number_of_processes_exceeded()
+{
+	// [EAGAIN] The system-imposed limit on the total number of processes
+	// under execution would be exceeded.  The limit is given by the
+	// sysctl(3) MIB variable KERN_MAXPROC.
+#warning TODO: write test case
+}
+
+void swi_test_error_intr_entropy_set()
+{
+	struct intr_event *test_intr_event = NULL;
+	enum arg argument = HANDLER_NOT_VISITED;
+	void *test_ih = NULL;
+	int retval = 0;
+
+	printf("== Set the INTR_ENTROPY flag.\n");
+
+	retval = swi_add(&test_intr_event, "swi_test", swi_test_handler, &argument,
+		SWI_TEST_THREAD_PRIO, INTR_ENTROPY, &test_ih);
+	assert(retval == EINVAL);
+	
+	usleep(SWI_SLEEP_TIME);
+	
+	assert(argument == HANDLER_NOT_VISITED);
+}
+
+void swi_test_error_point_to_hardware_interrupt_thread()
+{
+	//[EINVAL] The ithdp argument points to a hardware interrupt thread.
+#warning TODO: write test case
+}
+	
+void swi_test_error_name_null()
+{
+	struct intr_event *test_intr_event = NULL;
+	enum arg argument = HANDLER_NOT_VISITED;
+	void *test_ih = NULL;
+	int retval = 0;
+
+	printf("== Set name to NULL.\n");
+
+	retval = swi_add(&test_intr_event, NULL, swi_test_handler, &argument,
+		SWI_TEST_THREAD_PRIO, 0, &test_ih);
+	assert(retval == EINVAL);
+	
+	usleep(SWI_SLEEP_TIME);
+	
+	assert(argument == HANDLER_NOT_VISITED);
+}
+
+void swi_test_error_handler_null()
+{
+	struct intr_event *test_intr_event = NULL;
+	enum arg argument = HANDLER_NOT_VISITED;
+	void *test_ih = NULL;
+	int retval = 0;
+
+	printf("== Set handler to NULL.\n");
+
+	retval = swi_add(&test_intr_event, "swi_test", NULL, &argument,
+		SWI_TEST_THREAD_PRIO, 0, &test_ih);
+	assert(retval == EINVAL);
+	
+	usleep(SWI_SLEEP_TIME);
+	
+	assert(argument == HANDLER_NOT_VISITED);
+}
+
+void swi_test_error_has_allready_exclusive()
+{
+	struct intr_event *test_intr_event = NULL;
+	enum arg argument = HANDLER_NOT_VISITED;
+	void *test_ih1 = NULL;
+	void *test_ih2 = NULL;
+	int retval = 0;
+
+	printf("== Create a thread with a exclusive handler and try to add another handler.\n");
+
+	retval = swi_add(&test_intr_event, "swi_test1", swi_test_handler, &argument,
+		SWI_TEST_THREAD_PRIO, INTR_EXCL, &test_ih1);
+	assert(retval == 0);
+
+	retval = swi_add(&test_intr_event, "swi_test2", swi_test_handler, &argument,
+		SWI_TEST_THREAD_PRIO, 0, &test_ih2);
+	assert(retval == EINVAL);
+	
+	usleep(SWI_SLEEP_TIME);
+	
+	assert(argument == HANDLER_NOT_VISITED);
+}
+
+void swi_test(void)
+{
+	swi_test_normal_handler();
+	swi_test_exclusive_handler();
+	swi_test_error_number_of_processes_exceeded();
+	swi_test_error_intr_entropy_set();
+	swi_test_error_point_to_hardware_interrupt_thread();
+	swi_test_error_name_null();
+	swi_test_error_handler_null();
+	swi_test_error_has_allready_exclusive();
+}
+
diff --git a/testsuite/swi01/swi_test.h b/testsuite/swi01/swi_test.h
new file mode 100644
index 00000000..e7708b6c
--- /dev/null
+++ b/testsuite/swi01/swi_test.h
@@ -0,0 +1,45 @@
+/*
+ * Copyright (c) 2012 embedded brains GmbH.  All rights reserved.
+ *
+ *  embedded brains GmbH
+ *  Obere Lagerstr. 30
+ *  82178 Puchheim
+ *  Germany
+ *  <rtems@embedded-brains.de>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+#ifndef SWI_TEST_H
+#define SWI_TEST_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif /* __cplusplus */
+
+void swi_test(void);
+
+#ifdef __cplusplus
+}
+#endif /* __cplusplus */
+
+#endif /* TEST_H */
diff --git a/testsuite/timeout01/Makefile b/testsuite/timeout01/Makefile
new file mode 100644
index 00000000..6e38da14
--- /dev/null
+++ b/testsuite/timeout01/Makefile
@@ -0,0 +1,29 @@
+include ../../config.inc
+
+include $(RTEMS_MAKEFILE_PATH)/Makefile.inc
+include $(RTEMS_CUSTOM)
+include $(PROJECT_ROOT)/make/leaf.cfg
+
+APP_PIECES = init timeout_test timeout_helper
+
+APP_O_FILES = $(APP_PIECES:%=%.o)
+APP_DEP_FILES = $(APP_PIECES:%=%.dep)
+
+APP = app.exe
+
+DEPFLAGS = -MT $@ -MD -MP -MF $*.dep
+AM_CPPFLAGS += -I $(INSTALL_BASE)/include -I.
+
+CFLAGS += $(DEPFLAGS) $(GCCFLAGS) $(AM_CPPFLAGS) -Wno-unused -Wl,-Map,app.map
+
+LINK_LIBS += $(INSTALL_BASE)/libbsd.a
+
+all: $(APP)
+
+$(APP): $(APP_O_FILES)
+	$(CC) $(CFLAGS) $^ $(LINK_LIBS) -o $(APP)
+
+clean:
+	rm -f app.map $(APP) $(APP_O_FILES) $(APP_DEP_FILES)
+
+-include $(APP_DEP_FILES)
diff --git a/testsuite/timeout01/init.c b/testsuite/timeout01/init.c
new file mode 100644
index 00000000..f1bd5291
--- /dev/null
+++ b/testsuite/timeout01/init.c
@@ -0,0 +1,81 @@
+/*
+ * Copyright (c) 2012 embedded brains GmbH.  All rights reserved.
+ *
+ *  embedded brains GmbH
+ *  Obere Lagerstr. 30
+ *  82178 Puchheim
+ *  Germany
+ *  <rtems@embedded-brains.de>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+#include <stdlib.h>
+#include <stdio.h>
+#include <assert.h>
+
+#include <rtems.h>
+
+#include <freebsd/bsd.h>
+
+#include "timeout_test.h"
+#include "timeout_helper.h"
+
+static void Init(rtems_task_argument arg)
+{
+	rtems_status_code sc;
+
+	puts("\n\n*** TEST TIMOUT 1 ***");
+
+	sc = rtems_bsd_initialize();
+	assert(sc == RTEMS_SUCCESSFUL);
+
+	timeout_table_init();
+	callout_tick_task_init();
+
+	timeout_test();
+
+	puts("*** END OF TEST TIMOUT 1 ***");
+
+	exit(0);
+}
+
+#define CONFIGURE_APPLICATION_NEEDS_CLOCK_DRIVER
+#define CONFIGURE_APPLICATION_NEEDS_CONSOLE_DRIVER
+
+#define CONFIGURE_USE_IMFS_AS_BASE_FILESYSTEM
+
+#define CONFIGURE_FILESYSTEM_IMFS
+
+#define CONFIGURE_LIBIO_MAXIMUM_FILE_DESCRIPTORS 32
+
+#define CONFIGURE_UNLIMITED_OBJECTS
+
+#define CONFIGURE_UNIFIED_WORK_AREAS
+
+#define CONFIGURE_RTEMS_INIT_TASKS_TABLE
+
+#define CONFIGURE_STACK_CHECKER_ENABLED
+
+#define CONFIGURE_INIT
+
+#include <rtems/confdefs.h>
diff --git a/testsuite/timeout01/timeout_helper.c b/testsuite/timeout01/timeout_helper.c
new file mode 100644
index 00000000..88d8510d
--- /dev/null
+++ b/testsuite/timeout01/timeout_helper.c
@@ -0,0 +1,142 @@
+/*
+ * Copyright (c) 2012 embedded brains GmbH.  All rights reserved.
+ *
+ *  embedded brains GmbH
+ *  Obere Lagerstr. 30
+ *  82178 Puchheim
+ *  Germany
+ *  <rtems@embedded-brains.de>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+#include <freebsd/machine/rtems-bsd-config.h>
+
+#include <freebsd/sys/param.h>
+#include <freebsd/sys/systm.h>
+
+#include <assert.h>
+#include <malloc.h>
+
+#include "timeout_helper.h"
+
+void timeout_table_init()
+{
+	size_t size = 0;
+	caddr_t v = 0;
+	void* firstaddr = 0;
+
+	/* calculates how much memory is needed */
+	v = kern_timeout_callwheel_alloc(v);
+
+	/* allocate memory */
+	size = (size_t)v;
+	firstaddr = malloc(round_page(size));
+	assert(firstaddr != NULL);
+
+	/* now set correct addresses for callwheel */
+	v = (caddr_t) firstaddr;
+	v = kern_timeout_callwheel_alloc(v);
+
+	assert((size_t)((void *)v - firstaddr) == size);
+
+	/* Initialize the callouts we just allocated. */
+	kern_timeout_callwheel_init();
+}
+
+#define CALLOUT_TICK_TASK_PRIO		(PRIORITY_DEFAULT_MAXIMUM - 1)
+#define CALLOUT_TICK_TASK_STACK_SIZE	(1024)
+#define CALLOUT_TICK_TASK_NAME		rtems_build_name('C', 'O', 'U', 'T')
+#define CALLOUT_TICKS_PER_CALLOUT_TICK	1
+
+static const rtems_event_set TRIGGER_EVENT = RTEMS_EVENT_13;
+
+static void callout_tick_task_trigger(rtems_id timer, void *arg)
+{
+	rtems_status_code status;
+	rtems_id *task_id = arg;
+
+	status = rtems_event_send(*task_id, TRIGGER_EVENT);
+	assert(status == RTEMS_SUCCESSFUL);
+
+	status = rtems_timer_reset(timer);
+	assert(status == RTEMS_SUCCESSFUL);
+}
+
+rtems_task callout_tick_task(rtems_task_argument arg)
+{
+	rtems_name name;
+	rtems_id timer;
+	rtems_status_code status;
+	const rtems_interval ticks_per_ms = CALLOUT_TICKS_PER_CALLOUT_TICK;
+	rtems_id self_id = rtems_task_self();
+
+	name = CALLOUT_TICK_TASK_NAME;
+
+	status = rtems_timer_create( name, &timer );
+	assert(status == RTEMS_SUCCESSFUL);
+
+	status = rtems_timer_fire_after( timer, ticks_per_ms, callout_tick_task_trigger, &self_id );
+	assert(status == RTEMS_SUCCESSFUL);
+
+	while ( 1 ) {
+		rtems_event_set event;
+
+		status = rtems_event_receive(
+				TRIGGER_EVENT,
+				RTEMS_EVENT_ALL | RTEMS_WAIT,
+				RTEMS_NO_TIMEOUT,
+				&event
+		);
+		assert(status == RTEMS_SUCCESSFUL);
+		assert(event == TRIGGER_EVENT);
+		
+		callout_tick();
+	}
+}
+
+
+void callout_tick_task_init(void)
+{
+	static bool initialized = false;
+	rtems_status_code sc = RTEMS_SUCCESSFUL;
+
+	if (!initialized) {
+		rtems_id id = RTEMS_ID_NONE;
+
+		initialized = true;
+
+		sc = rtems_task_create(
+			CALLOUT_TICK_TASK_NAME,
+			CALLOUT_TICK_TASK_PRIO,
+			CALLOUT_TICK_TASK_STACK_SIZE,
+			RTEMS_DEFAULT_MODES,
+			RTEMS_DEFAULT_ATTRIBUTES,
+			&id
+		);
+		assert(sc == RTEMS_SUCCESSFUL);
+
+		sc = rtems_task_start(id, callout_tick_task, 0);
+		assert(sc == RTEMS_SUCCESSFUL);
+	}
+}
+
diff --git a/testsuite/timeout01/timeout_helper.h b/testsuite/timeout01/timeout_helper.h
new file mode 100644
index 00000000..7e5acce1
--- /dev/null
+++ b/testsuite/timeout01/timeout_helper.h
@@ -0,0 +1,46 @@
+/*
+ * Copyright (c) 2012 embedded brains GmbH.  All rights reserved.
+ *
+ *  embedded brains GmbH
+ *  Obere Lagerstr. 30
+ *  82178 Puchheim
+ *  Germany
+ *  <rtems@embedded-brains.de>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+#ifndef TIMEOUT_HELPER_H
+#define TIMEOUT_HELPER_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif /* __cplusplus */
+
+void timeout_table_init(void);
+void callout_tick_task_init(void);
+
+#ifdef __cplusplus
+}
+#endif /* __cplusplus */
+
+#endif /* TIMEOUT_HELPER_H */
diff --git a/testsuite/timeout01/timeout_test.c b/testsuite/timeout01/timeout_test.c
new file mode 100644
index 00000000..b89feb84
--- /dev/null
+++ b/testsuite/timeout01/timeout_test.c
@@ -0,0 +1,282 @@
+/*
+ * Copyright (c) 2012 embedded brains GmbH.  All rights reserved.
+ *
+ *  embedded brains GmbH
+ *  Obere Lagerstr. 30
+ *  82178 Puchheim
+ *  Germany
+ *  <rtems@embedded-brains.de>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+#include <assert.h>
+
+#include <stdio.h>
+#include <unistd.h>
+
+#include <freebsd/machine/rtems-bsd-config.h>
+
+#include <freebsd/sys/types.h>
+#include <freebsd/sys/systm.h>
+
+#include <freebsd/sys/param.h>
+#include <freebsd/sys/lock.h>
+#include <freebsd/sys/mutex.h>
+#include <freebsd/sys/rwlock.h>
+
+#define TIMEOUT_MILLISECONDS	(100)
+
+// test after TEST_NOT_FIRED_MS, if handlar has not been executed
+#define TEST_NOT_FIRED_MS	(TIMEOUT_MILLISECONDS * 80 / 100)
+// test TEST_FIRED_MS after TEST_NOT_FIRED_MS, if handlar has been executed
+#define TEST_FIRED_MS		(TIMEOUT_MILLISECONDS * 40 / 100)
+// delay handler by this time with a mutex
+#define TEST_DELAY_MS		(TIMEOUT_MILLISECONDS)
+
+enum arg {
+	HANDLER_NOT_VISITED,
+	HANDLER_VISITED,
+};
+
+static void timeout_handler(void *arg)
+{
+	enum arg* argument = arg;
+
+	printf("This is the timout_handler.\n");
+
+	*argument = HANDLER_VISITED;
+}
+
+void timeout_test_timeout()
+{
+	enum arg argument = HANDLER_NOT_VISITED;
+	struct callout_handle handle;
+	
+	printf("== Start a timeout and test if handler has been called.\n");
+
+	callout_handle_init(&handle);
+
+	handle = timeout(timeout_handler, &argument, RTEMS_MILLISECONDS_TO_TICKS(TIMEOUT_MILLISECONDS));
+
+	usleep(TEST_NOT_FIRED_MS * 1000);
+	assert(argument == HANDLER_NOT_VISITED);
+	
+	usleep(TEST_FIRED_MS * 1000);
+	assert(argument == HANDLER_VISITED);
+}
+
+void timeout_test_cancel_timeout()
+{
+	enum arg argument = HANDLER_NOT_VISITED;
+	struct callout_handle handle;
+	
+	printf("== Start a timeout and cancel it.\n");
+
+	callout_handle_init(&handle);
+
+	handle = timeout(timeout_handler, &argument, RTEMS_MILLISECONDS_TO_TICKS(TIMEOUT_MILLISECONDS));
+
+	usleep(TEST_NOT_FIRED_MS * 1000);
+	
+	untimeout(timeout_handler, &argument, handle);
+
+	usleep(TEST_FIRED_MS * 1000);
+	assert(argument == HANDLER_NOT_VISITED);
+}
+
+void timeout_test_callout(int mpsave)
+{
+	enum arg argument = HANDLER_NOT_VISITED;
+	struct callout callout;
+	int retval = 0;
+	printf("== Start a callout and test if handler has been called. mpsave=%d\n", mpsave);
+
+	callout_init(&callout, mpsave);
+
+	retval = callout_reset(&callout, RTEMS_MILLISECONDS_TO_TICKS(TIMEOUT_MILLISECONDS), timeout_handler, &argument);
+	assert(retval == 0);
+
+	usleep(TEST_NOT_FIRED_MS * 1000);
+	assert(argument == HANDLER_NOT_VISITED);
+	
+	usleep(TEST_FIRED_MS * 1000);
+	assert(argument == HANDLER_VISITED);
+
+	callout_deactivate(&callout);
+}
+
+void timeout_test_cancel_callout(int mpsave, bool use_drain)
+{
+	enum arg argument = HANDLER_NOT_VISITED;
+	struct callout callout;
+	int retval = 0;
+	printf("== Start a callout and cancel it with %s. mpsave=%d\n", use_drain ? "drain" : "stop", mpsave);
+
+	callout_init(&callout, mpsave);
+
+	retval = callout_reset(&callout, RTEMS_MILLISECONDS_TO_TICKS(TIMEOUT_MILLISECONDS), timeout_handler, &argument);
+	assert(retval == 0);
+
+	usleep(TEST_NOT_FIRED_MS * 1000);
+
+	if(!use_drain)
+	{
+		retval = callout_stop(&callout);
+	}
+	else
+	{
+		retval = callout_drain(&callout);
+	}
+	assert(retval != 0);
+	
+	usleep(TEST_FIRED_MS * 1000);
+	assert(argument == HANDLER_NOT_VISITED);
+
+	callout_deactivate(&callout);
+}
+
+void timeout_test_callout_reschedule(int mpsave, bool use_reset)
+{
+	enum arg argument = HANDLER_NOT_VISITED;
+	struct callout callout;
+	int retval = 0;
+	printf("== Start a callout and reschedule it after some time with %s. mpsave=%d\n", use_reset ? "reset" : "schedule", mpsave);
+
+	callout_init(&callout, mpsave);
+
+	retval = callout_reset(&callout, RTEMS_MILLISECONDS_TO_TICKS(TIMEOUT_MILLISECONDS), timeout_handler, &argument);
+	assert(retval == 0);
+
+	usleep(TEST_NOT_FIRED_MS * 1000);
+	assert(argument == HANDLER_NOT_VISITED);
+
+	if(!use_reset)
+	{
+		retval = callout_schedule(&callout, RTEMS_MILLISECONDS_TO_TICKS(TIMEOUT_MILLISECONDS));
+	}
+	else
+	{
+		retval = callout_reset(&callout, RTEMS_MILLISECONDS_TO_TICKS(TIMEOUT_MILLISECONDS), timeout_handler, &argument);
+	}
+	assert(retval != 0);
+
+	usleep(TEST_NOT_FIRED_MS * 1000);
+	assert(argument == HANDLER_NOT_VISITED);
+
+	usleep(TEST_FIRED_MS * 1000);
+	assert(argument == HANDLER_VISITED);
+
+	callout_deactivate(&callout);
+}
+
+void timeout_test_callout_mutex(bool delay_with_lock)
+{
+	enum arg argument = HANDLER_NOT_VISITED;
+	struct callout callout;
+	struct mtx mtx;
+	int retval = 0;
+	printf("== Start a callout with a mutex%s\n", delay_with_lock ? " and delay execution by locking it." : ".");
+
+	mtx_init(&mtx, "callouttest", NULL, MTX_DEF);
+	callout_init_mtx(&callout, &mtx, 0);
+
+	retval = callout_reset(&callout, RTEMS_MILLISECONDS_TO_TICKS(TIMEOUT_MILLISECONDS), timeout_handler, &argument);
+	assert(retval == 0);
+
+	usleep(TEST_NOT_FIRED_MS * 1000);
+	assert(argument == HANDLER_NOT_VISITED);
+
+	if(delay_with_lock)
+	{
+		retval = mtx_trylock(&mtx);
+		assert(retval != 0);
+
+		usleep(TEST_DELAY_MS * 1000);
+		assert(argument == HANDLER_NOT_VISITED);
+
+		mtx_unlock(&mtx);
+	}
+	
+	usleep(TEST_FIRED_MS * 1000);
+	assert(argument == HANDLER_VISITED);
+	
+	callout_deactivate(&callout);
+
+	mtx_destroy(&mtx);
+}
+
+void timeout_test_callout_rwlock(bool delay_with_lock)
+{
+	enum arg argument = HANDLER_NOT_VISITED;
+	struct callout callout;
+	struct rwlock rw;
+	int retval = 0;
+	printf("== Start a callout with a rwlock%s\n", delay_with_lock ? " and delay execution by locking it." : ".");
+
+	rw_init(&rw, "callouttest");
+	callout_init_rw(&callout, &rw, 0);
+
+	retval = callout_reset(&callout, RTEMS_MILLISECONDS_TO_TICKS(TIMEOUT_MILLISECONDS), timeout_handler, &argument);
+	assert(retval == 0);
+
+	usleep(TEST_NOT_FIRED_MS * 1000);
+	assert(argument == HANDLER_NOT_VISITED);
+	
+	if(delay_with_lock)
+	{
+		retval = rw_try_wlock(&rw);
+		assert(retval != 0);
+
+		usleep(TEST_DELAY_MS * 1000);
+		assert(argument == HANDLER_NOT_VISITED);
+
+		rw_wunlock(&rw);
+	}
+
+	usleep(TEST_FIRED_MS * 1000);
+	assert(argument == HANDLER_VISITED);
+	
+	callout_deactivate(&callout);
+}
+
+void timeout_test(void)
+{
+	int mpsave = 0;
+
+	timeout_test_timeout();
+	timeout_test_cancel_timeout();
+
+	for(mpsave = 0; mpsave<=1; mpsave++)
+	{
+		timeout_test_callout(mpsave);
+		timeout_test_cancel_callout(mpsave, false);
+		timeout_test_cancel_callout(mpsave, true);
+		timeout_test_callout_reschedule(mpsave, false);
+		timeout_test_callout_reschedule(mpsave, true);
+	}
+	
+	timeout_test_callout_mutex(false);
+	timeout_test_callout_mutex(true);
+	timeout_test_callout_rwlock(false);
+	timeout_test_callout_rwlock(true);
+}
diff --git a/testsuite/timeout01/timeout_test.h b/testsuite/timeout01/timeout_test.h
new file mode 100644
index 00000000..25d4cb20
--- /dev/null
+++ b/testsuite/timeout01/timeout_test.h
@@ -0,0 +1,45 @@
+/*
+ * Copyright (c) 2012 embedded brains GmbH.  All rights reserved.
+ *
+ *  embedded brains GmbH
+ *  Obere Lagerstr. 30
+ *  82178 Puchheim
+ *  Germany
+ *  <rtems@embedded-brains.de>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+#ifndef TIMEOUT_TEST_H
+#define TIMEOUT_TEST_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif /* __cplusplus */
+
+void timeout_test(void);
+
+#ifdef __cplusplus
+}
+#endif /* __cplusplus */
+
+#endif /* TIMEOUT_TEST_H */