add plibsys

1 files changed, 234 insertions, 0 deletions

diff --git a/3rdparty/plibsys/src/pcondvariable-atheos.c b/3rdparty/plibsys/src/pcondvariable-atheos.c
new file mode 100644
index 0000000..f68e98b
--- /dev/null
+++ b/3rdparty/plibsys/src/pcondvariable-atheos.c
@@ -0,0 +1,234 @@
+/*
+ * The MIT License
+ *
+ * Copyright (C) 2016 Alexander Saprykin <saprykin.spb@gmail.com>
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining
+ * a copy of this software and associated documentation files (the
+ * 'Software'), to deal in the Software without restriction, including
+ * without limitation the rights to use, copy, modify, merge, publish,
+ * distribute, sublicense, and/or sell copies of the Software, and to
+ * permit persons to whom the Software is furnished to do so, subject to
+ * the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be
+ * included in all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED 'AS IS', WITHOUT WARRANTY OF ANY KIND,
+ * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
+ * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
+ * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
+ * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
+ * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
+ */
+
+#include "pcondvariable.h"
+#include "pspinlock.h"
+#include "patomic.h"
+#include "pmem.h"
+
+#include <stdlib.h>
+#include <string.h>
+
+#include <atheos/semaphore.h>
+#include <atheos/threads.h>
+
+typedef struct _PCondThread {
+	thread_id		thread;
+	struct _PCondThread	*next;
+} PCondThread;
+
+struct PCondVariable_ {
+	PSpinLock 	*lock;
+	PCondThread	*wait_head;
+	pint		wait_count;
+};
+
+P_LIB_API PCondVariable *
+p_cond_variable_new (void)
+{
+	PCondVariable *ret;
+
+	if (P_UNLIKELY ((ret = p_malloc0 (sizeof (PCondVariable))) == NULL)) {
+		P_ERROR ("PCondVariable::p_cond_variable_new: failed to allocate memory");
+		return NULL;
+	}
+
+	if ((ret->lock = p_spinlock_new ()) == NULL) {
+		P_ERROR ("PCondVariable::p_cond_variable_new: failed to initialize");
+		p_free (ret);
+		return NULL;
+	}
+
+	return ret;
+}
+
+P_LIB_API void
+p_cond_variable_free (PCondVariable *cond)
+{
+	if (P_UNLIKELY (cond == NULL))
+		return;
+
+	if ((cond->wait_count > 0) || (cond->wait_head != NULL))
+		P_WARNING ("PCondVariable::p_cond_variable_free: destroying while threads are waiting");
+
+	p_spinlock_free (cond->lock);
+	p_free (cond);
+}
+
+P_LIB_API pboolean
+p_cond_variable_wait (PCondVariable	*cond,
+		      PMutex		*mutex)
+{
+	PCondThread *wait_thread;
+
+	if (P_UNLIKELY (cond == NULL || mutex == NULL))
+		return FALSE;
+
+	if ((wait_thread = p_malloc0 (sizeof (PCondThread))) == NULL) {
+		P_ERROR ("PCondVariable::p_cond_variable_wait: failed to allocate memory");
+		return FALSE;
+	}
+
+	wait_thread->thread = get_thread_id (NULL);
+	wait_thread->next   = NULL;
+	
+	if (p_spinlock_lock (cond->lock) != TRUE) {
+		P_ERROR ("PCondVariable::p_cond_variable_wait: failed to lock internal spinlock");
+		return FALSE;
+	}
+
+	if (cond->wait_head != NULL)
+		cond->wait_head->next = wait_thread;
+	else
+		cond->wait_head = wait_thread;
+
+	p_atomic_int_inc ((volatile pint *) &cond->wait_count);
+	
+	if (p_spinlock_unlock (cond->lock) != TRUE) {
+		P_ERROR ("PCondVariable::p_cond_variable_wait: failed to unlock internal spinlock");
+		return FALSE;
+	}
+
+	if (p_mutex_unlock (mutex) != TRUE) {
+		P_ERROR ("PCondVariable::p_cond_variable_wait: failed to unlock mutex");
+		return FALSE;
+	}
+
+	suspend_thread (wait_thread->thread);
+
+	if (p_mutex_lock (mutex) != TRUE) {
+		P_ERROR ("PCondVariable::p_cond_variable_wait: failed to lock mutex");
+		return FALSE;
+	}
+
+	return TRUE;
+}
+
+P_LIB_API pboolean
+p_cond_variable_signal (PCondVariable *cond)
+{
+	PCondThread	*wait_thread;
+	thread_info	thr_info;
+
+	if (P_UNLIKELY (cond == NULL))
+		return FALSE;
+
+	if (p_spinlock_lock (cond->lock) != TRUE) {
+		P_ERROR ("PCondVariable::p_cond_variable_signal: failed to lock internal spinlock");
+		return FALSE;
+	}
+
+	if (cond->wait_head == NULL) {
+		if (p_spinlock_unlock (cond->lock) != TRUE) {
+			P_ERROR ("PCondVariable::p_cond_variable_signal(1): failed to unlock internal spinlock");
+			return FALSE;
+		} else
+			return TRUE;
+	}
+
+	wait_thread = cond->wait_head;
+	cond->wait_head = wait_thread->next;
+
+	p_atomic_int_add ((volatile pint *) &cond->wait_count, -1);
+
+	if (p_spinlock_unlock (cond->lock) != TRUE) {
+		P_ERROR ("PCondVariable::p_cond_variable_signal(2): failed to unlock internal spinlock");
+		return FALSE;
+	}
+
+	memset (&thr_info, 0, sizeof (thr_info));
+
+	while (get_thread_info (wait_thread->thread, &thr_info) == 0) {
+		if (thr_info.ti_state != TS_READY)
+			break;
+	}
+
+	resume_thread (wait_thread->thread);
+
+	p_free (wait_thread);
+	return TRUE;
+}
+
+P_LIB_API pboolean
+p_cond_variable_broadcast (PCondVariable *cond)
+{
+	if (P_UNLIKELY (cond == NULL))
+		return FALSE;
+
+	PCondThread	*cur_thread;
+	PCondThread	*next_thread;
+	thread_info	thr_info;
+
+	if (p_spinlock_lock (cond->lock) != TRUE) {
+		P_ERROR ("PCondVariable::p_cond_variable_broadcast: failed to lock internal spinlock");
+		return FALSE;
+	}
+
+	if (cond->wait_head == NULL) {
+		if (p_spinlock_unlock (cond->lock) != TRUE) {
+			P_ERROR ("PCondVariable::p_cond_variable_broadcast(1): failed to unlock internal spinlock");
+			return FALSE;
+		} else
+			return TRUE;
+	}
+
+	cur_thread = cond->wait_head;
+
+	do {
+		memset (&thr_info, 0, sizeof (thr_info)); 
+
+		while (get_thread_info (cur_thread->thread, &thr_info) == 0) {
+			if (thr_info.ti_state != TS_READY)
+				break;
+		}
+
+		resume_thread (cur_thread->thread);
+
+		next_thread = cur_thread->next;
+		p_free (cur_thread);
+
+		cur_thread = next_thread;
+	} while (cur_thread != NULL);
+
+	cond->wait_head  = NULL;
+	cond->wait_count = 0;
+
+	if (p_spinlock_unlock (cond->lock) != TRUE) {
+		P_ERROR ("PCondVariable::p_cond_variable_broadcast(2): failed to unlock internal spinlock");
+		return FALSE;
+	}
+
+	return TRUE;
+}
+
+void
+p_cond_variable_init (void)
+{
+}
+
+void
+p_cond_variable_shutdown (void)
+{
+}