matos/core/synchro.c
2020-08-20 23:41:36 +02:00

82 lines
1.4 KiB
C

#include "synchro.h"
#include "alloc.h"
#include "assert.h"
#include "irq.h"
#include "klibc.h"
#include "list.h"
#include "time.h"
int mutexInit(struct mutex *m)
{
m->owner = NULL;
m->wait = (struct wait_queue *)malloc(sizeof(struct wait_queue));
if (!m->wait)
return ENOMEM;
waitQueueInit(m->wait);
list_init(m->wait->thread);
return 0;
}
int mutexFree(struct mutex *m)
{
int ret = 0;
if (m) {
uint32_t flags;
disable_IRQs(flags);
if (list_is_empty(m->wait)) {
#ifdef DEBUG
if (m->owner) {
printf("Warning: freeing a owned mutex 0x%. owned by 0x%p 0x%p\n", m, m->owner,
getCurrentThread());
}
#endif
waitQueueFree(m->wait);
free(m->wait);
} else {
ret = EBUSY;
}
restore_IRQs(flags);
}
return ret;
}
int mutexLock(struct mutex *m)
{
uint32_t flags;
struct kthread *current;
disable_IRQs(flags);
current = getCurrentThread();
assert(m->owner != current);
wait_event(m->wait, m->owner == NULL);
m->owner = current;
restore_IRQs(flags);
return 0;
}
int mutexUnlock(struct mutex *m)
{
uint32_t flags;
disable_IRQs(flags);
assert(m->owner == getCurrentThread());
m->owner = NULL;
wakeUp(m->wait);
restore_IRQs(flags);
return 0;
}