libogc/lwp_objmgr.c

   1 #include <processor.h>
   2 #include <stdlib.h>
   3 #include <stdio.h>
   4 #include <string.h>
   5 #include <lwp_threads.h>
   6 #include <lwp_wkspace.h>
   7 #include <lwp_config.h>
   8
   9 #include "lwp_objmgr.h"
  10
  11 static u32 _lwp_objmgr_memsize = 0;
  12 static lwp_obj *null_local_table = NULL;
  13
  14 u32 __lwp_objmgr_memsize()
  15 {
  16         return _lwp_objmgr_memsize;
  17 }
  18
  19 void __lwp_objmgr_initinfo(lwp_objinfo *info,u32 max_nodes,u32 node_size)
  20 {
  21         u32 idx,i,size;
  22         lwp_obj *object;
  23         lwp_queue inactives;
  24         void **local_table;
  25
  26         info->min_id = 0;
  27         info->max_id = 0;
  28         info->inactives_cnt = 0;
  29         info->node_size = node_size;
  30         info->max_nodes = max_nodes;
  31         info->obj_blocks = NULL;
  32         info->local_table = &null_local_table;
  33
  34         __lwp_queue_init_empty(&info->inactives);
  35
  36         size = ((info->max_nodes*sizeof(lwp_obj*))+(info->max_nodes*info->node_size));
  37         local_table = (void**)__lwp_wkspace_allocate(info->max_nodes*sizeof(lwp_obj*));
  38         if(!local_table) return;
  39
  40         info->local_table = (lwp_obj**)local_table;
  41         for(i=0;i<info->max_nodes;i++) {
  42                 local_table[i] = NULL;
  43         }
  44
  45         info->obj_blocks = __lwp_wkspace_allocate(info->max_nodes*info->node_size);
  46         if(!info->obj_blocks) {
  47                 __lwp_wkspace_free(local_table);
  48                 return;
  49         }
  50
  51         __lwp_queue_initialize(&inactives,info->obj_blocks,info->max_nodes,info->node_size);
  52
  53         idx = info->min_id;
  54         while((object=(lwp_obj*)__lwp_queue_get(&inactives))!=NULL) {
  55                 object->id = idx;
  56                 object->information = NULL;
  57                 __lwp_queue_append(&info->inactives,&object->node);
  58                 idx++;
  59         }
  60
  61         info->max_id += info->max_nodes;
  62         info->inactives_cnt += info->max_nodes;
  63         _lwp_objmgr_memsize += size;
  64 }
  65
  66 lwp_obj* __lwp_objmgr_getisrdisable(lwp_objinfo *info,u32 id,u32 *p_level)
  67 {
  68         u32 level;
  69         lwp_obj *object = NULL;
  70
  71         _CPU_ISR_Disable(level);
  72         if(info->max_id>=id) {
  73                 if((object=info->local_table[id])!=NULL) {
  74                         *p_level = level;
  75                         return object;
  76                 }
  77         }
  78         _CPU_ISR_Restore(level);
  79         return NULL;
  80 }
  81
  82 lwp_obj* __lwp_objmgr_getnoprotection(lwp_objinfo *info,u32 id)
  83 {
  84         lwp_obj *object = NULL;
  85
  86         if(info->max_id>=id) {
  87                 if((object=info->local_table[id])!=NULL) return object;
  88         }
  89         return NULL;
  90 }
  91
  92 lwp_obj* __lwp_objmgr_get(lwp_objinfo *info,u32 id)
  93 {
  94         lwp_obj *object = NULL;
  95
  96         if(info->max_id>=id) {
  97                 __lwp_thread_dispatchdisable();
  98                 if((object=info->local_table[id])!=NULL) return object;
  99                 __lwp_thread_dispatchenable();
 100         }
 101         return NULL;
 102 }
 103
 104 lwp_obj* __lwp_objmgr_allocate(lwp_objinfo *info)
 105 {
 106         u32 level;
 107         lwp_obj* object;
 108
 109         _CPU_ISR_Disable(level);
 110          object = (lwp_obj*)__lwp_queue_getI(&info->inactives);
 111          if(object) {
 112                  object->information = info;
 113                  info->inactives_cnt--;
 114          }
 115         _CPU_ISR_Restore(level);
 116
 117         return object;
 118 }
 119
 120 void __lwp_objmgr_free(lwp_objinfo *info,lwp_obj *object)
 121 {
 122         u32 level;
 123
 124         _CPU_ISR_Disable(level);
 125         __lwp_queue_appendI(&info->inactives,&object->node);
 126         object->information     = NULL;
 127         info->inactives_cnt++;
 128         _CPU_ISR_Restore(level);
 129 }