libogc/sdgecko_buf.c

   1 #include <stdio.h>
   2 #include <string.h>
   3
   4 #include "card_cmn.h"
   5 #include "card_buf.h"
   6
   7 //#define _POOLBUFFER_DEBUG
   8
   9 #define BUF_POOL_CNT                    3
  10
  11 typedef struct _buf_node {
  12         struct _buf_node *next;
  13         u8 data[SECTOR_SIZE+2];
  14
  15 } BufNode;
  16
  17 static BufNode s_buf[BUF_POOL_CNT];
  18 static BufNode *s_freepool;
  19
  20 void sdgecko_initBufferPool()
  21 {
  22         u32 i;
  23 #ifdef _POOLBUFFER_DEBUG
  24         printf("card_initBufferPool()\n");
  25 #endif
  26         for(i=0;i<BUF_POOL_CNT-1;++i) {
  27                 s_buf[i].next = s_buf+i+1;
  28         }
  29         s_buf[i].next = NULL;
  30         s_freepool = s_buf;
  31 }
  32
  33 u8*     sdgecko_allocBuffer()
  34 {
  35         u8 *buf = NULL;
  36
  37         if(s_freepool) {
  38                 buf = s_freepool->data;
  39                 s_freepool = s_freepool->next;
  40         }
  41
  42         return buf;
  43 }
  44
  45 void sdgecko_freeBuffer(u8 *buf)
  46 {
  47         if(buf) {
  48                 BufNode *node = (BufNode*)(buf-offsetof(BufNode,data));
  49                 node->next = s_freepool;
  50                 s_freepool = node;
  51         }
  52 }