]>
git.zerfleddert.de Git - usb-driver/blob - usb-driver.c
1 #if defined(__GNUC__) && !defined(__STRICT_ANSI__)
6 #define REAL_LIBC RTLD_NEXT
8 #define REAL_LIBC ((void *) -1L)
17 #include <sys/types.h>
23 static int (*ioctl_func
) (int, int, void *) = NULL
;
24 static int windrvrfd
= 0;
26 void hexdump(unsigned char *buf
, int len
);
27 void diff(unsigned char *buf1
, unsigned char *buf2
, int len
);
29 int do_wdioctl(int fd
, unsigned int request
, unsigned char *wdioctl
) {
30 struct header_struct
* wdheader
= (struct header_struct
*)wdioctl
;
31 struct version_struct
*version
;
34 if (wdheader
->magic
!= MAGIC
) {
35 fprintf(stderr
,"!!!ERROR: magic header does not match!!!\n");
36 return (*ioctl_func
) (fd
, request
, wdioctl
);
41 version
= (struct version_struct
*)(wdheader
->data
);
42 strcpy(version
->version
, "WinDriver no more");
43 version
->versionul
= 999;
44 fprintf(stderr
,"faking VERSION\n");
48 fprintf(stderr
,"faking LICENSE\n");
53 //struct card_register* cr = (struct card_register*)(wdheader->data);
54 /* Todo: LPT-Port already in use */
56 fprintf(stderr
,"faking CARD_REGISTER\n");
60 fprintf(stderr
,"in USB_TRANSFER");
62 struct usb_transfer
*ut
= (struct usb_transfer
*)(wdheader
->data
);
64 fprintf(stderr
," unique: %lu, pipe: %lu, read: %lu, options: %lx, size: %lu, timeout: %lx\n", ut
->dwUniqueID
, ut
->dwPipeNum
, ut
->fRead
, ut
->dwOptions
, ut
->dwBufferSize
, ut
->dwTimeout
);
65 fprintf(stderr
,"setup packet: ");
66 hexdump(ut
->SetupPacket
, 8);
68 if (!ut
->fRead
&& ut
->dwBufferSize
)
70 hexdump(ut
->pBuffer
, ut
->dwBufferSize
);
74 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
76 fprintf(stderr
,"Transferred: %lu (%s)\n",ut
->dwBytesTransferred
, (ut
->fRead
?"read":"write"));
77 if (ut
->fRead
&& ut
->dwBytesTransferred
)
79 fprintf(stderr
,"Read: ");
80 hexdump(ut
->pBuffer
, ut
->dwBytesTransferred
);
87 fprintf(stderr
,"faking INT_ENABLE");
89 struct interrupt
*it
= (struct interrupt
*)(wdheader
->data
);
91 fprintf(stderr
," Handle: %lu, Options: %lx, ncmds: %lu\n", it
->hInterrupt
, it
->dwOptions
, it
->dwCmds
);
94 //ret = (*ioctl_func) (fd, request, wdioctl);
100 fprintf(stderr
,"INT_DISABLE\n");
102 struct interrupt
*it
= (struct interrupt
*)(wdheader
->data
);
104 fprintf(stderr
," Handle: %lu, Options: %lx, ncmds: %lu\n", it
->hInterrupt
, it
->dwOptions
, it
->dwCmds
);
106 hexdump(wdheader
->data
, wdheader
->size
);
109 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
110 fprintf(stderr
,"\n\n");
111 hexdump(wdheader
->data
, wdheader
->size
);
112 fprintf(stderr
,"\n");
116 case USB_SET_INTERFACE
:
117 fprintf(stderr
,"USB_SET_INTERFACE\n");
119 struct usb_set_interface
*usi
= (struct usb_set_interface
*)(wdheader
->data
);
121 fprintf(stderr
,"unique: %lu, interfacenum: %lu, alternatesetting: %lu, options: %lx\n", usi
->dwUniqueID
, usi
->dwInterfaceNum
, usi
->dwAlternateSetting
, usi
->dwOptions
);
122 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
126 case USB_GET_DEVICE_DATA
:
127 fprintf(stderr
,"USB_GET_DEVICE_DATA\n");
129 struct usb_get_device_data
*ugdd
= (struct usb_get_device_data
*)(wdheader
->data
);
132 fprintf(stderr
, "uniqe: %lu, bytes: %lu, options: %lx\n", ugdd
->dwUniqueID
, ugdd
->dwBytes
, ugdd
->dwOptions
);
133 pSize
= ugdd
->dwBytes
;
134 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
136 hexdump(ugdd
->pBuf
, pSize
);
137 fprintf(stderr
, "\n");
143 fprintf(stderr
,"TRANSFER\n");
144 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
147 case EVENT_UNREGISTER
:
148 fprintf(stderr
,"EVENT_UNREGISTER\n");
149 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
153 fprintf(stderr
,"INT_WAIT\n");
154 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
157 case CARD_UNREGISTER
:
158 fprintf(stderr
,"CARD_UNREGISTER\n");
159 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
163 fprintf(stderr
,"EVENT_PULL\n");
164 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
168 fprintf(stderr
,"EVENT_REGISTER\n");
169 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
173 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
180 typedef int (*open_funcptr_t
) (const char *, int, mode_t
);
182 int open (const char *pathname
, int flags
, ...)
184 static open_funcptr_t func
= NULL
;
190 func
= (open_funcptr_t
) dlsym (REAL_LIBC
, "open");
192 if (flags
& O_CREAT
) {
193 va_start(args
, flags
);
194 mode
= va_arg(args
, mode_t
);
198 fd
= (*func
) (pathname
, flags
, mode
);
200 if (!strcmp (pathname
, "/dev/windrvr6")) {
201 fprintf(stderr
,"opening windrvr6\n");
208 void diff(unsigned char *buf1
, unsigned char *buf2
, int len
) {
211 for(i
=0; i
<len
; i
++) {
212 if (buf1
[i
] != buf2
[i
]) {
213 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
]:'.'));
218 void hexdump(unsigned char *buf
, int len
) {
221 for(i
=0; i
<len
; i
++) {
222 fprintf(stderr
,"%02x ", buf
[i
]);
224 fprintf(stderr
,"\n");
228 int ioctl(int fd
, int request
, ...)
235 ioctl_func
= (int (*) (int, int, void *)) dlsym (REAL_LIBC
, "ioctl");
237 va_start (args
, request
);
238 argp
= va_arg (args
, void *);
242 ret
= do_wdioctl(fd
, request
, argp
);
244 ret
= (*ioctl_func
) (fd
, request
, argp
);
250 void *mmap(void *start
, size_t length
, int prot
, int flags
, int fd
, off_t offset
)
252 static void* (*func
) (void *, size_t, int, int, int, off_t
) = NULL
;
256 func
= (void* (*) (void *, size_t, int, int, int, off_t
)) dlsym (REAL_LIBC
, "mmap");
258 ret
= (*func
) (start
, length
, prot
, flags
, fd
, offset
);
259 fprintf(stderr
,"MMAP: %x, %d, %d, %d, %d, %d -> %x\n", (unsigned int)start
, length
, prot
, flags
, fd
, offset
, (unsigned int)ret
);
266 void *mmap64(void *start
, size_t length
, int prot
, int flags
, int fd
, off64_t offset
)
268 static void* (*func
) (void *, size_t, int, int, int, off64_t
) = NULL
;
272 func
= (void* (*) (void *, size_t, int, int, int, off64_t
)) dlsym (REAL_LIBC
, "mmap64");
274 ret
= (*func
) (start
, length
, prot
, flags
, fd
, offset
);
275 fprintf(stderr
,"MMAP64: %x, %d, %d, %d, %d, %lld -> %x\n", (unsigned int)start
, length
, prot
, flags
, fd
, offset
, (unsigned int)ret
);
282 void *mmap2(void *start
, size_t length
, int prot
, int flags
, int fd
, off_t pgoffset
)
284 static void* (*func
) (void *, size_t, int, int, int, off_t
) = NULL
;
288 func
= (void* (*) (void *, size_t, int, int, int, off_t
)) dlsym (REAL_LIBC
, "mmap2");
290 ret
= (*func
) (start
, length
, prot
, flags
, fd
, pgoffset
);
291 fprintf(stderr
,"MMAP2: %x, %d, %d, %d, %d, %d -> %x\n", (unsigned int)start
, length
, prot
, flags
, fd
, pgoffset
, (unsigned int)ret
);
298 void *malloc(size_t size
)
300 static void* (*func
) (size_t) = NULL
;
304 func
= (void* (*) (size_t)) dlsym(REAL_LIBC
, "malloc");
306 ret
= (*func
) (size
);
308 //fprintf(stderr,"MALLOC: %d -> %x\n", size, (unsigned int) ret);