mirror of https://github.com/GOSTSec/sgminer
Browse Source
Conflicts: compat/libusb-1.0/doc/Makefile.am compat/libusb-1.0/doc/doxygen.cfg.in compat/libusb-1.0/examples/Makefile.am compat/libusb-1.0/examples/dpfp.c compat/libusb-1.0/examples/dpfp_threaded.c compat/libusb-1.0/examples/hotplugtest.c compat/libusb-1.0/examples/listdevs.c compat/libusb-1.0/examples/sam3u_benchmark.cnfactor-troky
Con Kolivas
11 years ago
9 changed files with 0 additions and 2979 deletions
@ -1,10 +0,0 @@
@@ -1,10 +0,0 @@
|
||||
EXTRA_DIST = doxygen.cfg.in |
||||
|
||||
docs: doxygen.cfg |
||||
doxygen $^ |
||||
|
||||
docs-upload: docs |
||||
ln -s html api-1.0 |
||||
rsync -av api-1.0/ web.sourceforge.net:htdocs/api-1.0/ |
||||
rm -f api-1.0 |
||||
|
File diff suppressed because it is too large
Load Diff
@ -1,15 +0,0 @@
@@ -1,15 +0,0 @@
|
||||
AM_CPPFLAGS = -I$(top_srcdir)/libusb |
||||
LDADD = ../libusb/libusb-1.0.la |
||||
noinst_PROGRAMS = listdevs hotplugtest testlibusb1 |
||||
|
||||
if HAVE_SIGACTION |
||||
noinst_PROGRAMS += dpfp |
||||
|
||||
if THREADS_POSIX |
||||
dpfp_threaded_CFLAGS = $(AM_CFLAGS) |
||||
noinst_PROGRAMS += dpfp_threaded |
||||
endif |
||||
|
||||
sam3u_benchmark_SOURCES = sam3u_benchmark.c |
||||
noinst_PROGRAMS += sam3u_benchmark |
||||
endif |
@ -1,507 +0,0 @@
@@ -1,507 +0,0 @@
|
||||
/*
|
||||
* libusb example program to manipulate U.are.U 4000B fingerprint scanner. |
||||
* Copyright (C) 2007 Daniel Drake <dsd@gentoo.org> |
||||
* |
||||
* Basic image capture program only, does not consider the powerup quirks or |
||||
* the fact that image encryption may be enabled. Not expected to work |
||||
* flawlessly all of the time. |
||||
* |
||||
* This library is free software; you can redistribute it and/or |
||||
* modify it under the terms of the GNU Lesser General Public |
||||
* License as published by the Free Software Foundation; either |
||||
* version 2.1 of the License, or (at your option) any later version. |
||||
* |
||||
* This library is distributed in the hope that it will be useful, |
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
||||
* Lesser General Public License for more details. |
||||
* |
||||
* You should have received a copy of the GNU Lesser General Public |
||||
* License along with this library; if not, write to the Free Software |
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
||||
*/ |
||||
|
||||
#include <errno.h> |
||||
#include <signal.h> |
||||
#include <string.h> |
||||
#include <stdio.h> |
||||
#include <stdlib.h> |
||||
|
||||
#include <libusb.h> |
||||
|
||||
#define EP_INTR (1 | LIBUSB_ENDPOINT_IN) |
||||
#define EP_DATA (2 | LIBUSB_ENDPOINT_IN) |
||||
#define CTRL_IN (LIBUSB_REQUEST_TYPE_VENDOR | LIBUSB_ENDPOINT_IN) |
||||
#define CTRL_OUT (LIBUSB_REQUEST_TYPE_VENDOR | LIBUSB_ENDPOINT_OUT) |
||||
#define USB_RQ 0x04 |
||||
#define INTR_LENGTH 64 |
||||
|
||||
enum { |
||||
MODE_INIT = 0x00, |
||||
MODE_AWAIT_FINGER_ON = 0x10, |
||||
MODE_AWAIT_FINGER_OFF = 0x12, |
||||
MODE_CAPTURE = 0x20, |
||||
MODE_SHUT_UP = 0x30, |
||||
MODE_READY = 0x80, |
||||
}; |
||||
|
||||
static int next_state(void); |
||||
|
||||
enum { |
||||
STATE_AWAIT_MODE_CHANGE_AWAIT_FINGER_ON = 1, |
||||
STATE_AWAIT_IRQ_FINGER_DETECTED, |
||||
STATE_AWAIT_MODE_CHANGE_CAPTURE, |
||||
STATE_AWAIT_IMAGE, |
||||
STATE_AWAIT_MODE_CHANGE_AWAIT_FINGER_OFF, |
||||
STATE_AWAIT_IRQ_FINGER_REMOVED, |
||||
}; |
||||
|
||||
static int state = 0; |
||||
static struct libusb_device_handle *devh = NULL; |
||||
static unsigned char imgbuf[0x1b340]; |
||||
static unsigned char irqbuf[INTR_LENGTH]; |
||||
static struct libusb_transfer *img_transfer = NULL; |
||||
static struct libusb_transfer *irq_transfer = NULL; |
||||
static int img_idx = 0; |
||||
static int do_exit = 0; |
||||
|
||||
static int find_dpfp_device(void) |
||||
{ |
||||
devh = libusb_open_device_with_vid_pid(NULL, 0x05ba, 0x000a); |
||||
return devh ? 0 : -EIO; |
||||
} |
||||
|
||||
static int print_f0_data(void) |
||||
{ |
||||
unsigned char data[0x10]; |
||||
int r; |
||||
unsigned int i; |
||||
|
||||
r = libusb_control_transfer(devh, CTRL_IN, USB_RQ, 0xf0, 0, data, |
||||
sizeof(data), 0); |
||||
if (r < 0) { |
||||
fprintf(stderr, "F0 error %d\n", r); |
||||
return r; |
||||
} |
||||
if ((unsigned int) r < sizeof(data)) { |
||||
fprintf(stderr, "short read (%d)\n", r); |
||||
return -1; |
||||
} |
||||
|
||||
printf("F0 data:"); |
||||
for (i = 0; i < sizeof(data); i++) |
||||
printf("%02x ", data[i]); |
||||
printf("\n"); |
||||
return 0; |
||||
} |
||||
|
||||
static int get_hwstat(unsigned char *status) |
||||
{ |
||||
int r; |
||||
|
||||
r = libusb_control_transfer(devh, CTRL_IN, USB_RQ, 0x07, 0, status, 1, 0); |
||||
if (r < 0) { |
||||
fprintf(stderr, "read hwstat error %d\n", r); |
||||
return r; |
||||
} |
||||
if ((unsigned int) r < 1) { |
||||
fprintf(stderr, "short read (%d)\n", r); |
||||
return -1; |
||||
} |
||||
|
||||
printf("hwstat reads %02x\n", *status); |
||||
return 0; |
||||
} |
||||
|
||||
static int set_hwstat(unsigned char data) |
||||
{ |
||||
int r; |
||||
|
||||
printf("set hwstat to %02x\n", data); |
||||
r = libusb_control_transfer(devh, CTRL_OUT, USB_RQ, 0x07, 0, &data, 1, 0); |
||||
if (r < 0) { |
||||
fprintf(stderr, "set hwstat error %d\n", r); |
||||
return r; |
||||
} |
||||
if ((unsigned int) r < 1) { |
||||
fprintf(stderr, "short write (%d)", r); |
||||
return -1; |
||||
} |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int set_mode(unsigned char data) |
||||
{ |
||||
int r; |
||||
printf("set mode %02x\n", data); |
||||
|
||||
r = libusb_control_transfer(devh, CTRL_OUT, USB_RQ, 0x4e, 0, &data, 1, 0); |
||||
if (r < 0) { |
||||
fprintf(stderr, "set mode error %d\n", r); |
||||
return r; |
||||
} |
||||
if ((unsigned int) r < 1) { |
||||
fprintf(stderr, "short write (%d)", r); |
||||
return -1; |
||||
} |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static void LIBUSB_CALL cb_mode_changed(struct libusb_transfer *transfer) |
||||
{ |
||||
if (transfer->status != LIBUSB_TRANSFER_COMPLETED) { |
||||
fprintf(stderr, "mode change transfer not completed!\n"); |
||||
do_exit = 2; |
||||
} |
||||
|
||||
printf("async cb_mode_changed length=%d actual_length=%d\n", |
||||
transfer->length, transfer->actual_length); |
||||
if (next_state() < 0) |
||||
do_exit = 2; |
||||
} |
||||
|
||||
static int set_mode_async(unsigned char data) |
||||
{ |
||||
unsigned char *buf = malloc(LIBUSB_CONTROL_SETUP_SIZE + 1); |
||||
struct libusb_transfer *transfer; |
||||
|
||||
if (!buf) |
||||
return -ENOMEM; |
||||
|
||||
transfer = libusb_alloc_transfer(0); |
||||
if (!transfer) { |
||||
free(buf); |
||||
return -ENOMEM; |
||||
} |
||||
|
||||
printf("async set mode %02x\n", data); |
||||
libusb_fill_control_setup(buf, CTRL_OUT, USB_RQ, 0x4e, 0, 1); |
||||
buf[LIBUSB_CONTROL_SETUP_SIZE] = data; |
||||
libusb_fill_control_transfer(transfer, devh, buf, cb_mode_changed, NULL, |
||||
1000); |
||||
|
||||
transfer->flags = LIBUSB_TRANSFER_SHORT_NOT_OK |
||||
| LIBUSB_TRANSFER_FREE_BUFFER | LIBUSB_TRANSFER_FREE_TRANSFER; |
||||
return libusb_submit_transfer(transfer); |
||||
} |
||||
|
||||
static int do_sync_intr(unsigned char *data) |
||||
{ |
||||
int r; |
||||
int transferred; |
||||
|
||||
r = libusb_interrupt_transfer(devh, EP_INTR, data, INTR_LENGTH, |
||||
&transferred, 1000); |
||||
if (r < 0) { |
||||
fprintf(stderr, "intr error %d\n", r); |
||||
return r; |
||||
} |
||||
if (transferred < INTR_LENGTH) { |
||||
fprintf(stderr, "short read (%d)\n", r); |
||||
return -1; |
||||
} |
||||
|
||||
printf("recv interrupt %04x\n", *((uint16_t *) data)); |
||||
return 0; |
||||
} |
||||
|
||||
static int sync_intr(unsigned char type) |
||||
{ |
||||
int r; |
||||
unsigned char data[INTR_LENGTH]; |
||||
|
||||
while (1) { |
||||
r = do_sync_intr(data); |
||||
if (r < 0) |
||||
return r; |
||||
if (data[0] == type) |
||||
return 0; |
||||
} |
||||
} |
||||
|
||||
static int save_to_file(unsigned char *data) |
||||
{ |
||||
FILE *fd; |
||||
char filename[64]; |
||||
|
||||
snprintf(filename, sizeof(filename), "finger%d.pgm", img_idx++); |
||||
fd = fopen(filename, "w"); |
||||
if (!fd) |
||||
return -1; |
||||
|
||||
fputs("P5 384 289 255 ", fd); |
||||
(void) fwrite(data + 64, 1, 384*289, fd); |
||||
fclose(fd); |
||||
printf("saved image to %s\n", filename); |
||||
return 0; |
||||
} |
||||
|
||||
static int next_state(void) |
||||
{ |
||||
int r = 0; |
||||
printf("old state: %d\n", state); |
||||
switch (state) { |
||||
case STATE_AWAIT_IRQ_FINGER_REMOVED: |
||||
state = STATE_AWAIT_MODE_CHANGE_AWAIT_FINGER_ON; |
||||
r = set_mode_async(MODE_AWAIT_FINGER_ON); |
||||
break; |
||||
case STATE_AWAIT_MODE_CHANGE_AWAIT_FINGER_ON: |
||||
state = STATE_AWAIT_IRQ_FINGER_DETECTED; |
||||
break; |
||||
case STATE_AWAIT_IRQ_FINGER_DETECTED: |
||||
state = STATE_AWAIT_MODE_CHANGE_CAPTURE; |
||||
r = set_mode_async(MODE_CAPTURE); |
||||
break; |
||||
case STATE_AWAIT_MODE_CHANGE_CAPTURE: |
||||
state = STATE_AWAIT_IMAGE; |
||||
break; |
||||
case STATE_AWAIT_IMAGE: |
||||
state = STATE_AWAIT_MODE_CHANGE_AWAIT_FINGER_OFF; |
||||
r = set_mode_async(MODE_AWAIT_FINGER_OFF); |
||||
break; |
||||
case STATE_AWAIT_MODE_CHANGE_AWAIT_FINGER_OFF: |
||||
state = STATE_AWAIT_IRQ_FINGER_REMOVED; |
||||
break; |
||||
default: |
||||
printf("unrecognised state %d\n", state); |
||||
} |
||||
if (r < 0) { |
||||
fprintf(stderr, "error detected changing state\n"); |
||||
return r; |
||||
} |
||||
|
||||
printf("new state: %d\n", state); |
||||
return 0; |
||||
} |
||||
|
||||
static void LIBUSB_CALL cb_irq(struct libusb_transfer *transfer) |
||||
{ |
||||
unsigned char irqtype = transfer->buffer[0]; |
||||
|
||||
if (transfer->status != LIBUSB_TRANSFER_COMPLETED) { |
||||
fprintf(stderr, "irq transfer status %d?\n", transfer->status); |
||||
do_exit = 2; |
||||
libusb_free_transfer(transfer); |
||||
irq_transfer = NULL; |
||||
return; |
||||
} |
||||
|
||||
printf("IRQ callback %02x\n", irqtype); |
||||
switch (state) { |
||||
case STATE_AWAIT_IRQ_FINGER_DETECTED: |
||||
if (irqtype == 0x01) { |
||||
if (next_state() < 0) { |
||||
do_exit = 2; |
||||
return; |
||||
} |
||||
} else { |
||||
printf("finger-on-sensor detected in wrong state!\n"); |
||||
} |
||||
break; |
||||
case STATE_AWAIT_IRQ_FINGER_REMOVED: |
||||
if (irqtype == 0x02) { |
||||
if (next_state() < 0) { |
||||
do_exit = 2; |
||||
return; |
||||
} |
||||
} else { |
||||
printf("finger-on-sensor detected in wrong state!\n"); |
||||
} |
||||
break; |
||||
} |
||||
if (libusb_submit_transfer(irq_transfer) < 0) |
||||
do_exit = 2; |
||||
} |
||||
|
||||
static void LIBUSB_CALL cb_img(struct libusb_transfer *transfer) |
||||
{ |
||||
if (transfer->status != LIBUSB_TRANSFER_COMPLETED) { |
||||
fprintf(stderr, "img transfer status %d?\n", transfer->status); |
||||
do_exit = 2; |
||||
libusb_free_transfer(transfer); |
||||
img_transfer = NULL; |
||||
return; |
||||
} |
||||
|
||||
printf("Image callback\n"); |
||||
save_to_file(imgbuf); |
||||
if (next_state() < 0) { |
||||
do_exit = 2; |
||||
return; |
||||
} |
||||
if (libusb_submit_transfer(img_transfer) < 0) |
||||
do_exit = 2; |
||||
} |
||||
|
||||
static int init_capture(void) |
||||
{ |
||||
int r; |
||||
|
||||
r = libusb_submit_transfer(irq_transfer); |
||||
if (r < 0) |
||||
return r; |
||||
|
||||
r = libusb_submit_transfer(img_transfer); |
||||
if (r < 0) { |
||||
libusb_cancel_transfer(irq_transfer); |
||||
while (irq_transfer) |
||||
if (libusb_handle_events(NULL) < 0) |
||||
break; |
||||
return r; |
||||
} |
||||
|
||||
/* start state machine */ |
||||
state = STATE_AWAIT_IRQ_FINGER_REMOVED; |
||||
return next_state(); |
||||
} |
||||
|
||||
static int do_init(void) |
||||
{ |
||||
unsigned char status; |
||||
int r; |
||||
|
||||
r = get_hwstat(&status); |
||||
if (r < 0) |
||||
return r; |
||||
|
||||
if (!(status & 0x80)) { |
||||
r = set_hwstat(status | 0x80); |
||||
if (r < 0) |
||||
return r; |
||||
r = get_hwstat(&status); |
||||
if (r < 0) |
||||
return r; |
||||
} |
||||
|
||||
status &= ~0x80; |
||||
r = set_hwstat(status); |
||||
if (r < 0) |
||||
return r; |
||||
|
||||
r = get_hwstat(&status); |
||||
if (r < 0) |
||||
return r; |
||||
|
||||
r = sync_intr(0x56); |
||||
if (r < 0) |
||||
return r; |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int alloc_transfers(void) |
||||
{ |
||||
img_transfer = libusb_alloc_transfer(0); |
||||
if (!img_transfer) |
||||
return -ENOMEM; |
||||
|
||||
irq_transfer = libusb_alloc_transfer(0); |
||||
if (!irq_transfer) |
||||
return -ENOMEM; |
||||
|
||||
libusb_fill_bulk_transfer(img_transfer, devh, EP_DATA, imgbuf, |
||||
sizeof(imgbuf), cb_img, NULL, 0); |
||||
libusb_fill_interrupt_transfer(irq_transfer, devh, EP_INTR, irqbuf, |
||||
sizeof(irqbuf), cb_irq, NULL, 0); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static void sighandler(int signum) |
||||
{ |
||||
do_exit = 1; |
||||
} |
||||
|
||||
int main(void) |
||||
{ |
||||
struct sigaction sigact; |
||||
int r = 1; |
||||
|
||||
r = libusb_init(NULL); |
||||
if (r < 0) { |
||||
fprintf(stderr, "failed to initialise libusb\n"); |
||||
exit(1); |
||||
} |
||||
|
||||
r = find_dpfp_device(); |
||||
if (r < 0) { |
||||
fprintf(stderr, "Could not find/open device\n"); |
||||
goto out; |
||||
} |
||||
|
||||
r = libusb_claim_interface(devh, 0); |
||||
if (r < 0) { |
||||
fprintf(stderr, "usb_claim_interface error %d\n", r); |
||||
goto out; |
||||
} |
||||
printf("claimed interface\n"); |
||||
|
||||
r = print_f0_data(); |
||||
if (r < 0) |
||||
goto out_release; |
||||
|
||||
r = do_init(); |
||||
if (r < 0) |
||||
goto out_deinit; |
||||
|
||||
/* async from here onwards */ |
||||
|
||||
r = alloc_transfers(); |
||||
if (r < 0) |
||||
goto out_deinit; |
||||
|
||||
r = init_capture(); |
||||
if (r < 0) |
||||
goto out_deinit; |
||||
|
||||
sigact.sa_handler = sighandler; |
||||
sigemptyset(&sigact.sa_mask); |
||||
sigact.sa_flags = 0; |
||||
sigaction(SIGINT, &sigact, NULL); |
||||
sigaction(SIGTERM, &sigact, NULL); |
||||
sigaction(SIGQUIT, &sigact, NULL); |
||||
|
||||
while (!do_exit) { |
||||
r = libusb_handle_events(NULL); |
||||
if (r < 0) |
||||
goto out_deinit; |
||||
} |
||||
|
||||
printf("shutting down...\n"); |
||||
|
||||
if (irq_transfer) { |
||||
r = libusb_cancel_transfer(irq_transfer); |
||||
if (r < 0) |
||||
goto out_deinit; |
||||
} |
||||
|
||||
if (img_transfer) { |
||||
r = libusb_cancel_transfer(img_transfer); |
||||
if (r < 0) |
||||
goto out_deinit; |
||||
} |
||||
|
||||
while (irq_transfer || img_transfer) |
||||
if (libusb_handle_events(NULL) < 0) |
||||
break; |
||||
|
||||
if (do_exit == 1) |
||||
r = 0; |
||||
else |
||||
r = 1; |
||||
|
||||
out_deinit: |
||||
libusb_free_transfer(img_transfer); |
||||
libusb_free_transfer(irq_transfer); |
||||
set_mode(0); |
||||
set_hwstat(0x80); |
||||
out_release: |
||||
libusb_release_interface(devh, 0); |
||||
out: |
||||
libusb_close(devh); |
||||
libusb_exit(NULL); |
||||
return r >= 0 ? r : -r; |
||||
} |
||||
|
@ -1,545 +0,0 @@
@@ -1,545 +0,0 @@
|
||||
/*
|
||||
* libusb example program to manipulate U.are.U 4000B fingerprint scanner. |
||||
* Copyright (C) 2007 Daniel Drake <dsd@gentoo.org> |
||||
* |
||||
* Basic image capture program only, does not consider the powerup quirks or |
||||
* the fact that image encryption may be enabled. Not expected to work |
||||
* flawlessly all of the time. |
||||
* |
||||
* This library is free software; you can redistribute it and/or |
||||
* modify it under the terms of the GNU Lesser General Public |
||||
* License as published by the Free Software Foundation; either |
||||
* version 2.1 of the License, or (at your option) any later version. |
||||
* |
||||
* This library is distributed in the hope that it will be useful, |
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
||||
* Lesser General Public License for more details. |
||||
* |
||||
* You should have received a copy of the GNU Lesser General Public |
||||
* License along with this library; if not, write to the Free Software |
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
||||
*/ |
||||
|
||||
#include <errno.h> |
||||
#include <pthread.h> |
||||
#include <signal.h> |
||||
#include <string.h> |
||||
#include <stdio.h> |
||||
#include <stdlib.h> |
||||
|
||||
#include <libusb.h> |
||||
|
||||
#define EP_INTR (1 | LIBUSB_ENDPOINT_IN) |
||||
#define EP_DATA (2 | LIBUSB_ENDPOINT_IN) |
||||
#define CTRL_IN (LIBUSB_REQUEST_TYPE_VENDOR | LIBUSB_ENDPOINT_IN) |
||||
#define CTRL_OUT (LIBUSB_REQUEST_TYPE_VENDOR | LIBUSB_ENDPOINT_OUT) |
||||
#define USB_RQ 0x04 |
||||
#define INTR_LENGTH 64 |
||||
|
||||
enum { |
||||
MODE_INIT = 0x00, |
||||
MODE_AWAIT_FINGER_ON = 0x10, |
||||
MODE_AWAIT_FINGER_OFF = 0x12, |
||||
MODE_CAPTURE = 0x20, |
||||
MODE_SHUT_UP = 0x30, |
||||
MODE_READY = 0x80, |
||||
}; |
||||
|
||||
static int next_state(void); |
||||
|
||||
enum { |
||||
STATE_AWAIT_MODE_CHANGE_AWAIT_FINGER_ON = 1, |
||||
STATE_AWAIT_IRQ_FINGER_DETECTED, |
||||
STATE_AWAIT_MODE_CHANGE_CAPTURE, |
||||
STATE_AWAIT_IMAGE, |
||||
STATE_AWAIT_MODE_CHANGE_AWAIT_FINGER_OFF, |
||||
STATE_AWAIT_IRQ_FINGER_REMOVED, |
||||
}; |
||||
|
||||
static int state = 0; |
||||
static struct libusb_device_handle *devh = NULL; |
||||
static unsigned char imgbuf[0x1b340]; |
||||
static unsigned char irqbuf[INTR_LENGTH]; |
||||
static struct libusb_transfer *img_transfer = NULL; |
||||
static struct libusb_transfer *irq_transfer = NULL; |
||||
static int img_idx = 0; |
||||
static int do_exit = 0; |
||||
|
||||
static pthread_t poll_thread; |
||||
static pthread_cond_t exit_cond = PTHREAD_COND_INITIALIZER; |
||||
static pthread_mutex_t exit_cond_lock = PTHREAD_MUTEX_INITIALIZER; |
||||
|
||||
static void request_exit(int code) |
||||
{ |
||||
do_exit = code; |
||||
pthread_cond_signal(&exit_cond); |
||||
} |
||||
|
||||
static void *poll_thread_main(void *arg) |
||||
{ |
||||
int r = 0; |
||||
printf("poll thread running\n"); |
||||
|
||||
while (!do_exit) { |
||||
struct timeval tv = { 1, 0 }; |
||||
r = libusb_handle_events_timeout(NULL, &tv); |
||||
if (r < 0) { |
||||
request_exit(2); |
||||
break; |
||||
} |
||||
} |
||||
|
||||
printf("poll thread shutting down\n"); |
||||
return NULL; |
||||
} |
||||
|
||||
static int find_dpfp_device(void) |
||||
{ |
||||
devh = libusb_open_device_with_vid_pid(NULL, 0x05ba, 0x000a); |
||||
return devh ? 0 : -EIO; |
||||
} |
||||
|
||||
static int print_f0_data(void) |
||||
{ |
||||
unsigned char data[0x10]; |
||||
int r; |
||||
unsigned int i; |
||||
|
||||
r = libusb_control_transfer(devh, CTRL_IN, USB_RQ, 0xf0, 0, data, |
||||
sizeof(data), 0); |
||||
if (r < 0) { |
||||
fprintf(stderr, "F0 error %d\n", r); |
||||
return r; |
||||
} |
||||
if ((unsigned int) r < sizeof(data)) { |
||||
fprintf(stderr, "short read (%d)\n", r); |
||||
return -1; |
||||
} |
||||
|
||||
printf("F0 data:"); |
||||
for (i = 0; i < sizeof(data); i++) |
||||
printf("%02x ", data[i]); |
||||
printf("\n"); |
||||
return 0; |
||||
} |
||||
|
||||
static int get_hwstat(unsigned char *status) |
||||
{ |
||||
int r; |
||||
|
||||
r = libusb_control_transfer(devh, CTRL_IN, USB_RQ, 0x07, 0, status, 1, 0); |
||||
if (r < 0) { |
||||
fprintf(stderr, "read hwstat error %d\n", r); |
||||
return r; |
||||
} |
||||
if ((unsigned int) r < 1) { |
||||
fprintf(stderr, "short read (%d)\n", r); |
||||
return -1; |
||||
} |
||||
|
||||
printf("hwstat reads %02x\n", *status); |
||||
return 0; |
||||
} |
||||
|
||||
static int set_hwstat(unsigned char data) |
||||
{ |
||||
int r; |
||||
|
||||
printf("set hwstat to %02x\n", data); |
||||
r = libusb_control_transfer(devh, CTRL_OUT, USB_RQ, 0x07, 0, &data, 1, 0); |
||||
if (r < 0) { |
||||
fprintf(stderr, "set hwstat error %d\n", r); |
||||
return r; |
||||
} |
||||
if ((unsigned int) r < 1) { |
||||
fprintf(stderr, "short write (%d)", r); |
||||
return -1; |
||||
} |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int set_mode(unsigned char data) |
||||
{ |
||||
int r; |
||||
printf("set mode %02x\n", data); |
||||
|
||||
r = libusb_control_transfer(devh, CTRL_OUT, USB_RQ, 0x4e, 0, &data, 1, 0); |
||||
if (r < 0) { |
||||
fprintf(stderr, "set mode error %d\n", r); |
||||
return r; |
||||
} |
||||
if ((unsigned int) r < 1) { |
||||
fprintf(stderr, "short write (%d)", r); |
||||
return -1; |
||||
} |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static void LIBUSB_CALL cb_mode_changed(struct libusb_transfer *transfer) |
||||
{ |
||||
if (transfer->status != LIBUSB_TRANSFER_COMPLETED) { |
||||
fprintf(stderr, "mode change transfer not completed!\n"); |
||||
request_exit(2); |
||||
} |
||||
|
||||
printf("async cb_mode_changed length=%d actual_length=%d\n", |
||||
transfer->length, transfer->actual_length); |
||||
if (next_state() < 0) |
||||
request_exit(2); |
||||
} |
||||
|
||||
static int set_mode_async(unsigned char data) |
||||
{ |
||||
unsigned char *buf = malloc(LIBUSB_CONTROL_SETUP_SIZE + 1); |
||||
struct libusb_transfer *transfer; |
||||
|
||||
if (!buf) |
||||
return -ENOMEM; |
||||
|
||||
transfer = libusb_alloc_transfer(0); |
||||
if (!transfer) { |
||||
free(buf); |
||||
return -ENOMEM; |
||||
} |
||||
|
||||
printf("async set mode %02x\n", data); |
||||
libusb_fill_control_setup(buf, CTRL_OUT, USB_RQ, 0x4e, 0, 1); |
||||
buf[LIBUSB_CONTROL_SETUP_SIZE] = data; |
||||
libusb_fill_control_transfer(transfer, devh, buf, cb_mode_changed, NULL, |
||||
1000); |
||||
|
||||
transfer->flags = LIBUSB_TRANSFER_SHORT_NOT_OK |
||||
| LIBUSB_TRANSFER_FREE_BUFFER | LIBUSB_TRANSFER_FREE_TRANSFER; |
||||
return libusb_submit_transfer(transfer); |
||||
} |
||||
|
||||
static int do_sync_intr(unsigned char *data) |
||||
{ |
||||
int r; |
||||
int transferred; |
||||
|
||||
r = libusb_interrupt_transfer(devh, EP_INTR, data, INTR_LENGTH, |
||||
&transferred, 1000); |
||||
if (r < 0) { |
||||
fprintf(stderr, "intr error %d\n", r); |
||||
return r; |
||||
} |
||||
if (transferred < INTR_LENGTH) { |
||||
fprintf(stderr, "short read (%d)\n", r); |
||||
return -1; |
||||
} |
||||
|
||||
printf("recv interrupt %04x\n", *((uint16_t *) data)); |
||||
return 0; |
||||
} |
||||
|
||||
static int sync_intr(unsigned char type) |
||||
{ |
||||
int r; |
||||
unsigned char data[INTR_LENGTH]; |
||||
|
||||
while (1) { |
||||
r = do_sync_intr(data); |
||||
if (r < 0) |
||||
return r; |
||||
if (data[0] == type) |
||||
return 0; |
||||
} |
||||
} |
||||
|
||||
static int save_to_file(unsigned char *data) |
||||
{ |
||||
FILE *fd; |
||||
char filename[64]; |
||||
|
||||
snprintf(filename, sizeof(filename), "finger%d.pgm", img_idx++); |
||||
fd = fopen(filename, "w"); |
||||
if (!fd) |
||||
return -1; |
||||
|
||||
fputs("P5 384 289 255 ", fd); |
||||
(void) fwrite(data + 64, 1, 384*289, fd); |
||||
fclose(fd); |
||||
printf("saved image to %s\n", filename); |
||||
return 0; |
||||
} |
||||
|
||||
static int next_state(void) |
||||
{ |
||||
int r = 0; |
||||
printf("old state: %d\n", state); |
||||
switch (state) { |
||||
case STATE_AWAIT_IRQ_FINGER_REMOVED: |
||||
state = STATE_AWAIT_MODE_CHANGE_AWAIT_FINGER_ON; |
||||
r = set_mode_async(MODE_AWAIT_FINGER_ON); |
||||
break; |
||||
case STATE_AWAIT_MODE_CHANGE_AWAIT_FINGER_ON: |
||||
state = STATE_AWAIT_IRQ_FINGER_DETECTED; |
||||
break; |
||||
case STATE_AWAIT_IRQ_FINGER_DETECTED: |
||||
state = STATE_AWAIT_MODE_CHANGE_CAPTURE; |
||||
r = set_mode_async(MODE_CAPTURE); |
||||
break; |
||||
case STATE_AWAIT_MODE_CHANGE_CAPTURE: |
||||
state = STATE_AWAIT_IMAGE; |
||||
break; |
||||
case STATE_AWAIT_IMAGE: |
||||
state = STATE_AWAIT_MODE_CHANGE_AWAIT_FINGER_OFF; |
||||
r = set_mode_async(MODE_AWAIT_FINGER_OFF); |
||||
break; |
||||
case STATE_AWAIT_MODE_CHANGE_AWAIT_FINGER_OFF: |
||||
state = STATE_AWAIT_IRQ_FINGER_REMOVED; |
||||
break; |
||||
default: |
||||
printf("unrecognised state %d\n", state); |
||||
} |
||||
if (r < 0) { |
||||
fprintf(stderr, "error detected changing state\n"); |
||||
return r; |
||||
} |
||||
|
||||
printf("new state: %d\n", state); |
||||
return 0; |
||||
} |
||||
|
||||
static void LIBUSB_CALL cb_irq(struct libusb_transfer *transfer) |
||||
{ |
||||
unsigned char irqtype = transfer->buffer[0]; |
||||
|
||||
if (transfer->status != LIBUSB_TRANSFER_COMPLETED) { |
||||
fprintf(stderr, "irq transfer status %d?\n", transfer->status); |
||||
irq_transfer = NULL; |
||||
request_exit(2); |
||||
return; |
||||
} |
||||
|
||||
printf("IRQ callback %02x\n", irqtype); |
||||
switch (state) { |
||||
case STATE_AWAIT_IRQ_FINGER_DETECTED: |
||||
if (irqtype == 0x01) { |
||||
if (next_state() < 0) { |
||||
request_exit(2); |
||||
return; |
||||
} |
||||
} else { |
||||
printf("finger-on-sensor detected in wrong state!\n"); |
||||
} |
||||
break; |
||||
case STATE_AWAIT_IRQ_FINGER_REMOVED: |
||||
if (irqtype == 0x02) { |
||||
if (next_state() < 0) { |
||||
request_exit(2); |
||||
return; |
||||
} |
||||
} else { |
||||
printf("finger-on-sensor detected in wrong state!\n"); |
||||
} |
||||
break; |
||||
} |
||||
if (libusb_submit_transfer(irq_transfer) < 0) |
||||
request_exit(2); |
||||
} |
||||
|
||||
static void LIBUSB_CALL cb_img(struct libusb_transfer *transfer) |
||||
{ |
||||
if (transfer->status != LIBUSB_TRANSFER_COMPLETED) { |
||||
fprintf(stderr, "img transfer status %d?\n", transfer->status); |
||||
img_transfer = NULL; |
||||
request_exit(2); |
||||
return; |
||||
} |
||||
|
||||
printf("Image callback\n"); |
||||
save_to_file(imgbuf); |
||||
if (next_state() < 0) { |
||||
request_exit(2); |
||||
return; |
||||
} |
||||
if (libusb_submit_transfer(img_transfer) < 0) |
||||
request_exit(2); |
||||
} |
||||
|
||||
static int init_capture(void) |
||||
{ |
||||
int r; |
||||
|
||||
r = libusb_submit_transfer(irq_transfer); |
||||
if (r < 0) |
||||
return r; |
||||
|
||||
r = libusb_submit_transfer(img_transfer); |
||||
if (r < 0) { |
||||
libusb_cancel_transfer(irq_transfer); |
||||
while (irq_transfer) |
||||
if (libusb_handle_events(NULL) < 0) |
||||
break; |
||||
return r; |
||||
} |
||||
|
||||
/* start state machine */ |
||||
state = STATE_AWAIT_IRQ_FINGER_REMOVED; |
||||
return next_state(); |
||||
} |
||||
|
||||
static int do_init(void) |
||||
{ |
||||
unsigned char status; |
||||
int r; |
||||
|
||||
r = get_hwstat(&status); |
||||
if (r < 0) |
||||
return r; |
||||
|
||||
if (!(status & 0x80)) { |
||||
r = set_hwstat(status | 0x80); |
||||
if (r < 0) |
||||
return r; |
||||
r = get_hwstat(&status); |
||||
if (r < 0) |
||||
return r; |
||||
} |
||||
|
||||
status &= ~0x80; |
||||
r = set_hwstat(status); |
||||
if (r < 0) |
||||
return r; |
||||
|
||||
r = get_hwstat(&status); |
||||
if (r < 0) |
||||
return r; |
||||
|
||||
r = sync_intr(0x56); |
||||
if (r < 0) |
||||
return r; |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int alloc_transfers(void) |
||||
{ |
||||
img_transfer = libusb_alloc_transfer(0); |
||||
if (!img_transfer) |
||||
return -ENOMEM; |
||||
|
||||
irq_transfer = libusb_alloc_transfer(0); |
||||
if (!irq_transfer) |
||||
return -ENOMEM; |
||||
|
||||
libusb_fill_bulk_transfer(img_transfer, devh, EP_DATA, imgbuf, |
||||
sizeof(imgbuf), cb_img, NULL, 0); |
||||
libusb_fill_interrupt_transfer(irq_transfer, devh, EP_INTR, irqbuf, |
||||
sizeof(irqbuf), cb_irq, NULL, 0); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static void sighandler(int signum) |
||||
{ |
||||
request_exit(1); |
||||
} |
||||
|
||||
int main(void) |
||||
{ |
||||
struct sigaction sigact; |
||||
int r = 1; |
||||
|
||||
r = libusb_init(NULL); |
||||
if (r < 0) { |
||||
fprintf(stderr, "failed to initialise libusb\n"); |
||||
exit(1); |
||||
} |
||||
|
||||
r = find_dpfp_device(); |
||||
if (r < 0) { |
||||
fprintf(stderr, "Could not find/open device\n"); |
||||
goto out; |
||||
} |
||||
|
||||
r = libusb_claim_interface(devh, 0); |
||||
if (r < 0) { |
||||
fprintf(stderr, "usb_claim_interface error %d %s\n", r, strerror(-r)); |
||||
goto out; |
||||
} |
||||
printf("claimed interface\n"); |
||||
|
||||
r = print_f0_data(); |
||||
if (r < 0) |
||||
goto out_release; |
||||
|
||||
r = do_init(); |
||||
if (r < 0) |
||||
goto out_deinit; |
||||
|
||||
/* async from here onwards */ |
||||
|
||||
sigact.sa_handler = sighandler; |
||||
sigemptyset(&sigact.sa_mask); |
||||
sigact.sa_flags = 0; |
||||
sigaction(SIGINT, &sigact, NULL); |
||||
sigaction(SIGTERM, &sigact, NULL); |
||||
sigaction(SIGQUIT, &sigact, NULL); |
||||
|
||||
r = pthread_create(&poll_thread, NULL, poll_thread_main, NULL); |
||||
if (r) |
||||
goto out_deinit; |
||||
|
||||
r = alloc_transfers(); |
||||
if (r < 0) { |
||||
request_exit(1); |
||||
pthread_join(poll_thread, NULL); |
||||
goto out_deinit; |
||||
} |
||||
|
||||
r = init_capture(); |
||||
if (r < 0) { |
||||
request_exit(1); |
||||
pthread_join(poll_thread, NULL); |
||||
goto out_deinit; |
||||
} |
||||
|
||||
while (!do_exit) { |
||||
pthread_mutex_lock(&exit_cond_lock); |
||||
pthread_cond_wait(&exit_cond, &exit_cond_lock); |
||||
pthread_mutex_unlock(&exit_cond_lock); |
||||
} |
||||
|
||||
printf("shutting down...\n"); |
||||
pthread_join(poll_thread, NULL); |
||||
|
||||
r = libusb_cancel_transfer(irq_transfer); |
||||
if (r < 0) { |
||||
request_exit(1); |
||||
goto out_deinit; |
||||
} |
||||
|
||||
r = libusb_cancel_transfer(img_transfer); |
||||
if (r < 0) { |
||||
request_exit(1); |
||||
goto out_deinit; |
||||
} |
||||
|
||||
while (img_transfer || irq_transfer) |
||||
if (libusb_handle_events(NULL) < 0) |
||||
break; |
||||
|
||||
if (do_exit == 1) |
||||
r = 0; |
||||
else |
||||
r = 1; |
||||
|
||||
out_deinit: |
||||
libusb_free_transfer(img_transfer); |
||||
libusb_free_transfer(irq_transfer); |
||||
set_mode(0); |
||||
set_hwstat(0x80); |
||||
out_release: |
||||
libusb_release_interface(devh, 0); |
||||
out: |
||||
libusb_close(devh); |
||||
libusb_exit(NULL); |
||||
return r >= 0 ? r : -r; |
||||
} |
||||
|
@ -1,95 +0,0 @@
@@ -1,95 +0,0 @@
|
||||
/*
|
||||
* libusb example program for hotplug API |
||||
* Copyright (C) 2012-2013 Nathan Hjelm <hjelmn@mac.ccom> |
||||
* |
||||
* This library is free software; you can redistribute it and/or |
||||
* modify it under the terms of the GNU Lesser General Public |
||||
* License as published by the Free Software Foundation; either |
||||
* version 2.1 of the License, or (at your option) any later version. |
||||
* |
||||
* This library is distributed in the hope that it will be useful, |
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
||||
* Lesser General Public License for more details. |
||||
* |
||||
* You should have received a copy of the GNU Lesser General Public |
||||
* License along with this library; if not, write to the Free Software |
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
||||
*/ |
||||
|
||||
#include <stdlib.h> |
||||
#include <stdio.h> |
||||
#include <sched.h> |
||||
#include <unistd.h> |
||||
|
||||
#include <libusb.h> |
||||
|
||||
int done = 0; |
||||
libusb_device_handle *handle; |
||||
|
||||
static int hotplug_callback (libusb_context *ctx, libusb_device *dev, libusb_hotplug_event event, void *user_data) { |
||||
struct libusb_device_descriptor desc; |
||||
int rc; |
||||
|
||||
rc = libusb_get_device_descriptor(dev, &desc); |
||||
if (LIBUSB_SUCCESS != rc) { |
||||
fprintf (stderr, "Error getting device descriptor\n"); |
||||
} |
||||
|
||||
printf ("Device attach: %04x:%04x\n", desc.idVendor, desc.idProduct); |
||||
|
||||
libusb_open (dev, &handle); |
||||
|
||||
done++; |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int hotplug_callback_detach (libusb_context *ctx, libusb_device *dev, libusb_hotplug_event event, void *user_data) { |
||||
printf ("Device detached\n"); |
||||
|
||||
libusb_close (handle); |
||||
|
||||
done++; |
||||
return 0; |
||||
} |
||||
|
||||
int main (int argc, char *argv[]) { |
||||
libusb_hotplug_callback_handle hp[2]; |
||||
int product_id, vendor_id, class_id; |
||||
int rc; |
||||
|
||||
vendor_id = (argc > 1) ? strtol (argv[1], NULL, 0) : 0x045a; |
||||
product_id = (argc > 2) ? strtol (argv[2], NULL, 0) : 0x5005; |
||||
class_id = (argc > 3) ? strtol (argv[3], NULL, 0) : LIBUSB_HOTPLUG_MATCH_ANY; |
||||
|
||||
libusb_init (NULL); |
||||
|
||||
if (!libusb_has_capability (LIBUSB_CAP_HAS_HOTPLUG)) { |
||||
printf ("Hotplug not supported by this build of libusb\n"); |
||||
libusb_exit (NULL); |
||||
return EXIT_FAILURE; |
||||
} |
||||
|
||||
rc = libusb_hotplug_register_callback (NULL, LIBUSB_HOTPLUG_EVENT_DEVICE_ARRIVED, 0, vendor_id, |
||||
product_id, class_id, hotplug_callback, NULL, &hp[0]); |
||||
if (LIBUSB_SUCCESS != rc) { |
||||
fprintf (stderr, "Error registering callback 0\n"); |
||||
libusb_exit (NULL); |
||||
return EXIT_FAILURE; |
||||
} |
||||
|
||||
rc = libusb_hotplug_register_callback (NULL, LIBUSB_HOTPLUG_EVENT_DEVICE_LEFT, 0, vendor_id, |
||||
product_id,class_id, hotplug_callback_detach, NULL, &hp[1]); |
||||
if (LIBUSB_SUCCESS != rc) { |
||||
fprintf (stderr, "Error registering callback 1\n"); |
||||
libusb_exit (NULL); |
||||
return EXIT_FAILURE; |
||||
} |
||||
|
||||
while (done < 2) { |
||||
libusb_handle_events (NULL); |
||||
} |
||||
|
||||
libusb_exit (NULL); |
||||
} |
@ -1,64 +0,0 @@
@@ -1,64 +0,0 @@
|
||||
/*
|
||||
* libusb example program to list devices on the bus |
||||
* Copyright (C) 2007 Daniel Drake <dsd@gentoo.org> |
||||
* |
||||
* This library is free software; you can redistribute it and/or |
||||
* modify it under the terms of the GNU Lesser General Public |
||||
* License as published by the Free Software Foundation; either |
||||
* version 2.1 of the License, or (at your option) any later version. |
||||
* |
||||
* This library is distributed in the hope that it will be useful, |
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
||||
* Lesser General Public License for more details. |
||||
* |
||||
* You should have received a copy of the GNU Lesser General Public |
||||
* License along with this library; if not, write to the Free Software |
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
||||
*/ |
||||
|
||||
#include <stdio.h> |
||||
#include <sys/types.h> |
||||
|
||||
#include <libusb.h> |
||||
|
||||
static void print_devs(libusb_device **devs) |
||||
{ |
||||
libusb_device *dev; |
||||
int i = 0; |
||||
|
||||
while ((dev = devs[i++]) != NULL) { |
||||
struct libusb_device_descriptor desc; |
||||
int r = libusb_get_device_descriptor(dev, &desc); |
||||
if (r < 0) { |
||||
fprintf(stderr, "failed to get device descriptor"); |
||||
return; |
||||
} |
||||
|
||||
printf("%04x:%04x (bus %d, device %d)\n", |
||||
desc.idVendor, desc.idProduct, |
||||
libusb_get_bus_number(dev), libusb_get_device_address(dev)); |
||||
} |
||||
} |
||||
|
||||
int main(void) |
||||
{ |
||||
libusb_device **devs; |
||||
int r; |
||||
ssize_t cnt; |
||||
|
||||
r = libusb_init(NULL); |
||||
if (r < 0) |
||||
return r; |
||||
|
||||
cnt = libusb_get_device_list(NULL, &devs); |
||||
if (cnt < 0) |
||||
return (int) cnt; |
||||
|
||||
print_devs(devs); |
||||
libusb_free_device_list(devs, 1); |
||||
|
||||
libusb_exit(NULL); |
||||
return 0; |
||||
} |
||||
|
@ -1,193 +0,0 @@
@@ -1,193 +0,0 @@
|
||||
/*
|
||||
* libusb example program to measure Atmel SAM3U isochronous performance |
||||
* Copyright (C) 2012 Harald Welte <laforge@gnumonks.org> |
||||
* |
||||
* Copied with the author's permission under LGPL-2.1 from |
||||
* http://git.gnumonks.org/cgi-bin/gitweb.cgi?p=sam3u-tests.git;a=blob;f=usb-benchmark-project/host/benchmark.c;h=74959f7ee88f1597286cd435f312a8ff52c56b7e
|
||||
* |
||||
* An Atmel SAM3U test firmware is also available in the above repository. |
||||
* |
||||
* This library is free software; you can redistribute it and/or |
||||
* modify it under the terms of the GNU Lesser General Public |
||||
* License as published by the Free Software Foundation; either |
||||
* version 2.1 of the License, or (at your option) any later version. |
||||
* |
||||
* This library is distributed in the hope that it will be useful, |
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
||||
* Lesser General Public License for more details. |
||||
* |
||||
* You should have received a copy of the GNU Lesser General Public |
||||
* License along with this library; if not, write to the Free Software |
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
||||
*/ |
||||
|
||||
#include <unistd.h> |
||||
#include <stdlib.h> |
||||
#include <stdio.h> |
||||
#include <errno.h> |
||||
#include <signal.h> |
||||
|
||||
#include <libusb.h> |
||||
|
||||
|
||||
#define EP_DATA_IN 0x82 |
||||
#define EP_ISO_IN 0x86 |
||||
|
||||
static int do_exit = 0; |
||||
static struct libusb_device_handle *devh = NULL; |
||||
|
||||
static unsigned long num_bytes = 0, num_xfer = 0; |
||||
static struct timeval tv_start; |
||||
|
||||
static void cb_xfr(struct libusb_transfer *xfr) |
||||
{ |
||||
unsigned int i; |
||||
|
||||
if (xfr->status != LIBUSB_TRANSFER_COMPLETED) { |
||||
fprintf(stderr, "transfer status %d\n", xfr->status); |
||||
libusb_free_transfer(xfr); |
||||
exit(3); |
||||
} |
||||
|
||||
if (xfr->type == LIBUSB_TRANSFER_TYPE_ISOCHRONOUS) { |
||||
for (i = 0; i < xfr->num_iso_packets; i++) { |
||||
struct libusb_iso_packet_descriptor *pack = &xfr->iso_packet_desc[i]; |
||||
|
||||
if (pack->status != LIBUSB_TRANSFER_COMPLETED) { |
||||
fprintf(stderr, "Error: pack %u status %d\n", i, pack->status); |
||||
exit(5); |
||||
} |
||||
|
||||
printf("pack%u length:%u, actual_length:%u\n", i, pack->length, pack->actual_length); |
||||
} |
||||
} |
||||
|
||||
printf("length:%u, actual_length:%u\n", xfr->length, xfr->actual_length); |
||||
for (i = 0; i < xfr->actual_length; i++) { |
||||
printf("%02x", xfr->buffer[i]); |
||||
if (i % 16) |
||||
printf("\n"); |
||||
else if (i % 8) |
||||
printf(" "); |
||||
else |
||||
printf(" "); |
||||
} |
||||
num_bytes += xfr->actual_length; |
||||
num_xfer++; |
||||
|
||||
if (libusb_submit_transfer(xfr) < 0) { |
||||
fprintf(stderr, "error re-submitting URB\n"); |
||||
exit(1); |
||||
} |
||||
} |
||||
|
||||
static int benchmark_in(uint8_t ep) |
||||
{ |
||||
static uint8_t buf[2048]; |
||||
static struct libusb_transfer *xfr; |
||||
int num_iso_pack = 0; |
||||
|
||||
if (ep == EP_ISO_IN) |
||||
num_iso_pack = 16; |
||||
|
||||
xfr = libusb_alloc_transfer(num_iso_pack); |
||||
if (!xfr) |
||||
return -ENOMEM; |
||||
|
||||
if (ep == EP_ISO_IN) { |
||||
libusb_fill_iso_transfer(xfr, devh, ep, buf, |
||||
sizeof(buf), num_iso_pack, cb_xfr, NULL, 0); |
||||
libusb_set_iso_packet_lengths(xfr, sizeof(buf)/num_iso_pack); |
||||
} else |
||||
libusb_fill_bulk_transfer(xfr, devh, ep, buf, |
||||
sizeof(buf), cb_xfr, NULL, 0); |
||||
|
||||
gettimeofday(&tv_start, NULL); |
||||
|
||||
/* NOTE: To reach maximum possible performance the program must
|
||||
* submit *multiple* transfers here, not just one. |
||||
* |
||||
* When only one transfer is submitted there is a gap in the bus |
||||
* schedule from when the transfer completes until a new transfer |
||||
* is submitted by the callback. This causes some jitter for |
||||
* isochronous transfers and loss of throughput for bulk transfers. |
||||
* |
||||
* This is avoided by queueing multiple transfers in advance, so |
||||
* that the host controller is always kept busy, and will schedule |
||||
* more transfers on the bus while the callback is running for |
||||
* transfers which have completed on the bus. |
||||
*/ |
||||
|
||||
return libusb_submit_transfer(xfr); |
||||
} |
||||
|
||||
static void measure(void) |
||||
{ |
||||
struct timeval tv_stop; |
||||
unsigned int diff_msec; |
||||
|
||||
gettimeofday(&tv_stop, NULL); |
||||
|
||||
diff_msec = (tv_stop.tv_sec - tv_start.tv_sec)*1000; |
||||
diff_msec += (tv_stop.tv_usec - tv_start.tv_usec)/1000; |
||||
|
||||
printf("%lu transfers (total %lu bytes) in %u miliseconds => %lu bytes/sec\n", |
||||
num_xfer, num_bytes, diff_msec, (num_bytes*1000)/diff_msec); |
||||
} |
||||
|
||||
static void sig_hdlr(int signum) |
||||
{ |
||||
switch (signum) { |
||||
case SIGINT: |
||||
measure(); |
||||
do_exit = 1; |
||||
break; |
||||
} |
||||
} |
||||
|
||||
int main(int argc, char **argv) |
||||
{ |
||||
int rc; |
||||
struct sigaction sigact; |
||||
|
||||
sigact.sa_handler = sig_hdlr; |
||||
sigemptyset(&sigact.sa_mask); |
||||
sigact.sa_flags = 0; |
||||
sigaction(SIGINT, &sigact, NULL); |
||||
|
||||
rc = libusb_init(NULL); |
||||
if (rc < 0) { |
||||
fprintf(stderr, "Error initializing libusb: %s\n", libusb_error_name(rc)); |
||||
exit(1); |
||||
} |
||||
|
||||
devh = libusb_open_device_with_vid_pid(NULL, 0x16c0, 0x0763); |
||||
if (!devh) { |
||||
fprintf(stderr, "Error finding USB device\n"); |
||||
goto out; |
||||
} |
||||
|
||||
rc = libusb_claim_interface(devh, 2); |
||||
if (rc < 0) { |
||||
fprintf(stderr, "Error claiming interface: %s\n", libusb_error_name(rc)); |
||||
goto out; |
||||
} |
||||
|
||||
benchmark_in(EP_ISO_IN); |
||||
|
||||
while (!do_exit) { |
||||
rc = libusb_handle_events(NULL); |
||||
if (rc != LIBUSB_SUCCESS) |
||||
break; |
||||
} |
||||
|
||||
/* Measurement has already been done by the signal handler. */ |
||||
|
||||
libusb_release_interface(devh, 0); |
||||
out: |
||||
if (devh) |
||||
libusb_close(devh); |
||||
libusb_exit(NULL); |
||||
return rc; |
||||
} |
@ -1,256 +0,0 @@
@@ -1,256 +0,0 @@
|
||||
/*
|
||||
* Test suite program based of libusb-0.1-compat testlibusb |
||||
* Copyright (c) 2013 Nathan Hjelm <hjelmn@mac.ccom> |
||||
* |
||||
* This library is free software; you can redistribute it and/or |
||||
* modify it under the terms of the GNU Lesser General Public |
||||
* License as published by the Free Software Foundation; either |
||||
* version 2.1 of the License, or (at your option) any later version. |
||||
* |
||||
* This library is distributed in the hope that it will be useful, |
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
||||
* Lesser General Public License for more details. |
||||
* |
||||
* You should have received a copy of the GNU Lesser General Public |
||||
* License along with this library; if not, write to the Free Software |
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
||||
*/ |
||||
|
||||
#include <stdio.h> |
||||
#include <string.h> |
||||
#include <libusb.h> |
||||
|
||||
int verbose = 0; |
||||
|
||||
static void print_endpoint_comp(const struct libusb_ss_endpoint_companion_descriptor *ep_comp) |
||||
{ |
||||
printf(" USB 3.0 Endpoint Companion:\n"); |
||||
printf(" bMaxBurst: %d\n", ep_comp->bMaxBurst); |
||||
printf(" bmAttributes: 0x%02x\n", ep_comp->bmAttributes); |
||||
printf(" wBytesPerInterval: %d\n", ep_comp->wBytesPerInterval); |
||||
} |
||||
|
||||
static void print_endpoint(const struct libusb_endpoint_descriptor *endpoint) |
||||
{ |
||||
int i, ret; |
||||
|
||||
printf(" Endpoint:\n"); |
||||
printf(" bEndpointAddress: %02xh\n", endpoint->bEndpointAddress); |
||||
printf(" bmAttributes: %02xh\n", endpoint->bmAttributes); |
||||
printf(" wMaxPacketSize: %d\n", endpoint->wMaxPacketSize); |
||||
printf(" bInterval: %d\n", endpoint->bInterval); |
||||
printf(" bRefresh: %d\n", endpoint->bRefresh); |
||||
printf(" bSynchAddress: %d\n", endpoint->bSynchAddress); |
||||
|
||||
for (i = 0 ; i < endpoint->extra_length ; ) { |
||||
if (LIBUSB_DT_SS_ENDPOINT_COMPANION == endpoint->extra[i+1]) { |
||||
struct libusb_ss_endpoint_companion_descriptor *ep_comp; |
||||
|
||||
ret = libusb_parse_ss_endpoint_comp(endpoint->extra+i, endpoint->extra[0], &ep_comp); |
||||
if (LIBUSB_SUCCESS != ret) { |
||||
continue; |
||||
} |
||||
|
||||
print_endpoint_comp(ep_comp); |
||||
|
||||
libusb_free_ss_endpoint_comp(ep_comp); |
||||
} |
||||
|
||||
i += endpoint->extra[i]; |
||||
} |
||||
} |
||||
|
||||
static void print_altsetting(const struct libusb_interface_descriptor *interface) |
||||
{ |
||||
int i; |
||||
|
||||
printf(" Interface:\n"); |
||||
printf(" bInterfaceNumber: %d\n", interface->bInterfaceNumber); |
||||
printf(" bAlternateSetting: %d\n", interface->bAlternateSetting); |
||||
printf(" bNumEndpoints: %d\n", interface->bNumEndpoints); |
||||
printf(" bInterfaceClass: %d\n", interface->bInterfaceClass); |
||||
printf(" bInterfaceSubClass: %d\n", interface->bInterfaceSubClass); |
||||
printf(" bInterfaceProtocol: %d\n", interface->bInterfaceProtocol); |
||||
printf(" iInterface: %d\n", interface->iInterface); |
||||
|
||||
for (i = 0; i < interface->bNumEndpoints; i++) |
||||
print_endpoint(&interface->endpoint[i]); |
||||
} |
||||
|
||||
static void print_2_0_ext_cap(struct libusb_usb_2_0_device_capability_descriptor *usb_2_0_ext_cap) |
||||
{ |
||||
printf(" USB 2.0 Extension Capabilities:\n"); |
||||
printf(" bDevCapabilityType: %d\n", usb_2_0_ext_cap->bDevCapabilityType); |
||||
printf(" bmAttributes: 0x%x\n", usb_2_0_ext_cap->bmAttributes); |
||||
} |
||||
|
||||
static void print_ss_usb_cap(struct libusb_ss_usb_device_capability_descriptor *ss_usb_cap) |
||||
{ |
||||
printf(" USB 3.0 Capabilities:\n"); |
||||
printf(" bDevCapabilityType: %d\n", ss_usb_cap->bDevCapabilityType); |
||||
printf(" bmAttributes: 0x%x\n", ss_usb_cap->bmAttributes); |
||||
printf(" wSpeedSupported: 0x%x\n", ss_usb_cap->wSpeedSupported); |
||||
printf(" bFunctionalitySupport: %d\n", ss_usb_cap->bFunctionalitySupport); |
||||
printf(" bU1devExitLat: %d\n", ss_usb_cap->bU1DevExitLat); |
||||
printf(" bU2devExitLat: %d\n", ss_usb_cap->bU2DevExitLat); |
||||
} |
||||
|
||||
static void print_bos(libusb_device_handle *handle) |
||||
{ |
||||
unsigned char buffer[128]; |
||||
struct libusb_bos_descriptor *bos; |
||||
int ret; |
||||
|
||||
ret = libusb_get_descriptor(handle, LIBUSB_DT_BOS, 0, buffer, 128); |
||||
if (0 > ret) { |
||||
return; |
||||
} |
||||
|
||||
ret = libusb_parse_bos_descriptor(buffer, 128, &bos); |
||||
if (0 > ret) { |
||||
return; |
||||
} |
||||
|
||||
printf(" Binary Object Store (BOS):\n"); |
||||
printf(" wTotalLength: %d\n", bos->wTotalLength); |
||||
printf(" bNumDeviceCaps: %d\n", bos->bNumDeviceCaps); |
||||
if (bos->usb_2_0_ext_cap) { |
||||
print_2_0_ext_cap(bos->usb_2_0_ext_cap); |
||||
} |
||||
|
||||
if (bos->ss_usb_cap) { |
||||
print_ss_usb_cap(bos->ss_usb_cap); |
||||
} |
||||
} |
||||
|
||||
static void print_interface(const struct libusb_interface *interface) |
||||
{ |
||||
int i; |
||||
|
||||
for (i = 0; i < interface->num_altsetting; i++) |
||||
print_altsetting(&interface->altsetting[i]); |
||||
} |
||||
|
||||
static void print_configuration(struct libusb_config_descriptor *config) |
||||
{ |
||||
int i; |
||||
|
||||
printf(" Configuration:\n"); |
||||
printf(" wTotalLength: %d\n", config->wTotalLength); |
||||
printf(" bNumInterfaces: %d\n", config->bNumInterfaces); |
||||
printf(" bConfigurationValue: %d\n", config->bConfigurationValue); |
||||
printf(" iConfiguration: %d\n", config->iConfiguration); |
||||
printf(" bmAttributes: %02xh\n", config->bmAttributes); |
||||
printf(" MaxPower: %d\n", config->MaxPower); |
||||
|
||||
for (i = 0; i < config->bNumInterfaces; i++) |
||||
print_interface(&config->interface[i]); |
||||
} |
||||
|
||||
static int print_device(libusb_device *dev, int level) |
||||
{ |
||||
struct libusb_device_descriptor desc; |
||||
libusb_device_handle *handle = NULL; |
||||
char description[256]; |
||||
char string[256]; |
||||
int ret, i; |
||||
|
||||
ret = libusb_get_device_descriptor(dev, &desc); |
||||
if (ret < 0) { |
||||
fprintf(stderr, "failed to get device descriptor"); |
||||
return -1; |
||||
} |
||||
|
||||
ret = libusb_open(dev, &handle); |
||||
if (LIBUSB_SUCCESS == ret) { |
||||
if (desc.iManufacturer) { |
||||
ret = libusb_get_string_descriptor_ascii(handle, desc.iManufacturer, string, sizeof(string)); |
||||
if (ret > 0) |
||||
snprintf(description, sizeof(description), "%s - ", string); |
||||
else |
||||
snprintf(description, sizeof(description), "%04X - ", |
||||
desc.idVendor); |
||||
} else |
||||
snprintf(description, sizeof(description), "%04X - ", |
||||
desc.idVendor); |
||||
|
||||
if (desc.iProduct) { |
||||
ret = libusb_get_string_descriptor_ascii(handle, desc.iProduct, string, sizeof(string)); |
||||
if (ret > 0) |
||||
snprintf(description + strlen(description), sizeof(description) - |
||||
strlen(description), "%s", string); |
||||
else |
||||
snprintf(description + strlen(description), sizeof(description) - |
||||
strlen(description), "%04X", desc.idProduct); |
||||
} else |
||||
snprintf(description + strlen(description), sizeof(description) - |
||||
strlen(description), "%04X", desc.idProduct); |
||||
} else { |
||||
snprintf(description, sizeof(description), "%04X - %04X", |
||||
desc.idVendor, desc.idProduct); |
||||
} |
||||
|
||||
printf("%.*sDev (bus %d, device %d): %s\n", level * 2, " ", |
||||
libusb_get_bus_number(dev), libusb_get_device_address(dev), description); |
||||
|
||||
if (handle && verbose) { |
||||
if (desc.iSerialNumber) { |
||||
ret = libusb_get_string_descriptor_ascii(handle, desc.iSerialNumber, string, sizeof(string)); |
||||
if (ret > 0) |
||||
printf("%.*s - Serial Number: %s\n", level * 2, |
||||
" ", string); |
||||
} |
||||
} |
||||
|
||||
if (verbose) { |
||||
for (i = 0; i < desc.bNumConfigurations; i++) { |
||||
struct libusb_config_descriptor *config; |
||||
ret = libusb_get_config_descriptor(dev, i, &config); |
||||
if (LIBUSB_SUCCESS != ret) { |
||||
printf(" Couldn't retrieve descriptors\n"); |
||||
continue; |
||||
} |
||||
|
||||
print_configuration(config); |
||||
|
||||
libusb_free_config_descriptor(config); |
||||
} |
||||
|
||||
if (handle && desc.bcdUSB >= 0x0201) { |
||||
print_bos(handle); |
||||
} |
||||
} |
||||
|
||||
if (handle) |
||||
libusb_close(handle); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
int main(int argc, char *argv[]) |
||||
{ |
||||
libusb_device **devs; |
||||
ssize_t cnt; |
||||
int r, i; |
||||
|
||||
if (argc > 1 && !strcmp(argv[1], "-v")) |
||||
verbose = 1; |
||||
|
||||
r = libusb_init(NULL); |
||||
if (r < 0) |
||||
return r; |
||||
|
||||
cnt = libusb_get_device_list(NULL, &devs); |
||||
if (cnt < 0) |
||||
return (int) cnt; |
||||
|
||||
for (i = 0 ; devs[i] ; ++i) { |
||||
print_device(devs[i], 0); |
||||
} |
||||
|
||||
libusb_free_device_list(devs, 1); |
||||
|
||||
libusb_exit(NULL); |
||||
return 0; |
||||
} |
Loading…
Reference in new issue