libogc/malloc_lock.c

   1 #include <_ansi.h>
   2 #include <_syslist.h>
   3 #ifndef REENTRANT_SYSCALLS_PROVIDED
   4 #include <reent.h>
   5 #endif
   6 #include <errno.h>
   7 #undef errno
   8 extern int errno;
   9
  10 #include "asm.h"
  11 #include "processor.h"
  12 #include "lwp_mutex.h"
  13
  14 #define MEMLOCK_MUTEX_ID                        0x00030040
  15
  16 static int initialized = 0;
  17 static lwp_mutex mem_lock;
  18
  19 void __memlock_init()
  20 {
  21         __lwp_thread_dispatchdisable();
  22         if(!initialized) {
  23                 lwp_mutex_attr attr;
  24
  25                 initialized = 1;
  26
  27                 attr.mode = LWP_MUTEX_FIFO;
  28                 attr.nest_behavior = LWP_MUTEX_NEST_ACQUIRE;
  29                 attr.onlyownerrelease = TRUE;
  30                 attr.prioceil = 1;
  31                 __lwp_mutex_initialize(&mem_lock,&attr,LWP_MUTEX_UNLOCKED);
  32         }
  33         __lwp_thread_dispatchunnest();
  34 }
  35
  36 #ifndef REENTRANT_SYSCALLS_PROVIDED
  37 void _DEFUN(__libogc_malloc_lock,(r),
  38                         struct _reent *r)
  39 {
  40         unsigned int level;
  41
  42         if(!initialized) return;
  43
  44         _CPU_ISR_Disable(level);
  45         __lwp_mutex_seize(&mem_lock,MEMLOCK_MUTEX_ID,TRUE,LWP_THREADQ_NOTIMEOUT,level);
  46 }
  47
  48 void _DEFUN(__libogc_malloc_unlock,(r),
  49                         struct _reent *r)
  50 {
  51         if(!initialized) return;
  52
  53         __lwp_thread_dispatchdisable();
  54         __lwp_mutex_surrender(&mem_lock);
  55         __lwp_thread_dispatchenable();
  56 }
  57
  58 #else
  59 void _DEFUN(__libogc_malloc_lock,(ptr),
  60                         struct _reent *ptr)
  61 {
  62         unsigned int level;
  63
  64         if(!initialized) return;
  65
  66         _CPU_ISR_Disable(level);
  67         __lwp_mutex_seize(&mem_lock,MEMLOCK_MUTEX_ID,TRUE,LWP_THREADQ_NOTIMEOUT,level);
  68         ptr->_errno = _thr_executing->wait.ret_code;
  69 }
  70
  71 void _DEFUN(__libogc_malloc_unlock,(ptr),
  72                         struct _reent *ptr)
  73 {
  74         if(!initialized) return;
  75
  76         __lwp_thread_dispatchdisable();
  77         ptr->_errno = __lwp_mutex_surrender(&mem_lock);
  78         __lwp_thread_dispatchenable();
  79 }
  80
  81 #endif