uGFX/ugfx
2
0
Fork 0
Code Issues 2 Pull requests Projects Releases Wiki Activity

GOS POSIX fixes

Browse source
This commit is contained in:
Joel Bodenmann 2013-07-22 05:50:31 +02:00
parent abca557bab
commit 7b4488267d
1 changed files with 33 additions and 32 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

65
src/gos/posix.c
View file

@ -15,6 +15,7 @@
#include <stdio.h> #include <stdio.h>
#include <unistd.h> #include <unistd.h>
#include <errno.h>
#include <time.h> #include <time.h>
static gfxMutex SystemMutex; static gfxMutex SystemMutex;
@ -24,11 +25,11 @@ void _gosInit(void) {
} }
void gfxSystemLock(void) { void gfxSystemLock(void) {
gfxMutexEnter(&SystemMutex); //gfxMutexEnter(&SystemMutex);
} }
void gfxSystemUnlock(void) { void gfxSystemUnlock(void) {
gfxMutexLeave(&SystemMutex); //gfxMutexLeave(&SystemMutex);
} }
void gfxHalt(const char *msg) { void gfxHalt(const char *msg) {
@ -95,30 +96,30 @@ threadreturn_t gfxThreadWait(gfxThreadHandle thread) {
return retval; return retval;
} }
void gfxSemInit(gfxSem *psem, semcount_t val, semcount_t limit) { void gfxSemInit(gfxSem *pSem, semcount_t val, semcount_t limit) {
pthread_mutex_init(&psem->mtx, 0); pthread_mutex_init(&pSem->mtx, 0);
pthread_cond_init(&psem->cond, 0); pthread_cond_init(&pSem->cond, 0);
pthread_mutex_lock(&psem->mtx); pthread_mutex_lock(&pSem->mtx);
psem->cnt = val; pSem->cnt = val;
psem->max = limit; pSem->max = limit;
pthread_mutex_unlock(&psem->mtx); pthread_mutex_unlock(&pSem->mtx);
} }
void gfxSemDestroy(gfxSem *psem) { void gfxSemDestroy(gfxSem *pSem) {
pthread_mutex_destroy(&psem->mtx); pthread_mutex_destroy(&pSem->mtx);
pthread_cond_destroy(&psem->cond); pthread_cond_destroy(&pSem->cond);
} }
bool_t gfxSemWait(gfxSem *psem, delaytime_t ms) { bool_t gfxSemWait(gfxSem *pSem, delaytime_t ms) {
pthread_mutex_lock(&psem->mtx); pthread_mutex_lock(&pSem->mtx);
switch (ms) { switch (ms) {
case TIME_INFINITE: case TIME_INFINITE:
while (!psem->val) while (!pSem->cnt)
pthread_cond_wait(&psem->cond, &psem->mtx); pthread_cond_wait(&pSem->cond, &pSem->mtx);
break; break;
case TIME_IMMEDIATE: case TIME_IMMEDIATE:
if (!psem->val) { if (!pSem->cnt) {
pthread_mutex_unlock(&psem->mtx); pthread_mutex_unlock(&pSem->mtx);
return FALSE; return FALSE;
} }
break; break;
@ -130,27 +131,27 @@ bool_t gfxSemWait(gfxSem *psem, delaytime_t ms) {
gettimeofday(&now); gettimeofday(&now);
tm.tv_sec = now.tv_sec + ms / 1000; tm.tv_sec = now.tv_sec + ms / 1000;
tm.tv_nsec = (now.tv_usec + ms % 1000) * 1000; tm.tv_nsec = (now.tv_usec + ms % 1000) * 1000;
while (!psem->val) { while (!pSem->cnt) {
if (pthread_cond_timedwait(&psem->cond, &psem->mtx, &tm) == ETIMEDOUT) { if (pthread_cond_timedwait(&pSem->cond, &pSem->mtx, &tm) == ETIMEDOUT) {
pthread_mutex_unlock(&psem->mtx); pthread_mutex_unlock(&pSem->mtx);
return FALSE; return FALSE;
} }
} }
} }
break; break;
} }
psem->val--; pSem->cnt--;
pthread_mutex_unlock(&psem->mtx); pthread_mutex_unlock(&pSem->mtx);
return TRUE; return TRUE;
} }
void gfxSemSignal(gfxSem *psem) { void gfxSemSignal(gfxSem *pSem) {
pthread_mutex_lock(&psem->mtx); pthread_mutex_lock(&pSem->mtx);
if (psem->val < psem->limit) { if (pSem->cnt < pSem->max) {
psem->val++; pSem->cnt++;
pthread_cond_signal(&psem->cond); pthread_cond_signal(&pSem->cond);
} }
pthread_mutex_unlock(&psem->mtx); pthread_mutex_unlock(&pSem->mtx);
} }
semcount_t gfxSemCounter(gfxSem *pSem) { semcount_t gfxSemCounter(gfxSem *pSem) {
@ -158,9 +159,9 @@ semcount_t gfxSemCounter(gfxSem *pSem) {
// The locking is really only required if obtaining the count is a divisible operation // The locking is really only required if obtaining the count is a divisible operation
// which it might be on a 8/16 bit processor with a 32 bit semaphore count. // which it might be on a 8/16 bit processor with a 32 bit semaphore count.
pthread_mutex_lock(&psem->mtx); pthread_mutex_lock(&pSem->mtx);
res = psem->cnt; res = pSem->cnt;
pthread_mutex_unlock(&psem->mtx); pthread_mutex_unlock(&pSem->mtx);
return res; return res;
} }