matos/core/wait.c
2021-11-09 15:14:11 +01:00

88 lines
1.5 KiB
C

#include "irq.h"
#include "thread.h"
#include "list.h"
#include "wait.h"
static struct wait_queue *waitQueues = NULL;
int waitQueueInit(struct wait_queue *wq)
{
uint32_t flags;
list_init(wq->thread);
disable_IRQs(flags);
list_add_tail(waitQueues, wq);
restore_IRQs(flags);
return 0;
}
int waitQueueFree(struct wait_queue *wq)
{
uint32_t flags;
disable_IRQs(flags);
list_delete(waitQueues, wq);
restore_IRQs(flags);
return 0;
}
int waitUp(struct wait_queue *wq)
{
struct thread *th;
uint32_t flags;
disable_IRQs(flags);
list_collapse(wq->thread, th)
{
threadAddThread(th);
}
restore_IRQs(flags);
return 0;
}
int waitUpNb(struct wait_queue *wq, unsigned int nbThread)
{
struct thread *th;
uint32_t flags;
disable_IRQs(flags);
list_collapse(wq->thread, th)
{
threadAddThread(th);
if(nbThread){
nbThread--;
if(!nbThread)
break;
}
}
restore_IRQs(flags);
return 0;
}
int wait(struct wait_queue *wq)
{
return waitTimeout(wq, 0);
}
int waitTimeout(struct wait_queue *wq, unsigned long msec)
{
struct thread *current, *next;
uint32_t flags;
int ret;
disable_IRQs(flags);
current = getCurrentThread();
current->state = WAITING;
next = threadSelectNext();
threadUnsched(current);
list_add_tail(wq->thread, current);
ret = threadWait(current, next, msec);
restore_IRQs(flags);
return ret;
}