arch/arm-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         return ret;
  62 }
  63
  64 void mem_init(void)
  65 {
  66     first_free = &__tmpspace[0];
  67     free_memory = BOOT_TMP_SIZE;
  68 }
  69
  70 size_t mem_avail()
  71 {
  72         return free_memory;
  73 }
  74
  75 size_t mem_used()
  76 {
  77         return BOOT_TMP_SIZE - free_memory;
  78 }
  79
  80 int32_t strlen(const char *c)
  81 {
  82         int32_t result = 0;
  83         while (*c++)
  84                 result++;
  85
  86         return result;
  87 }
  88
  89 const char *remove_path(const char *in)
  90 {
  91     const char *p = &in[strlen(in)-1];
  92     while (p > in && p[-1] != '/' && p[-1] != ':') p--;
  93     return p;
  94 }