firmware/buffer.c

   1 /***************************************************************************
   2  *             __________               __   ___.
   3  *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
   4  *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
   5  *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
   6  *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
   7  *                     \/            \/     \/    \/            \/
   8  * $Id$
   9  *
  10  * Copyright (C) 2002 by Linus Nielsen Feltzing
  11  *
  12  * This program is free software; you can redistribute it and/or
  13  * modify it under the terms of the GNU General Public License
  14  * as published by the Free Software Foundation; either version 2
  15  * of the License, or (at your option) any later version.
  16  *
  17  * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
  18  * KIND, either express or implied.
  19  *
  20  ****************************************************************************/
  21 #include <stdio.h>
  22 #include "buffer.h"
  23 #include "panic.h"
  24 #include "logf.h"
  25
  26 #if (CONFIG_PLATFORM & PLATFORM_HOSTED)
  27 unsigned char audiobuffer[(MEMORYSIZE*1024-256)*1024];
  28 unsigned char *audiobufend = audiobuffer + sizeof(audiobuffer);
  29 #else
  30 /* defined in linker script */
  31 extern unsigned char audiobuffer[];
  32 #endif
  33
  34 unsigned char *audiobuf;
  35
  36 #ifdef BUFFER_ALLOC_DEBUG
  37 static unsigned char *audiobuf_orig_start;
  38
  39 struct buffer_start_marker
  40 {
  41     unsigned int magic;
  42     size_t buffer_size;
  43 };
  44 #define BUF_MAGIC 0xDEADD0D0
  45
  46 struct buffer_end_marker
  47 {
  48     unsigned int magic;
  49     int last;
  50 };
  51 #endif /* BUFFER_ALLOC_DEBUG */
  52
  53 void buffer_init(void)
  54 {
  55     /* 32-bit aligned */
  56     audiobuf = (void *)(((unsigned long)audiobuffer + 3) & ~3);
  57 #ifdef BUFFER_ALLOC_DEBUG
  58     audiobuf_orig_start = audiobuf;
  59 #endif /* BUFFER_ALLOC_DEBUG */
  60 }
  61
  62 void *buffer_alloc(size_t size)
  63 {
  64     void *retval;
  65 #ifdef BUFFER_ALLOC_DEBUG
  66     struct buffer_start_marker *start;
  67     struct buffer_end_marker *end;
  68 #endif /* BUFFER_ALLOC_DEBUG */
  69
  70     /* 32-bit aligned */
  71     size = (size + 3) & ~3;
  72
  73     /* Other code touches audiobuf. Make sure it stays aligned */
  74     audiobuf = (void *)(((unsigned long)audiobuf + 3) & ~3);
  75
  76     retval = audiobuf;
  77
  78 #ifdef BUFFER_ALLOC_DEBUG
  79     retval +=sizeof(struct buffer_start_marker);
  80     if(size>0)
  81     {
  82         end=(struct buffer_end_marker*)(audiobuf - sizeof(struct buffer_end_marker));
  83         if(end->magic == BUF_MAGIC)
  84         {
  85             end->last=0;
  86         }
  87         start=(struct buffer_start_marker*)audiobuf;
  88         start->magic = BUF_MAGIC;
  89         start->buffer_size = size;
  90         end=(struct buffer_end_marker*)(audiobuf+sizeof(struct buffer_start_marker)+size);
  91         end->magic = BUF_MAGIC;
  92         end->last = 1;
  93
  94         audiobuf = ((unsigned char *)end) + sizeof(struct buffer_end_marker);
  95     }
  96
  97     logf("Alloc %x %d",(unsigned int)retval,size);
  98 #else /* !BUFFER_ALLOC_DEBUG */
  99     audiobuf += size;
 100 #endif /* BUFFER_ALLOC_DEBUG */
 101
 102     if (audiobuf > audiobufend) {
 103         panicf("OOM: %d bytes", (int) size);
 104     }
 105
 106     return retval;
 107 }
 108
 109 #ifdef BUFFER_ALLOC_DEBUG
 110 void buffer_alloc_check(char *name)
 111 {
 112     unsigned char *buf_ptr = audiobuf_orig_start;
 113     struct buffer_start_marker *start;
 114     struct buffer_end_marker *end;
 115
 116
 117     while(buf_ptr < audiobuf)
 118     {
 119         start=(struct buffer_start_marker*)buf_ptr;
 120         if(start->magic != BUF_MAGIC)
 121         {
 122             panicf("%s corrupted buffer %x start", name,(unsigned int)buf_ptr+sizeof(struct buffer_start_marker));
 123         }
 124         end=(struct buffer_end_marker*)(buf_ptr+sizeof(struct buffer_start_marker)+start->buffer_size);
 125         if(end->magic != BUF_MAGIC)
 126         {
 127             panicf("%s corrupted %x end", name,(unsigned int)buf_ptr+sizeof(struct buffer_start_marker));
 128         }
 129         if(end->last)
 130             break;
 131         buf_ptr=((unsigned char *)end)+sizeof(struct buffer_end_marker);
 132     }
 133 }
 134 #endif /* BUFFER_ALLOC_DEBUG */