Separate RTEMS Specific Files from Those Direct from FreeBSD

1 files changed, 122 insertions, 0 deletions

diff --git a/rtemsbsd/src/rtems-bsd-callout.c b/rtemsbsd/src/rtems-bsd-callout.c
new file mode 100644
index 00000000..d427b636
--- /dev/null
+++ b/rtemsbsd/src/rtems-bsd-callout.c
@@ -0,0 +1,122 @@
+/**
+ * @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>
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rtems.com/license/LICENSE.
+ */
+
+#include <rtems/freebsd/machine/rtems-bsd-config.h>
+
+#include <rtems/freebsd/sys/param.h>
+#include <rtems/freebsd/sys/types.h>
+#include <rtems/freebsd/sys/systm.h>
+#include <rtems/freebsd/sys/callout.h>
+#include <rtems/freebsd/sys/lock.h>
+#include <rtems/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;
+}