minix/lib/libddekit/src/semaphore.c
2012-03-25 21:58:14 +02:00

111 lines
3.2 KiB
C

#include "common.h"
#include <ddekit/condvar.h>
#include <ddekit/lock.h>
#include <ddekit/memory.h>
#include <ddekit/panic.h>
#include <ddekit/semaphore.h>
#ifdef DDEBUG_LEVEL_SEMAPHORE
#undef DDEBUG
#define DDEBUG DDEBUG_LEVEL_SEMAPHORE
#endif
#include "debug.h"
#include "thread.h"
struct ddekit_sem {
unsigned count;
ddekit_thread_t *wait_queue;
};
#define SEM_DEBUG(p) \
do { \
DDEBUG_MSG_VERBOSE("%s, %p, %d\n",__func__, sem, sem->count); \
} while(0)
/*****************************************************************************
* ddekit_sem_init *
*************************+**************************************************/
ddekit_sem_t *ddekit_sem_init(int value)
{
ddekit_sem_t *sem;
sem = (ddekit_sem_t *) ddekit_simple_malloc(sizeof(ddekit_sem_t));
sem->count = value;
sem->wait_queue = NULL;
SEM_DEBUG(p);
return sem;
}
/*****************************************************************************
* ddekit_sem_deinit *
****************************************************************************/
void ddekit_sem_deinit(ddekit_sem_t *sem)
{
SEM_DEBUG(p);
ddekit_simple_free(sem);
}
/*****************************************************************************
* ddekit_sem_down *
****************************************************************************/
void ddekit_sem_down(ddekit_sem_t *sem)
{
SEM_DEBUG(p);
if(sem->count == 0) {
if(sem->wait_queue == NULL) {
sem->wait_queue = ddekit_thread_myself();
} else {
ddekit_thread_t *pos = sem->wait_queue;
while(pos->next != NULL) {
pos = pos->next;
}
pos->next = ddekit_thread_myself();
}
_ddekit_thread_schedule();
} else {
sem->count--;
}
}
/*****************************************************************************
* ddekit_sem_down_try *
****************************************************************************/
int ddekit_sem_down_try(ddekit_sem_t *sem)
{
if(sem->count == 0) {
return -1;
}
sem->count--;
return 0;
}
/*****************************************************************************
* ddekit_sem_up *
****************************************************************************/
void ddekit_sem_up(ddekit_sem_t *sem)
{
SEM_DEBUG(p);
if (sem->wait_queue == NULL) {
sem->count++;
return;
} else {
ddekit_thread_t *waiter = sem->wait_queue;
sem->wait_queue = waiter->next;
waiter->next = NULL;
_ddekit_thread_enqueue(waiter);
ddekit_thread_schedule();
}
}
/****************************************************************************
* ddekit_sem_down_timed *
***************************************************************************/
int ddekit_sem_down_timed(ddekit_sem_t *sem, int timo )
{
ddekit_panic("not implemented!");
return 0;
}