FreeCalypso > hg > fc-usbser-tools
annotate duart28/find_usb.c @ 31:530ec3792de8
fc-duart28-conf: implement set command
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sat, 09 Sep 2023 19:40:58 +0000 |
parents | 2413a54a1bfc |
children | b9ecfa54fe2b |
rev | line source |
---|---|
27
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1 /* |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2 * This module implements the step of locating a connected FreeCalypso DUART28 |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
3 * device (either C or S) at the libusb level, without booting off the kernel |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
4 * driver and claiming the interface yet. |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
5 */ |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
6 |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
7 #include <stdio.h> |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
8 #include <stdlib.h> |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
9 #include <string.h> |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
10 #include <strings.h> |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
11 #include <usb.h> |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
12 #include "../libuwrap/prelim_init.h" |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
13 |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
14 static void |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
15 get_string(usb_dev_handle *usbh, int index, char *buf, size_t buflen) |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
16 { |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
17 int rc; |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
18 |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
19 rc = usb_get_string_simple(usbh, index, buf, buflen); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
20 if (rc <= 0) { |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
21 fprintf(stderr, "error: USB string retrieval failed\n"); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
22 exit(1); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
23 } |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
24 } |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
25 |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
26 static void |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
27 report_found_dev(struct usb_device *dev, unsigned usb_pid, char string_letter) |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
28 { |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
29 printf("Found FreeCalypso DUART28 adapter at bus %s device %s,\n", |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
30 dev->bus->dirname, dev->filename); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
31 if (usb_pid == 0x7152 && string_letter == 'C') |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
32 printf("presenting as DUART28C\n"); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
33 else if (usb_pid == 0x6010 && string_letter == 'S') |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
34 printf("presenting as DUART28S\n"); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
35 else |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
36 printf("presenting with inconsistent ID!\n"); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
37 } |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
38 |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
39 static int |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
40 is_match(struct usb_device *dev) |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
41 { |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
42 struct usb_device_descriptor *desc = &dev->descriptor; |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
43 usb_dev_handle *usbh; |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
44 char strbuf[1024]; |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
45 |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
46 if (desc->idVendor != 0x0403) |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
47 return 0; |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
48 if (desc->idProduct != 0x6010 && desc->idProduct != 0x7152) |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
49 return 0; |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
50 usbh = usb_open(dev); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
51 if (!usbh) { |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
52 fprintf(stderr, "error: usb_open() failed\n"); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
53 exit(1); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
54 } |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
55 get_string(usbh, desc->iManufacturer, strbuf, sizeof strbuf); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
56 if (strcmp(strbuf, "FreeCalypso")) { |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
57 usb_close(usbh); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
58 return 0; |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
59 } |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
60 get_string(usbh, desc->iProduct, strbuf, sizeof strbuf); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
61 if (strcmp(strbuf, "DUART28C") && strcmp(strbuf, "DUART28S")) { |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
62 usb_close(usbh); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
63 return 0; |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
64 } |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
65 usb_close(usbh); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
66 report_found_dev(dev, desc->idProduct, strbuf[7]); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
67 return 1; |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
68 } |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
69 |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
70 struct usb_device * |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
71 find_duart28_usbdev() |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
72 { |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
73 struct usb_bus *bus; |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
74 struct usb_device *dev; |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
75 |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
76 libusb_prelim_init(); |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
77 for (bus = usb_get_busses(); bus; bus = bus->next) { |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
78 for (dev = bus->devices; dev; dev = dev->next) { |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
79 if (is_match(dev)) |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
80 return dev; |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
81 } |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
82 } |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
83 return 0; |
2413a54a1bfc
fc-duart28-conf started
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
84 } |