1 files changed, 88 insertions, 7 deletions

diff --git a/src/threadpool.c b/src/threadpool.c
index e230ebb..808dd5d 100644
--- a/src/threadpool.c
+++ b/src/threadpool.c
@@ -4,6 +4,7 @@
 
 #include "ll.h"
 
+#include <asm-generic/errno-base.h>
 #include <threads.h>
 #include <stdlib.h>
 #include <errno.h>
@@ -161,34 +162,34 @@ static void ___ucleanup_dll(void *dll) {
 
 cqueue * cqueue_init(int mtx_type) {
     unsigned char flag = 0;
-    cleanup_create(10);
+    cleanup_CREATE(10);
     
     cqueue *cq = VALLOC(1, sizeof(*cq));
     if(!cq)
         return NULL;
-    cleanup_register(&__CLEANUP, free, cq);
+    cleanup_REGISTER(free, cq);
 
     cq->mutex = VALLOC(1, sizeof(*(cq->mutex)));
     if(!(cq->mutex))
         flag++;
-    cleanup_cndregister(&__CLEANUP, flag, free, cq->mutex);
+    cleanup_CNDREGISTER(flag, free, cq->mutex);
     
     if(!flag && mtx_init(cq->mutex, mtx_type) != thrd_success)
         flag++;
-    cleanup_cndregister(&__CLEANUP, flag, ___ucleanup_mtxd, cq->mutex);
+    cleanup_CNDREGISTER(flag, ___ucleanup_mtxd, cq->mutex);
 
     if(!flag && !(cq->conditional = VALLOC(1, sizeof(*(cq->conditional)))))
         flag++;
-    cleanup_cndregister(&__CLEANUP, flag, free, cq->conditional);
+    cleanup_CNDREGISTER(flag, free, cq->conditional);
 
     if(!flag && cnd_init(cq->conditional) != thrd_success)
         flag++;
-    cleanup_cndregister(&__CLEANUP, flag, ___ucleanup_cndd, cq->conditional);
+    cleanup_CNDREGISTER(flag, ___ucleanup_cndd, cq->conditional);
 
     cq->list = dlinkedlist_init();
     if(!flag && !cq->list)
         flag++;
-    cleanup_cndregister(&__CLEANUP, flag, ___ucleanup_dll, cq->list);
+    cleanup_CNDREGISTER(flag, ___ucleanup_dll, cq->list);
 
     if(flag)
         cleanup_fire(&__CLEANUP);
@@ -210,4 +211,84 @@ void cqueue_free(cqueue *cq) {
     free(cq);
 
     return;
+}
+
+int cqueue_append(cqueue * const cq, task *tsk) {
+    if(!cq || !tsk)
+        RETURNWERR(EINVAL, -1);
+
+    mtx_lock(cq->mutex);
+    dlinkedlist_append(cq->list, tsk, free);
+    mtx_unlock(cq->mutex);
+    cnd_signal(cq->conditional);
+
+    return 0;
+}
+
+int cqueue_prepend(cqueue * const cq, task *tsk) {
+    if(!cq || !tsk)
+        RETURNWERR(EINVAL, -1);
+
+    mtx_lock(cq->mutex);
+    dlinkedlist_prepend(cq->list, tsk, free);
+    mtx_unlock(cq->mutex);
+    cnd_signal(cq->conditional);
+
+    return 0;
+}
+
+int cqueue_insert(cqueue * const cq, task *tsk, int index) {
+    if(!cq || !tsk || index < 0) // Can't check to see if the index is too high without locking the mutex first
+        RETURNWERR(EINVAL, -1);
+
+    mtx_lock(cq->mutex);
+    dlinkedlist_insert(cq->list, tsk, free, index);
+    mtx_unlock(cq->mutex);
+    cnd_signal(cq->conditional);
+
+    return 0;
+}
+
+int cqueue_size(cqueue const * const cq) {
+    if(!cq)
+        RETURNWERR(EINVAL, -1);
+
+    mtx_lock(cq->mutex);
+    int retval = dlinkedlist_size(cq->list);
+    mtx_unlock(cq->mutex);
+
+    return retval;
+}
+
+int cqueue_isempty(cqueue const * const cq) {
+    return (cqueue_size(cq) == 0);
+}
+
+int cqueue_trypop(cqueue * const cq, task **ret) {
+    if(!cq || !ret || !*ret)
+        RETURNWERR(EINVAL, -1);
+
+    int retval = 0;
+    
+    mtx_lock(cq->mutex);
+    if(!dlinkedlist_isempty(cq->list)) {
+        *ret = (task*)dlinkedlist_poplast(cq->list);
+        retval = 1;
+    }
+    mtx_unlock(cq->mutex);
+
+    return retval;
+}
+
+int cqueue_waitpop(cqueue * const cq, task **ret) {
+    if(!cq || !ret || !*ret)
+        RETURNWERR(EINVAL, -1);
+
+    mtx_lock(cq->mutex);
+    while(!dlinkedlist_isempty(cq->list))
+        cnd_wait(cq->conditional, cq->mutex); // Unlocks mutex while waiting, acquires lock once waiting is done
+    *ret = dlinkedlist_poplast(cq->list);
+    mtx_unlock(cq->mutex);
+
+    return 0;
 }
\ No newline at end of file