Reading joystick 5 when we only support 4 should fail instead of
[wine/multimedia.git] / if1632 / snoop.c
blob5e0f6118ef36ae959ae6cc912d0945a57e29a665
1 /*
2 * 386-specific Win16 dll<->dll snooping functions
4 * Copyright 1998 Marcus Meissner
5 */
7 #include <assert.h>
8 #include "windows.h"
9 #include "winbase.h"
10 #include "winnt.h"
11 #include "heap.h"
12 #include "global.h"
13 #include "selectors.h"
14 #include "stackframe.h"
15 #include "snoop.h"
16 #include "debugstr.h"
17 #include "debug.h"
19 #ifdef __i386__
21 #pragma pack(1)
23 void WINAPI SNOOP16_Entry(CONTEXT *context);
24 void WINAPI SNOOP16_Return(CONTEXT *context);
25 extern void CallFrom16_p_regs_();
27 /* Generic callfrom16_p_regs function entry.
28 * pushw %bp 0x55
29 * pushl $DOS3Call DWORD fun32
30 * .byte 0x9a 0x9a
31 * .long CallFrom16_p_regs_ DWORD addr
32 * .long 0x90900023 WORD seg;nop;nop
35 typedef struct tagSNOOP16_FUN {
36 /* code part */
37 BYTE lcall; /* 0x9a call absolute with segment */
38 DWORD snr;
39 /* unreached */
40 int nrofargs;
41 FARPROC16 origfun;
42 char *name;
43 } SNOOP16_FUN;
45 typedef struct tagSNOOP16_DLL {
46 HMODULE16 hmod;
47 HANDLE16 funhandle;
48 SNOOP16_FUN *funs;
49 LPCSTR name;
50 struct tagSNOOP16_DLL *next;
51 } SNOOP16_DLL;
53 typedef struct tagSNOOP16_RETURNENTRY {
54 /* code part */
55 BYTE lcall; /* 0x9a call absolute with segment */
56 DWORD snr;
57 /* unreached */
58 FARPROC16 origreturn;
59 SNOOP16_DLL *dll;
60 DWORD ordinal;
61 WORD origSP;
62 WORD *args; /* saved args across a stdcall */
63 } SNOOP16_RETURNENTRY;
65 typedef struct tagSNOOP16_RETURNENTRIES {
66 SNOOP16_RETURNENTRY entry[65500/sizeof(SNOOP16_RETURNENTRY)];
67 HANDLE16 rethandle;
68 struct tagSNOOP16_RETURNENTRIES *next;
69 } SNOOP16_RETURNENTRIES;
71 typedef struct tagSNOOP16_RELAY {
72 /* code part */
73 BYTE prefix; /* 0x66 , 32bit prefix */
74 BYTE pushbp; /* 0x55 */
75 BYTE pushl; /* 0x68 */
76 DWORD realfun; /* SNOOP16_Return */
77 BYTE lcall; /* 0x9a call absolute with segment */
78 DWORD callfromregs;
79 WORD seg;
80 /* unreached */
81 } SNOOP16_RELAY;
83 #pragma pack(4)
85 static SNOOP16_DLL *firstdll = NULL;
86 static SNOOP16_RETURNENTRIES *firstrets = NULL;
87 static SNOOP16_RELAY *snr;
88 static HANDLE16 xsnr = 0;
90 void
91 SNOOP16_RegisterDLL(NE_MODULE *pModule,LPCSTR name) {
92 SNOOP16_DLL **dll = &(firstdll);
93 char *s;
95 if (!TRACE_ON(snoop)) return;
96 if (!snr) {
97 xsnr=GLOBAL_Alloc(GMEM_ZEROINIT,2*sizeof(*snr),0,TRUE,TRUE,FALSE);
98 snr = GlobalLock16(xsnr);
99 snr[0].prefix = 0x66;
100 snr[0].pushbp = 0x55;
101 snr[0].pushl = 0x68;
102 snr[0].realfun = (DWORD)SNOOP16_Entry;
103 snr[0].lcall = 0x9a;
104 snr[0].callfromregs = (DWORD)CallFrom16_p_regs_;
105 GET_CS(snr[0].seg);
106 snr[1].prefix = 0x66;
107 snr[1].pushbp = 0x55;
108 snr[1].pushl = 0x68;
109 snr[1].realfun = (DWORD)SNOOP16_Return;
110 snr[1].lcall = 0x9a;
111 snr[1].callfromregs = (DWORD)CallFrom16_p_regs_;
112 GET_CS(snr[1].seg);
114 while (*dll) {
115 if ((*dll)->hmod == pModule->self)
116 return; /* already registered */
117 dll = &((*dll)->next);
119 *dll = (SNOOP16_DLL*)HeapAlloc(SystemHeap,HEAP_ZERO_MEMORY,sizeof(SNOOP16_DLL));
120 (*dll)->next = NULL;
121 (*dll)->hmod = pModule->self;
122 if ((s=strrchr(name,'\\')))
123 name = s+1;
124 (*dll)->name = HEAP_strdupA(SystemHeap,0,name);
125 if ((s=strrchr((*dll)->name,'.')))
126 *s='\0';
127 (*dll)->funhandle = GlobalHandleToSel(GLOBAL_Alloc(GMEM_ZEROINIT,65535,0,TRUE,FALSE,FALSE));
128 (*dll)->funs = GlobalLock16((*dll)->funhandle);
129 if (!(*dll)->funs) {
130 HeapFree(SystemHeap,0,*dll);
131 FIXME(snoop,"out of memory\n");
132 return;
134 memset((*dll)->funs,0,65535);
137 FARPROC16
138 SNOOP16_GetProcAddress16(HMODULE16 hmod,DWORD ordinal,FARPROC16 origfun) {
139 SNOOP16_DLL *dll = firstdll;
140 SNOOP16_FUN *fun;
141 NE_MODULE *pModule = NE_GetPtr(hmod);
142 unsigned char *cpnt;
143 char name[200];
145 if (!TRACE_ON(snoop) || !pModule || !HIWORD(origfun))
146 return origfun;
147 if (!*(LPBYTE)PTR_SEG_TO_LIN(origfun)) /* 0x00 is an imposs. opcode, poss. dataref. */
148 return origfun;
149 while (dll) {
150 if (hmod == dll->hmod)
151 break;
152 dll=dll->next;
154 if (!dll) /* probably internal */
155 return origfun;
156 if (ordinal>65535/sizeof(SNOOP16_FUN))
157 return origfun;
158 fun = dll->funs+ordinal;
159 /* already done? */
160 fun->lcall = 0x9a;
161 fun->snr = MAKELONG(0,xsnr);
162 fun->origfun = origfun;
163 if (fun->name)
164 return (FARPROC16)(SEGPTR)MAKELONG(((char*)fun-(char*)dll->funs),dll->funhandle);
165 cpnt = (unsigned char *)pModule + pModule->name_table;
166 while (*cpnt) {
167 cpnt += *cpnt + 1 + sizeof(WORD);
168 if (*(WORD*)(cpnt+*cpnt+1) == ordinal) {
169 sprintf(name,"%.*s",*cpnt,cpnt+1);
170 break;
173 /* Now search the non-resident names table */
175 if (!*cpnt && pModule->nrname_handle) {
176 cpnt = (char *)GlobalLock16( pModule->nrname_handle );
177 while (*cpnt) {
178 cpnt += *cpnt + 1 + sizeof(WORD);
179 if (*(WORD*)(cpnt+*cpnt+1) == ordinal) {
180 sprintf(name,"%.*s",*cpnt,cpnt+1);
181 break;
185 if (*cpnt)
186 fun->name = HEAP_strdupA(SystemHeap,0,name);
187 else
188 fun->name = HEAP_strdupA(SystemHeap,0,"");
189 if (!SNOOP_ShowDebugmsgSnoop(dll->name, ordinal, fun->name))
190 return origfun;
192 /* more magic. do not try to snoop thunk data entries (MMSYSTEM) */
193 if (strchr(fun->name,'_')) {
194 char *s=strchr(fun->name,'_');
196 if (!strncasecmp(s,"_thunkdata",10)) {
197 HeapFree(SystemHeap,0,fun->name);
198 fun->name = NULL;
199 return origfun;
202 fun->lcall = 0x9a;
203 fun->snr = MAKELONG(0,xsnr);
204 fun->origfun = origfun;
205 fun->nrofargs = -1;
206 return (FARPROC16)(SEGPTR)MAKELONG(((char*)fun-(char*)dll->funs),dll->funhandle);
209 #define CALLER1REF (*(DWORD*)(PTR_SEG_OFF_TO_LIN(SS_reg(context),SP_reg(context)+4)))
210 void WINAPI SNOOP16_Entry(CONTEXT *context) {
211 DWORD ordinal=0;
212 DWORD entry=(DWORD)PTR_SEG_OFF_TO_LIN(CS_reg(context),IP_reg(context))-5;
213 WORD xcs = CS_reg(context);
214 SNOOP16_DLL *dll = firstdll;
215 SNOOP16_FUN *fun = NULL;
216 SNOOP16_RETURNENTRIES **rets = &firstrets;
217 SNOOP16_RETURNENTRY *ret;
218 int i,max;
220 while (dll) {
221 if (xcs == dll->funhandle) {
222 fun = (SNOOP16_FUN*)entry;
223 ordinal = fun-dll->funs;
224 break;
226 dll=dll->next;
228 if (!dll) {
229 FIXME(snoop,"entrypoint 0x%08lx not found\n",entry);
230 return; /* oops */
232 while (*rets) {
233 for (i=0;i<sizeof((*rets)->entry)/sizeof((*rets)->entry[0]);i++)
234 if (!(*rets)->entry[i].origreturn)
235 break;
236 if (i!=sizeof((*rets)->entry)/sizeof((*rets)->entry[0]))
237 break;
238 rets = &((*rets)->next);
240 if (!*rets) {
241 HANDLE16 hand = GlobalHandleToSel(GLOBAL_Alloc(GMEM_ZEROINIT,65535,0,TRUE,FALSE,FALSE));
242 *rets = GlobalLock16(hand);
243 memset(*rets,0,65535);
244 (*rets)->rethandle = hand;
245 i = 0; /* entry 0 is free */
247 ret = &((*rets)->entry[i]);
248 ret->lcall = 0x9a;
249 ret->snr = MAKELONG(sizeof(SNOOP16_RELAY),xsnr);
250 ret->origreturn = (FARPROC16)CALLER1REF;
251 CALLER1REF = MAKELONG((char*)&(ret->lcall)-(char*)((*rets)->entry),(*rets)->rethandle);
252 ret->dll = dll;
253 ret->args = NULL;
254 ret->ordinal = ordinal;
255 ret->origSP = SP_reg(context);
257 IP_reg(context)= LOWORD(fun->origfun);
258 CS_reg(context)= HIWORD(fun->origfun);
261 DPRINTF("Call %s.%ld: %s(",dll->name,ordinal,fun->name);
262 if (fun->nrofargs>0) {
263 max = fun->nrofargs;
264 if (max>16) max=16;
265 for (i=max;i--;)
266 DPRINTF("%04x%s",*(WORD*)(PTR_SEG_OFF_TO_LIN(SS_reg(context),SP_reg(context))+8+sizeof(WORD)*i),i?",":"");
267 if (max!=fun->nrofargs)
268 DPRINTF(" ...");
269 } else if (fun->nrofargs<0) {
270 DPRINTF("<unknown, check return>");
271 ret->args = HeapAlloc(SystemHeap,0,16*sizeof(WORD));
272 memcpy(ret->args,(LPBYTE)(PTR_SEG_OFF_TO_LIN(SS_reg(context),SP_reg(context))+8),sizeof(WORD)*16);
274 DPRINTF(") ret=%04x:%04x\n",HIWORD(ret->origreturn),LOWORD(ret->origreturn));
277 void WINAPI SNOOP16_Return(CONTEXT *context) {
278 SNOOP16_RETURNENTRY *ret = (SNOOP16_RETURNENTRY*)(PTR_SEG_OFF_TO_LIN(CS_reg(context),IP_reg(context))-5);
280 /* We haven't found out the nrofargs yet. If we called a cdecl
281 * function it is too late anyway and we can just set '0' (which
282 * will be the difference between orig and current SP
283 * If pascal -> everything ok.
285 if (ret->dll->funs[ret->ordinal].nrofargs<0) {
286 ret->dll->funs[ret->ordinal].nrofargs=(SP_reg(context)-ret->origSP-4)/2;
288 IP_reg(context) = LOWORD(ret->origreturn);
289 CS_reg(context) = HIWORD(ret->origreturn);
290 if (ret->args) {
291 int i,max;
293 DPRINTF("Ret %s.%ld: %s(",ret->dll->name,ret->ordinal,ret->dll->funs[ret->ordinal].name);
294 max = ret->dll->funs[ret->ordinal].nrofargs;
295 if (max>16)
296 max=16;
297 if (max<0)
298 max=0;
300 for (i=max;i--;)
301 DPRINTF("%04x%s",ret->args[i],i?",":"");
302 if (max!=ret->dll->funs[ret->ordinal].nrofargs)
303 DPRINTF(" ...");
304 DPRINTF(") retval = %04x:%04x ret=%04x:%04x\n",
305 DX_reg(context),AX_reg(context),HIWORD(ret->origreturn),LOWORD(ret->origreturn)
307 HeapFree(SystemHeap,0,ret->args);
308 ret->args = NULL;
309 } else
310 DPRINTF("Ret %s.%ld: %s() retval = %04x:%04x ret=%04x:%04x\n",
311 ret->dll->name,ret->ordinal,ret->dll->funs[ret->ordinal].name,
312 DX_reg(context),AX_reg(context),HIWORD(ret->origreturn),LOWORD(ret->origreturn)
314 ret->origreturn = NULL; /* mark as empty */
316 #else /* !__i386__ */
317 void SNOOP16_RegisterDLL(NE_MODULE *pModule,LPCSTR name) {
318 FIXME(snoop,"snooping works only on i386 for now.\n");
319 return;
322 FARPROC16 SNOOP16_GetProcAddress16(HMODULE16 hmod,DWORD ordinal,FARPROC16 origfun) {
323 return origfun;
325 #endif /* !__i386__ */
327 void
328 SNOOP16_Init() {
329 fnSNOOP16_GetProcAddress16=SNOOP16_GetProcAddress16;
330 fnSNOOP16_RegisterDLL=SNOOP16_RegisterDLL;