]>
cvs.zerfleddert.de Git - usb-driver/blob - usb-driver.c
3ec84578f66f28ba0a5cc3bde547044c0a7cd1bc
1 #if defined(__GNUC__) && !defined(__STRICT_ANSI__)
6 #define REAL_LIBC RTLD_NEXT
8 #define REAL_LIBC ((void *) -1L)
17 #include <sys/types.h>
24 static unsigned char lastbuf
[4096];
26 void hexdump(unsigned char *buf
, int len
);
27 void diff(unsigned char *buf1
, unsigned char *buf2
, int len
);
29 void parse_wdioctlreq(unsigned char *wdioctl
, unsigned int request
) {
30 struct header_struct
* wdheader
= (struct header_struct
*)wdioctl
;
32 if (wdheader
->magic
!= MAGIC
) {
33 fprintf(stderr
,"!!!ERROR: Header does not match!!!\n");
37 fprintf(stderr
, "Request: ");
40 fprintf(stderr
,"VERSION");
43 fprintf(stderr
,"LICENSE");
44 fprintf(stderr
," \"%s\" (XX,XX)", ((struct license_struct
*)(wdheader
->data
))->cLicense
);
47 fprintf(stderr
,"TRANSFER");
50 fprintf(stderr
,"USB_TRANSFER");
53 struct usb_transfer
*ut
= (struct usb_transfer
*)(wdheader
->data
);
55 fprintf(stderr
," unique: %d, pipe: %d, read: %d, options: %x, size: %d, timeout: %x\n", ut
->dwUniqueID
, ut
->dwPipeNum
, ut
->fRead
, ut
->dwOptions
, ut
->dwBufferSize
, ut
->dwTimeout
);
56 memcpy(lastbuf
, ut
->pBuffer
, ut
->dwBufferSize
);
57 hexdump(ut
->pBuffer
, ut
->dwBufferSize
);
63 case EVENT_UNREGISTER
:
64 fprintf(stderr
,"EVENT_UNREGISTER");
67 fprintf(stderr
,"INT_DISABLE");
70 fprintf(stderr
,"INT_WAIT");
73 fprintf(stderr
,"CARD_UNREGISTER");
75 case USB_GET_DEVICE_DATA
:
76 fprintf(stderr
,"USB_GET_DEVICE_DATA");
79 fprintf(stderr
,"INT_ENABLE");
82 fprintf(stderr
,"EVENT_PULL");
84 case USB_SET_INTERFACE
:
85 fprintf(stderr
,"USB_SET_INTERFACE");
89 struct event
*e
= (struct event
*)(wdheader
->data
);
90 fprintf(stderr
,"%x:%x ", e
->u
.Usb
.deviceId
.dwVendorId
, e
->u
.Usb
.deviceId
.dwProductId
);
91 fprintf(stderr
,"match: %04x:%04x\n", e
->matchTables
[0].VendorId
, e
->matchTables
[0].ProductId
);
93 memcpy(lastbuf
, wdheader
->data
, wdheader
->size
);
94 fprintf(stderr
,"EVENT_REGISTER");
99 memcpy(lastbuf
, wdheader
->data
, wdheader
->size
);
100 fprintf(stderr
,"\n");
101 hexdump(wdheader
->data
, wdheader
->size
);
102 fprintf(stderr
,"\n");
103 fprintf(stderr
,"Unknown(%x)",request
);
106 fprintf(stderr
, ", size: %d\n", wdheader
->size
);
109 void parse_wdioctlans(unsigned char *wdioctl
, unsigned int request
, int result
) {
110 struct header_struct
* wdheader
= (struct header_struct
*)wdioctl
;
112 if (wdheader
->magic
!= MAGIC
) {
113 fprintf(stderr
,"!!!ERROR: Header does not match!!!\n");
117 fprintf(stderr
, "Answer: %d ", result
);
120 fprintf(stderr
,"\"%s\" (%d)", ((struct version_struct
*)(wdheader
->data
))->version
, ((struct version_struct
*)(wdheader
->data
))->versionul
);
123 fprintf(stderr
,"\"%s\" (XX,XX)", ((struct license_struct
*)(wdheader
->data
))->cLicense
);
126 case EVENT_UNREGISTER
:
129 case CARD_UNREGISTER
:
130 case USB_GET_DEVICE_DATA
:
133 case USB_SET_INTERFACE
:
137 fprintf(stderr
,"\n");
138 diff(lastbuf
, wdheader
->data
, wdheader
->size
);
143 struct usb_transfer
*ut
= (struct usb_transfer
*)(wdheader
->data
);
145 fprintf(stderr
,"\n");
146 hexdump(ut
->pBuffer
, ut
->dwBufferSize
);
147 fprintf(stderr
,"\n");
148 diff(lastbuf
, ut
->pBuffer
, ut
->dwBufferSize
);
153 fprintf(stderr
,"\n");
154 hexdump(wdheader
->data
, wdheader
->size
);
155 fprintf(stderr
,"\n");
156 diff(lastbuf
, wdheader
->data
, wdheader
->size
);
159 fprintf(stderr
, ", size: %d\n", wdheader
->size
);
162 int do_wdioctl(unsigned int request
, unsigned char *wdioctl
) {
163 struct header_struct
* wdheader
= (struct header_struct
*)wdioctl
;
164 struct version_struct
*version
;
166 if (wdheader
->magic
!= MAGIC
) {
167 fprintf(stderr
,"!!!ERROR: Header does not match!!!\n");
173 version
= (struct version_struct
*)(wdheader
->data
);
174 strcpy(version
->version
, "WinDriver no more");
175 version
->versionul
= 999;
176 fprintf(stderr
,"faking VERSION\n");
180 struct card_register
* cr
= (struct card_register
*)(wdheader
->data
);
181 /* Todo: LPT-Port already in use */
183 fprintf(stderr
,"faking CARD_REGISTER\n");
186 fprintf(stderr
,"in USB_TRANSFER");
188 struct usb_transfer
*ut
= (struct usb_transfer
*)(wdheader
->data
);
190 fprintf(stderr
," unique: %d, pipe: %d, read: %d, options: %x, size: %d, timeout: %x\n", ut
->dwUniqueID
, ut
->dwPipeNum
, ut
->fRead
, ut
->dwOptions
, ut
->dwBufferSize
, ut
->dwTimeout
);
191 fprintf(stderr
,"setup packet: ");
192 hexdump(ut
->SetupPacket
, 8);
193 if (!ut
->fRead
&& ut
->dwBufferSize
)
195 hexdump(ut
->pBuffer
, ut
->dwBufferSize
);
196 fprintf(stderr
,"\n");
201 case EVENT_UNREGISTER
:
204 case CARD_UNREGISTER
:
205 case USB_GET_DEVICE_DATA
:
208 case USB_SET_INTERFACE
:
218 typedef int (*open_funcptr_t
) (const char *, int, mode_t
);
220 static windrvrfd
= 0;
221 static void* mmapped
= NULL
;
222 static size_t mmapplen
= 0;
224 int open (const char *pathname
, int flags
, ...)
226 static open_funcptr_t func
= NULL
;
232 func
= (open_funcptr_t
) dlsym (REAL_LIBC
, "open");
234 if (flags
& O_CREAT
) {
235 va_start(args
, flags
);
236 mode
= va_arg(args
, mode_t
);
240 fd
= (*func
) (pathname
, flags
, mode
);
242 if (!strcmp (pathname
, "/dev/windrvr6")) {
243 fprintf(stderr
,"opening windrvr6\n");
250 void diff(unsigned char *buf1
, unsigned char *buf2
, int len
) {
253 for(i
=0; i
<len
; i
++) {
254 if (buf1
[i
] != buf2
[i
]) {
255 fprintf(stderr
,"Diff at %d: %02x(%c)->%02x(%c)\n", i
, buf1
[i
], ((buf1
[i
] >= 31 && buf1
[i
] <= 126)?buf1
[i
]:'.'), buf2
[i
], ((buf2
[i
] >= 31 && buf2
[i
] <= 126)?buf2
[i
]:'.'));
260 void hexdump(unsigned char *buf
, int len
) {
263 for(i
=0; i
<len
; i
++) {
264 fprintf(stderr
,"%02x ", buf
[i
]);
266 fprintf(stderr
,"\n");
270 int ioctl(int fd
, int request
, ...)
272 static int (*func
) (int, int, void *) = NULL
;
278 func
= (int (*) (int, int, void *)) dlsym (REAL_LIBC
, "ioctl");
280 va_start (args
, request
);
281 argp
= va_arg (args
, void *);
284 if (fd
== windrvrfd
) {
285 parse_wdioctlreq(argp
, request
);
287 if ((ret
= do_wdioctl(request
, argp
)))
288 ret
= (*func
) (fd
, request
, argp
);
290 ret
= (*func
) (fd
, request
, argp
);
293 if (fd
== windrvrfd
) {
294 parse_wdioctlans(argp
, request
, ret
);
300 void *mmap(void *start
, size_t length
, int prot
, int flags
, int fd
, off_t offset
)
302 static void* (*func
) (void *, size_t, int, int, int, off_t
) = NULL
;
306 func
= (void* (*) (void *, size_t, int, int, int, off_t
)) dlsym (REAL_LIBC
, "mmap");
308 ret
= (*func
) (start
, length
, prot
, flags
, fd
, offset
);
309 fprintf(stderr
,"MMAP: %x, %d, %d, %d, %d, %d -> %x\n", (unsigned int)start
, length
, prot
, flags
, fd
, offset
, (unsigned int)ret
);
316 void *mmap64(void *start
, size_t length
, int prot
, int flags
, int fd
, off64_t offset
)
318 static void* (*func
) (void *, size_t, int, int, int, off64_t
) = NULL
;
322 func
= (void* (*) (void *, size_t, int, int, int, off64_t
)) dlsym (REAL_LIBC
, "mmap64");
324 ret
= (*func
) (start
, length
, prot
, flags
, fd
, offset
);
325 fprintf(stderr
,"MMAP64: %x, %d, %d, %d, %d, %lld -> %x\n", (unsigned int)start
, length
, prot
, flags
, fd
, offset
, (unsigned int)ret
);
332 void *mmap2(void *start
, size_t length
, int prot
, int flags
, int fd
, off_t pgoffset
)
334 static void* (*func
) (void *, size_t, int, int, int, off_t
) = NULL
;
338 func
= (void* (*) (void *, size_t, int, int, int, off_t
)) dlsym (REAL_LIBC
, "mmap2");
340 ret
= (*func
) (start
, length
, prot
, flags
, fd
, pgoffset
);
341 fprintf(stderr
,"MMAP2: %x, %d, %d, %d, %d, %d -> %x\n", (unsigned int)start
, length
, prot
, flags
, fd
, pgoffset
, (unsigned int)ret
);
348 void *malloc(size_t size
)
350 static void* (*func
) (size_t) = NULL
;
354 func
= (void* (*) (size_t)) dlsym(REAL_LIBC
, "malloc");
356 ret
= (*func
) (size
);
358 //fprintf(stderr,"MALLOC: %d -> %x\n", size, (unsigned int) ret);