matos/core/synchro.c

85 lines
1.5 KiB
C
Raw Normal View History

2020-07-08 23:08:50 +02:00
#include "synchro.h"
#include "alloc.h"
2020-08-15 23:31:35 +02:00
#include "assert.h"
2020-07-08 23:08:50 +02:00
#include "irq.h"
#include "klibc.h"
#include "list.h"
#include "time.h"
struct wait_queue *waitQueues = NULL;
int mutexInit(struct mutex *m)
{
uint32_t flags;
m->owner = NULL;
m->wait = (struct wait_queue *)malloc(sizeof(struct wait_queue));
if (!m->wait)
return ENOMEM;
list_init(m->wait->thread);
disable_IRQs(flags);
list_add_tail(waitQueues, m->wait);
restore_IRQs(flags);
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,
2020-08-16 00:24:59 +02:00
getCurrentThread());
2020-07-08 23:08:50 +02:00
}
#endif
list_delete(waitQueues, 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);
2020-08-16 00:24:59 +02:00
current = getCurrentThread();
2020-07-08 23:08:50 +02:00
assert(m->owner != current);
2020-08-15 23:31:35 +02:00
wait_event(m->wait, m->owner == NULL);
2020-07-08 23:08:50 +02:00
m->owner = current;
restore_IRQs(flags);
return 0;
}
int mutexUnlock(struct mutex *m)
{
uint32_t flags;
disable_IRQs(flags);
2020-08-16 00:24:59 +02:00
assert(m->owner == getCurrentThread());
2020-07-08 23:08:50 +02:00
m->owner = NULL;
2020-08-15 23:31:35 +02:00
wake_up(m->wait);
2020-07-08 23:08:50 +02:00
restore_IRQs(flags);
return 0;
}