arch/arm-efika/boot/support.c

   1 /*
   2     Copyright © 2010-2014, 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 = &__tmpspace[0];
  12 static unsigned long free_memory = BOOT_TMP_SIZE;
  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 size_t mem_avail()
  65 {
  66         return free_memory;
  67 }
  68
  69 size_t mem_used()
  70 {
  71         return BOOT_TMP_SIZE - free_memory;
  72 }
  73
  74 int32_t strlen(const char *c)
  75 {
  76         int32_t result = 0;
  77         while (*c++)
  78                 result++;
  79
  80         return result;
  81 }
  82
  83 const char *remove_path(const char *in)
  84 {
  85     const char *p = &in[strlen(in)-1];
  86     while (p > in && p[-1] != '/' && p[-1] != ':') p--;
  87     return p;
  88 }