arch/all-pc/bootstrap/support.c

   1 /*
   2     Copyright (C) 2006-2011 The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: Miscellaneous support functions.
   6     Lang: English
   7 */
   8
   9 #include <bootconsole.h>
  10 #include <runtime.h>
  11 #include <stdarg.h>
  12 #include <string.h>
  13
  14 #include "bootstrap.h"
  15 #include "support.h"
  16
  17 /* This comes from librom32 */
  18 int __vcformat (void *data, int(*outc)(int, void *), const char * format, va_list args);
  19
  20 char *__bs_remove_path(char *in)
  21 {
  22     char *p;
  23
  24     /* Go to the end of string */
  25     for (p = in; *p; p++);
  26     /* Now go backwards until we find a separator */
  27     while (p > in && p[-1] != '/' && p[-1] != ':') p--;
  28
  29     return p;
  30 }
  31
  32 /* Own memcpy(), because librom's one can use CopyMem() */
  33 void *memcpy(void *dest, const void *src, size_t len)
  34 {
  35     void *ret = dest;
  36
  37     while (len >= 4)
  38     {
  39         *(unsigned long *)dest = *(unsigned long *)src;
  40         len-=4;
  41         dest+=4;
  42         src+=4;
  43     }
  44     if (len >= 2)
  45     {
  46         *(unsigned short *)dest = *(unsigned short *)src;
  47         dest+=2;
  48         src+=2;
  49         len-=2;
  50     }
  51     if (len == 1)
  52     {
  53         *(unsigned char *)dest = *(unsigned char *)src;
  54         dest += 1;
  55     }
  56
  57     return ret;
  58 }
  59
  60 /*
  61  * Our extremely simple working memory allocator.
  62  * We can't just use some memory region because kickstart modules are placed there by GRUB.
  63  * We risk clobbering loaded kickstart in such a case.
  64  * The only 100% usable memory is memory contained in our own file.
  65  * So we reserve some workspace here. I hope 1MB is more than enough for out needs.
  66  * This space ends up in .bss section, so it does not occupy this megabyte on disk.
  67  */
  68 static char workspace[0x1000000];
  69
  70 static char *MemPtr = workspace;
  71
  72 void *__bs_malloc(unsigned long size)
  73 {
  74     char *start = MemPtr;
  75     char *end;
  76
  77     /* Longword-align the size */
  78     size = (size + sizeof(void *) - 1) & ~(sizeof(void *) - 1);
  79     end  = start + size;
  80
  81     /*
  82      * _start is provided by linker script, it marks start of
  83      * our executable. This is the end of allocatable region.
  84      * We also count reserved space for stack which is placed in the
  85      * end of our working memory.
  86      */
  87     if (end > workspace + sizeof(workspace))
  88         return 0;
  89
  90     MemPtr = end;
  91
  92     return start;
  93 }
  94
  95 /* This routine resets the allocator and releases all previously allocated memory */
  96 void __bs_free(void)
  97 {
  98     MemPtr = workspace;
  99 }
 100
 101 static int kputc(int c, void *data)
 102 {
 103     con_Putc(c);
 104
 105     return 1;
 106 }
 107
 108 /* KNOWN BUG: %llu and %lld will not work here. See notice in compiler/clib/__vcformat.c. */
 109 void kprintf(const char *format, ...)
 110 {
 111     va_list ap;
 112
 113     va_start(ap, format);
 114
 115     __vcformat(0, kputc, format, ap);
 116
 117     va_end(ap);
 118 }
 119
 120 /* The same as kprintf(). Needed for ELF loader. */
 121 void DisplayError(char *format, ...)
 122 {
 123     va_list ap;
 124
 125     va_start(ap, format);
 126
 127     __vcformat(0, kputc, format, ap);
 128
 129     va_end(ap);
 130 }