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