LXR linux/arch/cris/arch-v32/mach-a3/vcs

   1/*
   2 * Simulator hook mechanism
   3 */
   4
   5#include "vcs_hook.h"
   6#include <asm/io.h>
   7#include <stdarg.h>
   8
   9#define HOOK_TRIG_ADDR      0xb7000000
  10#define HOOK_MEM_BASE_ADDR  0xce000000
  11
  12static volatile unsigned *hook_base;
  13
  14#define HOOK_DATA(offset) hook_base[offset]
  15#define VHOOK_DATA(offset) hook_base[offset]
  16#define HOOK_TRIG(funcid) \
  17        do { \
  18                *((unsigned *) HOOK_TRIG_ADDR) = funcid; \
  19        } while (0)
  20#define HOOK_DATA_BYTE(offset) ((unsigned char *)hook_base)[offset]
  21
  22static void hook_init(void)
  23{
  24        static int first = 1;
  25        if (first) {
  26                first = 0;
  27                hook_base = ioremap(HOOK_MEM_BASE_ADDR, 8192);
  28        }
  29}
  30
  31static unsigned hook_trig(unsigned id)
  32{
  33        unsigned ret;
  34
  35        /* preempt_disable(); */
  36
  37        /* Dummy read from mem to make sure data has propagated to memory
  38         * before trigging */
  39        ret = *hook_base;
  40
  41        /* trigger hook */
  42        HOOK_TRIG(id);
  43
  44        /* wait for call to finish */
  45        while (VHOOK_DATA(0) > 0) ;
  46
  47        /* extract return value */
  48
  49        ret = VHOOK_DATA(1);
  50
  51        return ret;
  52}
  53
  54int hook_call(unsigned id, unsigned pcnt, ...)
  55{
  56        va_list ap;
  57        int i;
  58        unsigned ret;
  59
  60        hook_init();
  61
  62        HOOK_DATA(0) = id;
  63
  64        va_start(ap, pcnt);
  65        for (i = 1; i <= pcnt; i++)
  66                HOOK_DATA(i) = va_arg(ap, unsigned);
  67        va_end(ap);
  68
  69        ret = hook_trig(id);
  70
  71        return ret;
  72}
  73
  74int hook_call_str(unsigned id, unsigned size, const char *str)
  75{
  76        int i;
  77        unsigned ret;
  78
  79        hook_init();
  80
  81        HOOK_DATA(0) = id;
  82        HOOK_DATA(1) = size;
  83
  84        for (i = 0; i < size; i++)
  85                HOOK_DATA_BYTE(8 + i) = str[i];
  86        HOOK_DATA_BYTE(8 + i) = 0;
  87
  88        ret = hook_trig(id);
  89
  90        return ret;
  91}
  92
  93void print_str(const char *str)
  94{
  95        int i;
  96        /* find null at end of string */
  97        for (i = 1; str[i]; i++) ;
  98        hook_call(hook_print_str, i, str);
  99}
 100
 101void CPU_WATCHDOG_TIMEOUT(unsigned t)
 102{
 103}
 104