arch/armeb-raspi/boot/support.c

   1 /*
   2     Copyright � 2013, The AROS Development Team. All rights reserved.
   3     $Id$
   4  */
   5
   6 #include "boot.h"
   7
   8 #include <sys/types.h>
   9
  10 static unsigned char __tmpspace[BOOT_TMP_SIZE];
  11 static unsigned char *first_free;
  12 static unsigned long free_memory;
  13
  14 void arm_flush_cache(uint32_t addr, uint32_t length)
  15 {
  16         while (length)
  17         {
  18                 __asm__ __volatile__("mcr p15, 0, %0, c7, c14, 1"::"r"(addr));
  19                 addr += 32;
  20                 length -= 32;
  21         }
  22         __asm__ __volatile__("mcr p15, 0, %0, c7, c10, 4"::"r"(addr));
  23 }
  24
  25 void arm_icache_invalidate(uint32_t addr, uint32_t length)
  26 {
  27         while (length)
  28         {
  29                 __asm__ __volatile__("mcr p15, 0, %0, c7, c5, 1"::"r"(addr));
  30                 addr += 32;
  31                 length -= 32;
  32         }
  33         __asm__ __volatile__("mcr p15, 0, %0, c7, c10, 4"::"r"(addr));
  34 }
  35
  36 void arm_dcache_invalidate(uint32_t addr, uint32_t length)
  37 {
  38         while (length)
  39         {
  40                 __asm__ __volatile__("mcr p15, 0, %0, c7, c6, 1"::"r"(addr));
  41                 addr += 32;
  42                 length -= 32;
  43         }
  44         __asm__ __volatile__("mcr p15, 0, %0, c7, c10, 4"::"r"(addr));
  45 }
  46
  47 void *malloc(size_t size)
  48 {
  49         void *ret = NULL;
  50
  51         size = (size + 15) & ~15;
  52
  53         if (size <= free_memory)
  54         {
  55                 ret = first_free;
  56
  57                 first_free += size;
  58                 free_memory -= size;
  59         }
  60
  61         if (!ret)
  62                 kprintf("[BOOT] malloc - OUT OF MEMORY\n");
  63
  64         return ret;
  65 }
  66
  67 void mem_init(void)
  68 {
  69     first_free = &__tmpspace[0];
  70     free_memory = BOOT_TMP_SIZE;
  71 }
  72
  73 void explicit_mem_init(void *first, unsigned long free)
  74 {
  75     first_free = first;
  76     free_memory = free;
  77 }
  78
  79 size_t mem_avail()
  80 {
  81         return free_memory;
  82 }
  83
  84 size_t mem_used()
  85 {
  86         return BOOT_TMP_SIZE - free_memory;
  87 }
  88
  89 int32_t strlen(const char *c)
  90 {
  91         int32_t result = 0;
  92         while (*c++)
  93                 result++;
  94
  95         return result;
  96 }
  97
  98 const char *remove_path(const char *in)
  99 {
 100     const char *p = &in[strlen(in)-1];
 101     while (p > in && p[-1] != '/' && p[-1] != ':') p--;
 102     return p;
 103 }