1 /* libusb/ppdev connector for XILINX impact
3 * Copyright (c) 2007 Michael Gernoth <michael@gernoth.net>
5 * Permission is hereby granted, free of charge, to any person obtaining a copy
6 * of this software and associated documentation files (the "Software"), to
7 * deal in the Software without restriction, including without limitation the
8 * rights to use, copy, modify, merge, publish, distribute, sublicense, and/or
9 * sell copies of the Software, and to permit persons to whom the Software is
10 * furnished to do so, subject to the following conditions:
12 * The above copyright notice and this permission notice shall be included in
13 * all copies or substantial portions of the Software.
15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
18 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
20 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
32 #include <sys/types.h>
41 #include <sys/ioctl.h>
42 #include <linux/parport.h>
43 #include <linux/ppdev.h>
44 #include "usb-driver.h"
46 static int (*ioctl_func
) (int, int, void *) = NULL
;
47 static int windrvrfd
= -1;
48 static int parportfd
= -1;
49 static int parportnum
= 0;
50 static unsigned long ppbase
= 0;
51 static unsigned long ecpbase
= 0;
52 FILE *modulesfp
= NULL
;
53 static int modules_read
= 0;
54 static struct usb_bus
*busses
= NULL
;
55 static struct usb_device
*usbdevice
;
56 static usb_dev_handle
*usb_devhandle
= NULL
;
57 static int usbinterface
= -1;
58 static unsigned long card_type
;
59 static int ints_enabled
= 0;
60 static pthread_mutex_t int_wait
= PTHREAD_MUTEX_INITIALIZER
;
65 #define DPRINTF(format, args...) fprintf(stderr, format, ##args)
66 void hexdump(unsigned char *buf
, int len
) {
69 for(i
=0; i
<len
; i
++) {
70 fprintf(stderr
,"%02x ", buf
[i
]);
77 #define DPRINTF(format, args...)
80 int usb_deviceinfo(unsigned char *buf
) {
83 WDU_CONFIGURATION
**pConfigs
, **pActiveConfig
;
84 WDU_INTERFACE
**pActiveInterface
;
87 struct usb_device_info
*udi
= (struct usb_device_info
*)(buf
+len
);
89 udi
->Descriptor
.bLength
= sizeof(WDU_DEVICE_DESCRIPTOR
);
90 udi
->Descriptor
.bDescriptorType
= usbdevice
->descriptor
.bDescriptorType
;
91 udi
->Descriptor
.bcdUSB
= usbdevice
->descriptor
.bcdUSB
;
92 udi
->Descriptor
.bDeviceClass
= usbdevice
->descriptor
.bDeviceClass
;
93 udi
->Descriptor
.bDeviceSubClass
= usbdevice
->descriptor
.bDeviceSubClass
;
94 udi
->Descriptor
.bDeviceProtocol
= usbdevice
->descriptor
.bDeviceProtocol
;
95 udi
->Descriptor
.bMaxPacketSize0
= usbdevice
->descriptor
.bMaxPacketSize0
;
96 udi
->Descriptor
.idVendor
= usbdevice
->descriptor
.idVendor
;
97 udi
->Descriptor
.idProduct
= usbdevice
->descriptor
.idProduct
;
98 udi
->Descriptor
.bcdDevice
= usbdevice
->descriptor
.bcdDevice
;
99 udi
->Descriptor
.iManufacturer
= usbdevice
->descriptor
.iManufacturer
;
100 udi
->Descriptor
.iProduct
= usbdevice
->descriptor
.iProduct
;
101 udi
->Descriptor
.iSerialNumber
= usbdevice
->descriptor
.iSerialNumber
;
102 udi
->Descriptor
.bNumConfigurations
= usbdevice
->descriptor
.bNumConfigurations
;
104 /* TODO: Fix Pipe0! */
105 udi
->Pipe0
.dwNumber
= 0x00;
106 udi
->Pipe0
.dwMaximumPacketSize
= usbdevice
->descriptor
.bMaxPacketSize0
;
108 udi
->Pipe0
.direction
= WDU_DIR_IN_OUT
;
109 udi
->Pipe0
.dwInterval
= 0;
111 pConfigs
= &(udi
->pConfigs
);
112 pActiveConfig
= &(udi
->pActiveConfig
);
113 pActiveInterface
= &(udi
->pActiveInterface
[0]);
116 len
= sizeof(struct usb_device_info
);
118 for (i
=0; i
<usbdevice
->descriptor
.bNumConfigurations
; i
++)
120 struct usb_config_descriptor
*conf_desc
= &usbdevice
->config
[i
];
121 WDU_INTERFACE
**pInterfaces
;
122 WDU_ALTERNATE_SETTING
**pAlternateSettings
[conf_desc
->bNumInterfaces
];
123 WDU_ALTERNATE_SETTING
**pActiveAltSetting
[conf_desc
->bNumInterfaces
];
126 WDU_CONFIGURATION
*cfg
= (WDU_CONFIGURATION
*)(buf
+len
);
129 *pActiveConfig
= cfg
;
131 cfg
->Descriptor
.bLength
= conf_desc
->bLength
;
132 cfg
->Descriptor
.bDescriptorType
= conf_desc
->bDescriptorType
;
133 cfg
->Descriptor
.wTotalLength
= conf_desc
->wTotalLength
;
134 cfg
->Descriptor
.bNumInterfaces
= conf_desc
->bNumInterfaces
;
135 cfg
->Descriptor
.bConfigurationValue
= conf_desc
->bConfigurationValue
;
136 cfg
->Descriptor
.iConfiguration
= conf_desc
->iConfiguration
;
137 cfg
->Descriptor
.bmAttributes
= conf_desc
->bmAttributes
;
138 cfg
->Descriptor
.MaxPower
= conf_desc
->MaxPower
;
140 cfg
->dwNumInterfaces
= conf_desc
->bNumInterfaces
;
142 pInterfaces
= &(cfg
->pInterfaces
);
144 len
+= sizeof(WDU_CONFIGURATION
);
147 *pInterfaces
= (WDU_INTERFACE
*)(buf
+len
);
148 for (j
=0; j
<conf_desc
->bNumInterfaces
; j
++) {
149 WDU_INTERFACE
*iface
= (WDU_INTERFACE
*)(buf
+len
);
151 pActiveInterface
[j
] = iface
;
153 pAlternateSettings
[j
] = &(iface
->pAlternateSettings
);
154 iface
->dwNumAltSettings
= usbdevice
->config
[i
].interface
[j
].num_altsetting
;
155 pActiveAltSetting
[j
] = &(iface
->pActiveAltSetting
);
157 len
+= sizeof(WDU_INTERFACE
);
160 len
+= sizeof(WDU_INTERFACE
) * conf_desc
->bNumInterfaces
;
163 for (j
=0; j
<conf_desc
->bNumInterfaces
; j
++)
165 struct usb_interface
*interface
= &usbdevice
->config
[i
].interface
[j
];
168 *pAlternateSettings
[j
] = (WDU_ALTERNATE_SETTING
*)(buf
+len
);
170 *pActiveAltSetting
[j
] = (WDU_ALTERNATE_SETTING
*)(buf
+len
);
173 for(k
=0; k
<interface
->num_altsetting
; k
++)
175 unsigned char bNumEndpoints
= interface
->altsetting
[k
].bNumEndpoints
;
176 WDU_ENDPOINT_DESCRIPTOR
**pEndpointDescriptors
;
177 WDU_PIPE_INFO
**pPipes
;
180 WDU_ALTERNATE_SETTING
*altset
= (WDU_ALTERNATE_SETTING
*)(buf
+len
);
182 altset
->Descriptor
.bLength
= interface
->altsetting
[k
].bLength
;
183 altset
->Descriptor
.bDescriptorType
= interface
->altsetting
[k
].bDescriptorType
;
184 altset
->Descriptor
.bInterfaceNumber
= interface
->altsetting
[k
].bInterfaceNumber
;
185 altset
->Descriptor
.bAlternateSetting
= interface
->altsetting
[k
].bAlternateSetting
;
186 altset
->Descriptor
.bNumEndpoints
= interface
->altsetting
[k
].bNumEndpoints
;
187 altset
->Descriptor
.bInterfaceClass
= interface
->altsetting
[k
].bInterfaceClass
;
188 altset
->Descriptor
.bInterfaceSubClass
= interface
->altsetting
[k
].bInterfaceSubClass
;
189 altset
->Descriptor
.bInterfaceProtocol
= interface
->altsetting
[k
].bInterfaceProtocol
;
190 altset
->Descriptor
.iInterface
= interface
->altsetting
[k
].iInterface
;
191 pEndpointDescriptors
= &(altset
->pEndpointDescriptors
);
192 pPipes
= &(altset
->pPipes
);
195 len
+=sizeof(WDU_ALTERNATE_SETTING
);
198 *pEndpointDescriptors
= (WDU_ENDPOINT_DESCRIPTOR
*)(buf
+len
);
199 for (l
= 0; l
< bNumEndpoints
; l
++) {
200 WDU_ENDPOINT_DESCRIPTOR
*ed
= (WDU_ENDPOINT_DESCRIPTOR
*)(buf
+len
);
202 ed
->bLength
= interface
->altsetting
[k
].endpoint
[l
].bLength
;
203 ed
->bDescriptorType
= interface
->altsetting
[k
].endpoint
[l
].bDescriptorType
;
204 ed
->bEndpointAddress
= interface
->altsetting
[k
].endpoint
[l
].bEndpointAddress
;
205 ed
->bmAttributes
= interface
->altsetting
[k
].endpoint
[l
].bmAttributes
;
206 ed
->wMaxPacketSize
= interface
->altsetting
[k
].endpoint
[l
].wMaxPacketSize
;
207 ed
->bInterval
= interface
->altsetting
[k
].endpoint
[l
].bInterval
;
209 len
+= sizeof(WDU_ENDPOINT_DESCRIPTOR
);
212 *pPipes
= (WDU_PIPE_INFO
*)(buf
+len
);
213 for (l
= 0; l
< bNumEndpoints
; l
++) {
214 WDU_PIPE_INFO
*pi
= (WDU_PIPE_INFO
*)(buf
+len
);
216 pi
->dwNumber
= interface
->altsetting
[k
].endpoint
[l
].bEndpointAddress
;
217 pi
->dwMaximumPacketSize
= WDU_GET_MAX_PACKET_SIZE(interface
->altsetting
[k
].endpoint
[l
].wMaxPacketSize
);
218 pi
->type
= interface
->altsetting
[k
].endpoint
[l
].bmAttributes
& USB_ENDPOINT_TYPE_MASK
;
219 if (pi
->type
== PIPE_TYPE_CONTROL
)
220 pi
->direction
= WDU_DIR_IN_OUT
;
223 pi
->direction
= interface
->altsetting
[k
].endpoint
[l
].bEndpointAddress
& USB_ENDPOINT_DIR_MASK
? WDU_DIR_IN
: WDU_DIR_OUT
;
226 pi
->dwInterval
= interface
->altsetting
[k
].endpoint
[l
].bInterval
;
228 len
+= sizeof(WDU_PIPE_INFO
);
231 len
+=(sizeof(WDU_ENDPOINT_DESCRIPTOR
)+sizeof(WDU_PIPE_INFO
))*bNumEndpoints
;
240 int pp_transfer(WD_TRANSFER
*tr
, int fd
, unsigned int request
, unsigned char *wdioctl
) {
242 unsigned long port
= (unsigned long)tr
->dwPort
;
245 DPRINTF("dwPort: 0x%lx, cmdTrans: %lu, dwbytes: %ld, fautoinc: %ld, dwoptions: %ld\n",
246 (unsigned long)tr
->dwPort
, tr
->cmdTrans
, tr
->dwBytes
,
247 tr
->fAutoinc
, tr
->dwOptions
);
252 if (tr
->cmdTrans
== 13)
253 DPRINTF("write byte: %d\n", val
);
257 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
262 if (port
== ppbase
+ PP_DATA
) {
263 DPRINTF("data port\n");
264 switch(tr
->cmdTrans
) {
266 ret
= 0; /* We don't support reading of the data port */
270 ret
= ioctl(parportfd
, PPWDATA
, &val
);
274 fprintf(stderr
,"!!!Unsupported TRANSFER command: %lu!!!\n", tr
->cmdTrans
);
278 } else if (port
== ppbase
+ PP_STATUS
) {
279 DPRINTF("status port\n");
280 switch(tr
->cmdTrans
) {
282 ret
= ioctl(parportfd
, PPRSTATUS
, &val
);
286 ret
= 0; /* Status Port is readonly */
290 fprintf(stderr
,"!!!Unsupported TRANSFER command: %lu!!!\n", tr
->cmdTrans
);
294 } else if (port
== ppbase
+ PP_CONTROL
) {
295 DPRINTF("control port\n");
296 switch(tr
->cmdTrans
) {
298 ret
= ioctl(parportfd
, PPRCONTROL
, &val
);
302 ret
= ioctl(parportfd
, PPWCONTROL
, &val
);
306 fprintf(stderr
,"!!!Unsupported TRANSFER command: %lu!!!\n", tr
->cmdTrans
);
310 } else if ((port
== ecpbase
+ PP_ECP_CFGA
) && ecpbase
) {
311 DPRINTF("ECP_CFGA port\n");
312 } else if ((port
== ecpbase
+ PP_ECP_CFGB
) && ecpbase
) {
313 DPRINTF("ECP_CFGB port\n");
314 } else if ((port
== ecpbase
+ PP_ECP_ECR
) && ecpbase
) {
315 DPRINTF("ECP_ECR port\n");
317 DPRINTF("access to unsupported address range!\n");
324 DPRINTF("dwPortReturn: 0x%lx, cmdTrans: %lu, dwbytes: %ld, fautoinc: %ld, dwoptions: %ld\n",
325 (unsigned long)tr
->dwPort
, tr
->cmdTrans
, tr
->dwBytes
,
326 tr
->fAutoinc
, tr
->dwOptions
);
328 if (tr
->cmdTrans
== 10)
329 DPRINTF("read byte: %d\n", tr
->Data
.Byte
);
335 int do_wdioctl(int fd
, unsigned int request
, unsigned char *wdioctl
) {
336 struct header_struct
* wdheader
= (struct header_struct
*)wdioctl
;
337 struct version_struct
*version
;
340 if (wdheader
->magic
!= MAGIC
) {
341 fprintf(stderr
,"!!!ERROR: magic header does not match!!!\n");
342 return (*ioctl_func
) (fd
, request
, wdioctl
);
345 switch(request
& ~(0xc0000000)) {
347 version
= (struct version_struct
*)(wdheader
->data
);
348 strcpy(version
->version
, "WinDriver no more");
349 version
->versionul
= 802;
350 DPRINTF("VERSION\n");
354 DPRINTF("LICENSE\n");
357 case CARD_REGISTER_OLD
:
359 DPRINTF("CARD_REGISTER\n");
361 struct card_register
* cr
= (struct card_register
*)(wdheader
->data
);
364 DPRINTF("Items: %lu, Addr: 0x%lx, bytes: %lu, bar: %lu\n",
366 (unsigned long)cr
->Card
.Item
[0].I
.IO
.dwAddr
,
367 cr
->Card
.Item
[0].I
.IO
.dwBytes
,
368 cr
->Card
.Item
[0].I
.IO
.dwBar
);
370 DPRINTF("Items: %lu, Addr: 0x%lx, bytes: %lu, bar: %lu\n",
372 (unsigned long)cr
->Card
.Item
[1].I
.IO
.dwAddr
,
373 cr
->Card
.Item
[1].I
.IO
.dwBytes
,
374 cr
->Card
.Item
[1].I
.IO
.dwBar
);
376 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
379 if (ppbase
&& ((unsigned long)cr
->Card
.Item
[0].I
.IO
.dwAddr
!= ppbase
))
382 snprintf(ppdev
, sizeof(ppdev
), "/dev/parport%d", parportnum
);
383 DPRINTF("opening %s\n", ppdev
);
384 parportfd
= open(ppdev
, O_RDWR
|O_EXCL
);
387 fprintf(stderr
,"Can't open %s: %s\n", ppdev
, strerror(errno
));
390 if (parportfd
>= 0) {
393 if (ioctl(parportfd
, PPCLAIM
) == -1)
397 pmode
= IEEE1284_MODE_COMPAT
;
398 if (ioctl(parportfd
, PPNEGOT
, &pmode
) == -1)
401 if (cr
->Card
.dwItems
> 1 && cr
->Card
.Item
[1].I
.IO
.dwAddr
) {
402 DPRINTF("ECP mode requested\n");
403 ecpbase
= (unsigned long)cr
->Card
.Item
[1].I
.IO
.dwAddr
;
404 /* TODO: Implement ECP mode */
406 pmode
= IEEE1284_MODE_ECP
;
408 if (ioctl(parportfd
, PPNEGOT
, &pmode
) == -1) {
410 pmode
= IEEE1284_MODE_COMPAT
;
411 if (ioctl(parportfd
, PPNEGOT
, &pmode
) == -1)
417 cr
->hCard
= parportfd
;
418 ppbase
= (unsigned long)cr
->Card
.Item
[0].I
.IO
.dwAddr
;
421 DPRINTF("hCard: %lu\n", cr
->hCard
);
426 DPRINTF("in USB_TRANSFER");
428 struct usb_transfer
*ut
= (struct usb_transfer
*)(wdheader
->data
);
431 DPRINTF(" unique: %lu, pipe: %lu, read: %lu, options: %lx, size: %lu, timeout: %lx\n",
432 ut
->dwUniqueID
, ut
->dwPipeNum
, ut
->fRead
,
433 ut
->dwOptions
, ut
->dwBufferSize
, ut
->dwTimeout
);
434 DPRINTF("setup packet: ");
435 hexdump(ut
->SetupPacket
, 8);
437 if (!ut
->fRead
&& ut
->dwBufferSize
)
439 hexdump(ut
->pBuffer
, ut
->dwBufferSize
);
444 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
446 /* http://www.jungo.com/support/documentation/windriver/802/wdusb_man_mhtml/node55.html#SECTION001213000000000000000 */
447 if (ut
->dwPipeNum
== 0) { /* control pipe */
448 int requesttype
, request
, value
, index
, size
;
449 requesttype
= ut
->SetupPacket
[0];
450 request
= ut
->SetupPacket
[1];
451 value
= ut
->SetupPacket
[2] | (ut
->SetupPacket
[3] << 8);
452 index
= ut
->SetupPacket
[4] | (ut
->SetupPacket
[5] << 8);
453 size
= ut
->SetupPacket
[6] | (ut
->SetupPacket
[7] << 8);
454 DPRINTF("requesttype: %x, request: %x, value: %u, index: %u, size: %u\n", requesttype
, request
, value
, index
, size
);
455 ret
= usb_control_msg(usb_devhandle
, requesttype
, request
, value
, index
, ut
->pBuffer
, size
, ut
->dwTimeout
);
458 ret
= usb_bulk_read(usb_devhandle
, ut
->dwPipeNum
, ut
->pBuffer
, ut
->dwBufferSize
, ut
->dwTimeout
);
461 ret
= usb_bulk_write(usb_devhandle
, ut
->dwPipeNum
, ut
->pBuffer
, ut
->dwBufferSize
, ut
->dwTimeout
);
466 fprintf(stderr
, "usb_transfer: %d (%s)\n", ret
, usb_strerror());
468 ut
->dwBytesTransferred
= ret
;
474 DPRINTF("Transferred: %lu (%s)\n",ut
->dwBytesTransferred
, (ut
->fRead
?"read":"write"));
475 if (ut
->fRead
&& ut
->dwBytesTransferred
)
478 hexdump(ut
->pBuffer
, ut
->dwBytesTransferred
);
486 DPRINTF("INT_ENABLE\n");
488 struct interrupt
*it
= (struct interrupt
*)(wdheader
->data
);
490 DPRINTF("Handle: %lu, Options: %lx, ncmds: %lu, enableok: %lu, count: %lu, lost: %lu, stopped: %lu\n",
491 it
->hInterrupt
, it
->dwOptions
,
492 it
->dwCmds
, it
->fEnableOk
, it
->dwCounter
,
493 it
->dwLost
, it
->fStopped
);
498 pthread_mutex_trylock(&int_wait
);
504 DPRINTF("INT_DISABLE\n");
506 struct interrupt
*it
= (struct interrupt
*)(wdheader
->data
);
508 DPRINTF("Handle: %lu, Options: %lx, ncmds: %lu, enableok: %lu, count: %lu, lost: %lu, stopped: %lu\n",
509 it
->hInterrupt
, it
->dwOptions
,
510 it
->dwCmds
, it
->fEnableOk
, it
->dwCounter
,
511 it
->dwLost
, it
->fStopped
);
513 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
518 if (pthread_mutex_trylock(&int_wait
) == EBUSY
)
519 pthread_mutex_unlock(&int_wait
);
521 DPRINTF("Handle: %lu, Options: %lx, ncmds: %lu, enableok: %lu, count: %lu, lost: %lu, stopped: %lu\n",
522 it
->hInterrupt
, it
->dwOptions
,
523 it
->dwCmds
, it
->fEnableOk
, it
->dwCounter
,
524 it
->dwLost
, it
->fStopped
);
528 case USB_SET_INTERFACE
:
529 DPRINTF("USB_SET_INTERFACE\n");
531 struct usb_set_interface
*usi
= (struct usb_set_interface
*)(wdheader
->data
);
533 DPRINTF("unique: %lu, interfacenum: %lu, alternatesetting: %lu, options: %lx\n",
534 usi
->dwUniqueID
, usi
->dwInterfaceNum
,
535 usi
->dwAlternateSetting
, usi
->dwOptions
);
537 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
541 usb_devhandle
= usb_open(usbdevice
);
543 /* FIXME: Select right interface! */
544 ret
= usb_claim_interface(usb_devhandle
, usbdevice
->config
[0].interface
[usi
->dwInterfaceNum
].altsetting
[usi
->dwAlternateSetting
].bInterfaceNumber
);
547 usbinterface
= usbdevice
->config
[0].interface
[usi
->dwInterfaceNum
].altsetting
[usi
->dwAlternateSetting
].bInterfaceNumber
;
548 ret
= usb_set_altinterface(usb_devhandle
, usi
->dwAlternateSetting
);
550 fprintf(stderr
, "usb_set_altinterface: %d\n", ret
);
552 fprintf(stderr
, "usb_set_configuration: %d (%s)\n", ret
, usb_strerror());
555 fprintf(stderr
, "usb_claim_interface: %d -> %d (%s)\n",
556 usbdevice
->config
[0].interface
[usi
->dwInterfaceNum
].altsetting
[usi
->dwAlternateSetting
].bInterfaceNumber
,
557 ret
, usb_strerror());
561 DPRINTF("unique: %lu, interfacenum: %lu, alternatesetting: %lu, options: %lx\n",
562 usi
->dwUniqueID
, usi
->dwInterfaceNum
,
563 usi
->dwAlternateSetting
, usi
->dwOptions
);
567 case USB_GET_DEVICE_DATA_OLD
:
568 case USB_GET_DEVICE_DATA
:
569 DPRINTF("USB_GET_DEVICE_DATA\n");
571 struct usb_get_device_data
*ugdd
= (struct usb_get_device_data
*)(wdheader
->data
);
574 DPRINTF("unique: %lu, bytes: %lu, options: %lx\n",
575 ugdd
->dwUniqueID
, ugdd
->dwBytes
,
578 pSize
= ugdd
->dwBytes
;
579 if (!ugdd
->dwBytes
) {
581 ugdd
->dwBytes
= usb_deviceinfo(NULL
);
584 usb_deviceinfo((unsigned char*)ugdd
->pBuf
);
589 case EVENT_REGISTER_OLD
:
591 DPRINTF("EVENT_REGISTER\n");
593 struct event
*e
= (struct event
*)(wdheader
->data
);
597 DPRINTF("handle: %lu, action: %lu, status: %lu, eventid: %lu, cardtype: %lu, kplug: %lu, options: %lu, dev: %lx:%lx, unique: %lu, ver: %lu, nummatch: %lu\n",
598 e
->handle
, e
->dwAction
,
599 e
->dwStatus
, e
->dwEventId
, e
->dwCardType
,
600 e
->hKernelPlugIn
, e
->dwOptions
,
601 e
->u
.Usb
.deviceId
.dwVendorId
,
602 e
->u
.Usb
.deviceId
.dwProductId
,
603 e
->u
.Usb
.dwUniqueID
, e
->dwEventVer
,
604 e
->dwNumMatchTables
);
606 for (i
= 0; i
< e
->dwNumMatchTables
; i
++) {
608 DPRINTF("match: dev: %04x:%04x, class: %x, subclass: %x, intclass: %x, intsubclass: %x, intproto: %x\n",
609 e
->matchTables
[i
].VendorId
,
610 e
->matchTables
[i
].ProductId
,
611 e
->matchTables
[i
].bDeviceClass
,
612 e
->matchTables
[i
].bDeviceSubClass
,
613 e
->matchTables
[i
].bInterfaceClass
,
614 e
->matchTables
[i
].bInterfaceSubClass
,
615 e
->matchTables
[i
].bInterfaceProtocol
);
617 for (bus
= busses
; bus
; bus
= bus
->next
) {
618 struct usb_device
*dev
;
620 for (dev
= bus
->devices
; dev
; dev
= dev
->next
) {
621 struct usb_device_descriptor
*desc
= &(dev
->descriptor
);
623 if((desc
->idVendor
== e
->matchTables
[i
].VendorId
) &&
624 (desc
->idProduct
== e
->matchTables
[i
].ProductId
) &&
625 (desc
->bDeviceClass
== e
->matchTables
[i
].bDeviceClass
) &&
626 (desc
->bDeviceSubClass
== e
->matchTables
[i
].bDeviceSubClass
)) {
628 for (ac
= 0; ac
< desc
->bNumConfigurations
; ac
++) {
629 struct usb_interface
*interface
= dev
->config
[ac
].interface
;
632 for (ai
= 0; ai
< interface
->num_altsetting
; ai
++) {
634 DPRINTF("intclass: %x, intsubclass: %x, intproto: %x\n",
635 interface
->altsetting
[i
].bInterfaceClass
,
636 interface
->altsetting
[i
].bInterfaceSubClass
,
637 interface
->altsetting
[i
].bInterfaceProtocol
);
639 if ((interface
->altsetting
[ai
].bInterfaceSubClass
== e
->matchTables
[i
].bInterfaceSubClass
) &&
640 (interface
->altsetting
[ai
].bInterfaceProtocol
== e
->matchTables
[i
].bInterfaceProtocol
)){
641 /* TODO: check interfaceClass! */
642 DPRINTF("found device with libusb\n");
644 card_type
= e
->dwCardType
;
654 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
660 DPRINTF("handle: %lu, action: %lu, status: %lu, eventid: %lu, cardtype: %lu, kplug: %lu, options: %lu, dev: %lx:%lx, unique: %lu, ver: %lu, nummatch: %lu\n",
661 e
->handle
, e
->dwAction
,
662 e
->dwStatus
, e
->dwEventId
, e
->dwCardType
,
663 e
->hKernelPlugIn
, e
->dwOptions
,
664 e
->u
.Usb
.deviceId
.dwVendorId
,
665 e
->u
.Usb
.deviceId
.dwProductId
,
666 e
->u
.Usb
.dwUniqueID
, e
->dwEventVer
,
667 e
->dwNumMatchTables
);
669 for (i
= 0; i
< e
->dwNumMatchTables
; i
++)
670 DPRINTF("match: dev: %04x:%04x, class: %x, subclass: %x, intclass: %x, intsubclass: %x, intproto: %x\n",
671 e
->matchTables
[i
].VendorId
,
672 e
->matchTables
[i
].ProductId
,
673 e
->matchTables
[i
].bDeviceClass
,
674 e
->matchTables
[i
].bDeviceSubClass
,
675 e
->matchTables
[i
].bInterfaceClass
,
676 e
->matchTables
[i
].bInterfaceSubClass
,
677 e
->matchTables
[i
].bInterfaceProtocol
);
684 DPRINTF("TRANSFER\n");
686 WD_TRANSFER
*tr
= (WD_TRANSFER
*)(wdheader
->data
);
688 ret
= pp_transfer(tr
, fd
, request
, wdioctl
);
692 case MULTI_TRANSFER_OLD
:
694 DPRINTF("MULTI_TRANSFER\n");
696 WD_TRANSFER
*tr
= (WD_TRANSFER
*)(wdheader
->data
);
697 unsigned long num
= wdheader
->size
/sizeof(WD_TRANSFER
);
701 for (i
= 0; i
< num
; i
++) {
702 DPRINTF("Transfer %d:\n", i
+1);
704 wdheader
->size
= sizeof(WD_TRANSFER
);
706 wdheader
->data
= tr
+ i
;
708 ret
= pp_transfer(tr
+ i
, fd
, request
, wdioctl
);
719 case EVENT_UNREGISTER
:
720 DPRINTF("EVENT_UNREGISTER\n");
722 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
727 DPRINTF("INT_WAIT\n");
729 struct interrupt
*it
= (struct interrupt
*)(wdheader
->data
);
731 DPRINTF("Handle: %lu, Options: %lx, ncmds: %lu, enableok: %lu, count: %lu, lost: %lu, stopped: %lu\n",
732 it
->hInterrupt
, it
->dwOptions
,
733 it
->dwCmds
, it
->fEnableOk
, it
->dwCounter
,
734 it
->dwLost
, it
->fStopped
);
737 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
740 if (it
->dwCounter
== 0) {
743 pthread_mutex_lock(&int_wait
);
744 pthread_mutex_unlock(&int_wait
);
747 pthread_mutex_lock(&int_wait
);
748 pthread_mutex_unlock(&int_wait
);
752 DPRINTF("INT_WAIT_RETURN: Handle: %lu, Options: %lx, ncmds: %lu, enableok: %lu, count: %lu, lost: %lu, stopped: %lu\n",
753 it
->hInterrupt
, it
->dwOptions
, it
->dwCmds
,
754 it
->fEnableOk
, it
->dwCounter
, it
->dwLost
,
759 case CARD_UNREGISTER
:
760 DPRINTF("CARD_UNREGISTER\n");
762 struct card_register
* cr
= (struct card_register
*)(wdheader
->data
);
764 DPRINTF("Addr: 0x%lx, bytes: %lu, bar: %lu\n",
765 (unsigned long)cr
->Card
.Item
[0].I
.IO
.dwAddr
,
766 cr
->Card
.Item
[0].I
.IO
.dwBytes
,
767 cr
->Card
.Item
[0].I
.IO
.dwBar
);
769 DPRINTF("hCard: %lu\n", cr
->hCard
);
772 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
774 if (parportfd
== cr
->hCard
&& parportfd
>= 0) {
775 ioctl(parportfd
, PPRELEASE
);
784 DPRINTF("EVENT_PULL\n");
786 struct event
*e
= (struct event
*)(wdheader
->data
);
790 DPRINTF("handle: %lu, action: %lu, status: %lu, eventid: %lu, cardtype: %lx, kplug: %lu, options: %lu, dev: %lx:%lx, unique: %lu, ver: %lu, nummatch: %lu\n",
791 e
->handle
, e
->dwAction
, e
->dwStatus
,
792 e
->dwEventId
, e
->dwCardType
, e
->hKernelPlugIn
,
793 e
->dwOptions
, e
->u
.Usb
.deviceId
.dwVendorId
,
794 e
->u
.Usb
.deviceId
.dwProductId
,
795 e
->u
.Usb
.dwUniqueID
, e
->dwEventVer
,
796 e
->dwNumMatchTables
);
798 for (i
= 0; i
< e
->dwNumMatchTables
; i
++)
799 DPRINTF("match: dev: %04x:%04x, class: %x, subclass: %x, intclass: %x, intsubclass: %x, intproto: %x\n",
800 e
->matchTables
[i
].VendorId
,
801 e
->matchTables
[i
].ProductId
,
802 e
->matchTables
[i
].bDeviceClass
,
803 e
->matchTables
[i
].bDeviceSubClass
,
804 e
->matchTables
[i
].bInterfaceClass
,
805 e
->matchTables
[i
].bInterfaceSubClass
,
806 e
->matchTables
[i
].bInterfaceProtocol
);
810 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
813 struct usb_interface
*interface
= usbdevice
->config
->interface
;
815 e
->dwCardType
= card_type
;
818 e
->u
.Usb
.dwUniqueID
= 110;
819 e
->matchTables
[0].VendorId
= usbdevice
->descriptor
.idVendor
;
820 e
->matchTables
[0].ProductId
= usbdevice
->descriptor
.idProduct
;
821 e
->matchTables
[0].bDeviceClass
= usbdevice
->descriptor
.bDeviceClass
;
822 e
->matchTables
[0].bDeviceSubClass
= usbdevice
->descriptor
.bDeviceSubClass
;
823 e
->matchTables
[0].bInterfaceClass
= interface
->altsetting
[0].bInterfaceClass
;
824 e
->matchTables
[0].bInterfaceSubClass
= interface
->altsetting
[0].bInterfaceSubClass
;
825 e
->matchTables
[0].bInterfaceProtocol
= interface
->altsetting
[0].bInterfaceProtocol
;
830 DPRINTF("handle: %lu, action: %lu, status: %lu, eventid: %lu, cardtype: %lx, kplug: %lu, options: %lu, dev: %lx:%lx, unique: %lu, ver: %lu, nummatch: %lu\n",
831 e
->handle
, e
->dwAction
, e
->dwStatus
,
832 e
->dwEventId
, e
->dwCardType
, e
->hKernelPlugIn
,
833 e
->dwOptions
, e
->u
.Usb
.deviceId
.dwVendorId
,
834 e
->u
.Usb
.deviceId
.dwProductId
,
835 e
->u
.Usb
.dwUniqueID
, e
->dwEventVer
,
836 e
->dwNumMatchTables
);
838 for (i
= 0; i
< e
->dwNumMatchTables
; i
++)
839 DPRINTF("match: dev: %04x:%04x, class: %x, subclass: %x, intclass: %x, intsubclass: %x, intproto: %x\n",
840 e
->matchTables
[i
].VendorId
,
841 e
->matchTables
[i
].ProductId
,
842 e
->matchTables
[i
].bDeviceClass
,
843 e
->matchTables
[i
].bDeviceSubClass
,
844 e
->matchTables
[i
].bInterfaceClass
,
845 e
->matchTables
[i
].bInterfaceSubClass
,
846 e
->matchTables
[i
].bInterfaceProtocol
);
853 fprintf(stderr
,"!!!Unsupported IOCTL: %x!!!\n", request
);
855 ret
= (*ioctl_func
) (fd
, request
, wdioctl
);
863 int ioctl(int fd
, unsigned long int request
, ...) {
869 ioctl_func
= (int (*) (int, int, void *)) dlsym (RTLD_NEXT
, "ioctl");
871 va_start (args
, request
);
872 argp
= va_arg (args
, void *);
876 ret
= do_wdioctl(fd
, request
, argp
);
878 ret
= (*ioctl_func
) (fd
, request
, argp
);
883 int open (const char *pathname
, int flags
, ...) {
884 static int (*func
) (const char *, int, mode_t
) = NULL
;
890 func
= (int (*) (const char *, int, mode_t
)) dlsym (RTLD_NEXT
, "open");
892 if (flags
& O_CREAT
) {
893 va_start(args
, flags
);
894 mode
= va_arg(args
, mode_t
);
898 if (!strcmp (pathname
, "/dev/windrvr6")) {
899 DPRINTF("opening windrvr6\n");
901 windrvrfd
= fd
= (*func
) ("/dev/null", flags
, mode
);
903 windrvrfd
= fd
= (*func
) (pathname
, flags
, mode
);
910 busses
= usb_get_busses();
916 return (*func
) (pathname
, flags
, mode
);
920 static int (*func
) (int) = NULL
;
923 func
= (int (*) (int)) dlsym(RTLD_NEXT
, "close");
925 if (fd
== windrvrfd
&& windrvrfd
>= 0) {
926 DPRINTF("close windrvrfd\n");
927 if (usbinterface
>= 0)
928 usb_release_interface(usb_devhandle
, usbinterface
);
931 usb_close(usb_devhandle
);
933 usb_devhandle
= NULL
;
941 FILE *fopen(const char *path
, const char *mode
) {
943 static FILE* (*func
) (const char*, const char*) = NULL
;
946 func
= (FILE* (*) (const char*, const char*)) dlsym(RTLD_NEXT
, "fopen");
948 ret
= (*func
) (path
, mode
);
950 if (!strcmp (path
, "/proc/modules")) {
951 DPRINTF("opening /proc/modules\n");
961 char *fgets(char *s
, int size
, FILE *stream
) {
962 static char* (*func
) (char*, int, FILE*) = NULL
;
963 const char modules
[][256] = {"windrvr6 1 0 - Live 0xdeadbeef\n", "parport_pc 1 0 - Live 0xdeadbeef\n"};
968 func
= (char* (*) (char*, int, FILE*)) dlsym(RTLD_NEXT
, "fgets");
970 if (modulesfp
== stream
) {
971 if (modules_read
< sizeof(modules
) / sizeof(modules
[0])) {
972 strcpy(s
, modules
[modules_read
]);
977 ret
= (*func
)(s
,size
,stream
);
983 int fclose(FILE *fp
) {
984 static int (*func
) (FILE*) = NULL
;
987 func
= (int (*) (FILE*)) dlsym(RTLD_NEXT
, "fclose");
989 if (fp
== modulesfp
) {
996 int access(const char *pathname
, int mode
) {
997 static int (*func
) (const char*, int);
1000 func
= (int (*) (const char*, int)) dlsym(RTLD_NEXT
, "access");
1002 if (!strcmp(pathname
, "/dev/windrvr6")) {
1005 return (*func
)(pathname
, mode
);