1 files changed, 62 insertions, 0 deletions
diff --git a/libcr_ipc/sema.c b/libcr_ipc/sema.c
new file mode 100644
index 0000000..f2ac9b6
--- /dev/null
+++ b/libcr_ipc/sema.c
@@ -0,0 +1,62 @@
+/* libcr_ipc/sema.c - Simple semaphores for libcr
+ *
+ * Copyright (C) 2024-2025  Luke T. Shumaker <lukeshu@lukeshu.com>
+ * SPDX-License-Identifier: AGPL-3.0-or-later
+ */
+
+#include <libcr/coroutine.h> /* for cid_t, cr_* */
+#include <libmisc/assert.h>
+
+#define IMPLEMENTATION_FOR_LIBCR_IPC_SEMA_H YES
+#include <libcr_ipc/sema.h>
+
+struct cr_sema_waiter {
+	cid_t   cid;
+};
+SLIST_DECLARE_NODE(_cr_sema_waiter_list, struct cr_sema_waiter);
+
+void cr_sema_signal(cr_sema_t *sema) {
+	assert(sema);
+	cr_assert_in_coroutine();
+
+	bool saved = cr_save_and_disable_interrupts();
+	sema->cnt++;
+	if (sema->waiters.front && !sema->unpausing) {
+		cr_unpause(sema->waiters.front->val.cid);
+		sema->unpausing = true;
+	}
+	cr_restore_interrupts(saved);
+}
+
+void cr_sema_signal_from_intrhandler(cr_sema_t *sema) {
+	assert(sema);
+	cr_assert_in_intrhandler();
+
+	sema->cnt++;
+	if (sema->waiters.front && !sema->unpausing) {
+		cr_unpause_from_intrhandler(sema->waiters.front->val.cid);
+		sema->unpausing = true;
+	}
+}
+
+void cr_sema_wait(cr_sema_t *sema) {
+	assert(sema);
+	cr_assert_in_coroutine();
+
+	bool saved = cr_save_and_disable_interrupts();
+
+	struct _cr_sema_waiter_list_node self = { .val = {
+		.cid    = cr_getcid(),
+	}};
+	slist_push_to_rear(&sema->waiters, &self);
+	if (sema->waiters.front != &self || !sema->cnt)
+		cr_pause_and_yield();
+	assert(sema->waiters.front == &self && sema->cnt);
+	slist_pop_from_front(&sema->waiters);
+	sema->cnt--;
+	if (sema->cnt && sema->waiters.front)
+		cr_unpause(sema->waiters.front->val.cid);
+	else
+		sema->unpausing = false;
+	cr_restore_interrupts(saved);
+}