82 lines
1.4 KiB
C
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 thread *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;
|
|
}
|