handle other TRANSFER commands not used by USB ;-)
This commit is contained in:
parent
0b50c513ef
commit
ac9e3f59d8
63
usb-driver.c
63
usb-driver.c
@ -53,6 +53,7 @@ static int ints_enabled = 0;
|
|||||||
static pthread_mutex_t int_wait = PTHREAD_MUTEX_INITIALIZER;
|
static pthread_mutex_t int_wait = PTHREAD_MUTEX_INITIALIZER;
|
||||||
|
|
||||||
#define NO_WINDRVR 1
|
#define NO_WINDRVR 1
|
||||||
|
#undef PARPORT
|
||||||
|
|
||||||
#ifdef DEBUG
|
#ifdef DEBUG
|
||||||
#define DPRINTF(format, args...) fprintf(stderr, format, ##args)
|
#define DPRINTF(format, args...) fprintf(stderr, format, ##args)
|
||||||
@ -230,6 +231,33 @@ int usb_deviceinfo(unsigned char *buf) {
|
|||||||
return len;
|
return len;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
int pp_transfer(WD_TRANSFER *tr, int fd, unsigned int request, unsigned char *wdioctl) {
|
||||||
|
int ret = 0;
|
||||||
|
|
||||||
|
DPRINTF("dwPort: 0x%lx, cmdTrans: %lu, dwbytes: %ld, fautoinc: %ld, dwoptions: %ld\n",
|
||||||
|
(unsigned long)tr->dwPort, tr->cmdTrans, tr->dwBytes,
|
||||||
|
tr->fAutoinc, tr->dwOptions);
|
||||||
|
|
||||||
|
#ifdef DEBUG
|
||||||
|
if (tr->cmdTrans == 13)
|
||||||
|
DPRINTF("write byte: %d\n", tr->Data.Byte);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifndef NO_WINDRVR
|
||||||
|
ret = (*ioctl_func) (fd, request, wdioctl);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
DPRINTF("dwPortReturn: 0x%lx, cmdTrans: %lu, dwbytes: %ld, fautoinc: %ld, dwoptions: %ld\n",
|
||||||
|
(unsigned long)tr->dwPort, tr->cmdTrans, tr->dwBytes,
|
||||||
|
tr->fAutoinc, tr->dwOptions);
|
||||||
|
#ifdef DEBUG
|
||||||
|
if (tr->cmdTrans == 10)
|
||||||
|
DPRINTF("read byte: %d\n", tr->Data.Byte);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
|
int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
|
||||||
struct header_struct* wdheader = (struct header_struct*)wdioctl;
|
struct header_struct* wdheader = (struct header_struct*)wdioctl;
|
||||||
struct version_struct *version;
|
struct version_struct *version;
|
||||||
@ -255,12 +283,16 @@ int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
|
|||||||
case CARD_REGISTER_OLD:
|
case CARD_REGISTER_OLD:
|
||||||
case CARD_REGISTER:
|
case CARD_REGISTER:
|
||||||
/* TODO: Implement for LPT-support */
|
/* TODO: Implement for LPT-support */
|
||||||
#if 0
|
#ifdef PARPORT
|
||||||
{
|
{
|
||||||
struct card_register* cr = (struct card_register*)(wdheader->data);
|
struct card_register* cr = (struct card_register*)(wdheader->data);
|
||||||
#ifndef NO_WINDRVR
|
#ifndef NO_WINDRVR
|
||||||
ret = (*ioctl_func) (fd, request, wdioctl);
|
ret = (*ioctl_func) (fd, request, wdioctl);
|
||||||
|
#else
|
||||||
|
/* TODO: Open /dev/parport, check, ... */
|
||||||
|
cr->hCard = 1;
|
||||||
#endif
|
#endif
|
||||||
|
DPRINTF("hCard: %lu\n", cr->hCard);
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
DPRINTF("CARD_REGISTER\n");
|
DPRINTF("CARD_REGISTER\n");
|
||||||
@ -526,16 +558,37 @@ int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
|
|||||||
case TRANSFER_OLD:
|
case TRANSFER_OLD:
|
||||||
case TRANSFER:
|
case TRANSFER:
|
||||||
DPRINTF("TRANSFER\n");
|
DPRINTF("TRANSFER\n");
|
||||||
#ifndef NO_WINDRVR
|
{
|
||||||
ret = (*ioctl_func) (fd, request, wdioctl);
|
WD_TRANSFER *tr = (WD_TRANSFER*)(wdheader->data);
|
||||||
#endif
|
|
||||||
|
ret = pp_transfer(tr, fd, request, wdioctl);
|
||||||
|
}
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case MULTI_TRANSFER:
|
case MULTI_TRANSFER:
|
||||||
DPRINTF("MULTI_TRANSFER\n");
|
DPRINTF("MULTI_TRANSFER\n");
|
||||||
|
{
|
||||||
|
WD_TRANSFER *tr = (WD_TRANSFER*)(wdheader->data);
|
||||||
|
unsigned long num = wdheader->size/sizeof(WD_TRANSFER);
|
||||||
|
int i;
|
||||||
|
|
||||||
|
|
||||||
|
for (i = 0; i < num; i++) {
|
||||||
|
DPRINTF("Transfer %d:\n", i+1);
|
||||||
#ifndef NO_WINDRVR
|
#ifndef NO_WINDRVR
|
||||||
ret = (*ioctl_func) (fd, request, wdioctl);
|
wdheader->size = sizeof(WD_TRANSFER);
|
||||||
|
request = TRANSFER;
|
||||||
|
wdheader->data = tr + i;
|
||||||
#endif
|
#endif
|
||||||
|
ret = pp_transfer(tr + i, fd, request, wdioctl);
|
||||||
|
}
|
||||||
|
|
||||||
|
#ifndef NO_WINDRVR
|
||||||
|
wdheader->data = tr;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case EVENT_UNREGISTER:
|
case EVENT_UNREGISTER:
|
||||||
|
Reference in New Issue
Block a user