CRIS v32: Add new machine dependent files for Etrax-FS and Artpec-3.
[linux-2.6.git] / arch / cris / arch-v32 / mach-fs / vcs_hook.c
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 <asm/arch-v32/hwregs/reg_map.h>
9 #include <asm/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
22 int 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
78 unsigned hook_buf(unsigned i)
79 {
80         return (HOOK_DATA(i));
81 }
82
83 void 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
91 void CPU_KICK_DOG(void)
92 {
93         (void)hook_call(hook_kick_dog, 0);
94 }
95
96 void CPU_WATCHDOG_TIMEOUT(unsigned t)
97 {
98         (void)hook_call(hook_dog_timeout, 1, t);
99 }
100