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

   1/*
   2 * Call simulator hook. This is the part running in the
   3 * simulated program.
   4 */
   5
   6#include "vcs_hook.h"
   7#include <stdarg.h>
   8#include <arch-v32/hwregs/reg_map.h>
   9#include <arch-v32/hwregs/intr_vect_defs.h>
  10
  11#define HOOK_TRIG_ADDR     0xb7000000   /* hook cvlog model reg address */
  12#define HOOK_MEM_BASE_ADDR 0xa0000000   /* csp4 (shared mem) base addr */
  13
  14#define HOOK_DATA(offset) ((unsigned *)HOOK_MEM_BASE_ADDR)[offset]
  15#define VHOOK_DATA(offset) ((volatile unsigned *)HOOK_MEM_BASE_ADDR)[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_MEM_BASE_ADDR)[offset]
  21
  22int hook_call(unsigned id, unsigned pcnt, ...)
  23{
  24        va_list ap;
  25        unsigned i;
  26        unsigned ret;
  27#ifdef USING_SOS
  28        PREEMPT_OFF_SAVE();
  29#endif
  30
  31        /* pass parameters */
  32        HOOK_DATA(0) = id;
  33
  34        /* Have to make hook_print_str a special case since we call with a
  35         * parameter of byte type. Should perhaps be a separate
  36         * hook_call. */
  37
  38        if (id == hook_print_str) {
  39                int i;
  40                char *str;
  41
  42                HOOK_DATA(1) = pcnt;
  43
  44                va_start(ap, pcnt);
  45                str = (char *)va_arg(ap, unsigned);
  46
  47                for (i = 0; i != pcnt; i++)
  48                        HOOK_DATA_BYTE(8 + i) = str[i];
  49
  50                HOOK_DATA_BYTE(8 + i) = 0;      /* null byte */
  51        } else {
  52                va_start(ap, pcnt);
  53                for (i = 1; i <= pcnt; i++)
  54                        HOOK_DATA(i) = va_arg(ap, unsigned);
  55                va_end(ap);
  56        }
  57
  58        /* read from mem to make sure data has propagated to memory before
  59         * trigging */
  60        ret = *((volatile unsigned *)HOOK_MEM_BASE_ADDR);
  61
  62        /* trigger hook */
  63        HOOK_TRIG(id);
  64
  65        /* wait for call to finish */
  66        while (VHOOK_DATA(0) > 0) ;
  67
  68        /* extract return value */
  69
  70        ret = VHOOK_DATA(1);
  71
  72#ifdef USING_SOS
  73        PREEMPT_RESTORE();
  74#endif
  75        return ret;
  76}
  77
  78unsigned hook_buf(unsigned i)
  79{
  80        return (HOOK_DATA(i));
  81}
  82
  83void print_str(const char *str)
  84{
  85        int i;
  86        /* find null at end of string */
  87        for (i = 1; str[i]; i++) ;
  88        hook_call(hook_print_str, i, str);
  89}
  90
  91void CPU_KICK_DOG(void)
  92{
  93        (void)hook_call(hook_kick_dog, 0);
  94}
  95
  96void CPU_WATCHDOG_TIMEOUT(unsigned t)
  97{
  98        (void)hook_call(hook_dog_timeout, 1, t);
  99}
 100
 101