usbconfig.c revision 356404
1184610Salfred/* $FreeBSD: stable/10/usr.sbin/usbconfig/usbconfig.c 356404 2020-01-06 09:37:13Z hselasky $ */
2184610Salfred/*-
3201705Sthompsa * Copyright (c) 2008-2009 Hans Petter Selasky. All rights reserved.
4184610Salfred *
5184610Salfred * Redistribution and use in source and binary forms, with or without
6184610Salfred * modification, are permitted provided that the following conditions
7184610Salfred * are met:
8184610Salfred * 1. Redistributions of source code must retain the above copyright
9184610Salfred *    notice, this list of conditions and the following disclaimer.
10184610Salfred * 2. Redistributions in binary form must reproduce the above copyright
11184610Salfred *    notice, this list of conditions and the following disclaimer in the
12184610Salfred *    documentation and/or other materials provided with the distribution.
13184610Salfred *
14184610Salfred * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15184610Salfred * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16184610Salfred * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17184610Salfred * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18184610Salfred * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19184610Salfred * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20184610Salfred * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21184610Salfred * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22184610Salfred * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23184610Salfred * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24184610Salfred * SUCH DAMAGE.
25184610Salfred */
26184610Salfred
27184610Salfred#include <stdio.h>
28184610Salfred#include <stdlib.h>
29184610Salfred#include <stdint.h>
30184610Salfred#include <err.h>
31184610Salfred#include <string.h>
32184610Salfred#include <pwd.h>
33184610Salfred#include <grp.h>
34184610Salfred#include <errno.h>
35185087Salfred#include <ctype.h>
36248236Shselasky#include <sys/types.h>
37184610Salfred
38184610Salfred#include <libusb20_desc.h>
39184610Salfred#include <libusb20.h>
40184610Salfred
41184610Salfred#include "dump.h"
42184610Salfred
43184610Salfredstruct options {
44184610Salfred	const char *quirkname;
45185087Salfred	void   *buffer;
46188987Sthompsa	int template;
47184610Salfred	gid_t	gid;
48184610Salfred	uid_t	uid;
49184610Salfred	mode_t	mode;
50184610Salfred	uint32_t got_any;
51185087Salfred	struct LIBUSB20_CONTROL_SETUP_DECODED setup;
52184610Salfred	uint16_t bus;
53184610Salfred	uint16_t addr;
54184610Salfred	uint16_t iface;
55184610Salfred	uint16_t vid;
56184610Salfred	uint16_t pid;
57184610Salfred	uint16_t lo_rev;		/* inclusive */
58184610Salfred	uint16_t hi_rev;		/* inclusive */
59185087Salfred	uint8_t	string_index;
60184610Salfred	uint8_t	config_index;
61184610Salfred	uint8_t	alt_index;
62184610Salfred	uint8_t	got_list:1;
63184610Salfred	uint8_t	got_bus:1;
64184610Salfred	uint8_t	got_addr:1;
65184610Salfred	uint8_t	got_iface:1;
66184610Salfred	uint8_t	got_set_config:1;
67184610Salfred	uint8_t	got_set_alt:1;
68188987Sthompsa	uint8_t	got_set_template:1;
69188987Sthompsa	uint8_t	got_get_template:1;
70184610Salfred	uint8_t	got_suspend:1;
71184610Salfred	uint8_t	got_resume:1;
72184610Salfred	uint8_t	got_reset:1;
73184610Salfred	uint8_t	got_power_off:1;
74184610Salfred	uint8_t	got_power_save:1;
75184610Salfred	uint8_t	got_power_on:1;
76184610Salfred	uint8_t	got_dump_device_quirks:1;
77184610Salfred	uint8_t	got_dump_quirk_names:1;
78356404Shselasky	uint8_t	got_dump_all_desc:1;
79184610Salfred	uint8_t	got_dump_device_desc:1;
80184610Salfred	uint8_t	got_dump_curr_config:1;
81184610Salfred	uint8_t	got_dump_all_config:1;
82184610Salfred	uint8_t	got_dump_info:1;
83188622Sthompsa	uint8_t	got_show_iface_driver:1;
84184610Salfred	uint8_t	got_remove_device_quirk:1;
85184610Salfred	uint8_t	got_add_device_quirk:1;
86201705Sthompsa	uint8_t	got_remove_quirk:1;
87201705Sthompsa	uint8_t	got_add_quirk:1;
88185087Salfred	uint8_t	got_dump_string:1;
89185087Salfred	uint8_t	got_do_request:1;
90184610Salfred};
91184610Salfred
92184610Salfredstruct token {
93184610Salfred	const char *name;
94184610Salfred	uint8_t	value;
95184610Salfred	uint8_t	narg;
96184610Salfred};
97184610Salfred
98184610Salfredenum {
99184610Salfred	T_UNIT,
100184610Salfred	T_ADDR,
101201705Sthompsa	T_UGEN,
102184610Salfred	T_IFACE,
103184610Salfred	T_SET_CONFIG,
104184610Salfred	T_SET_ALT,
105188987Sthompsa	T_SET_TEMPLATE,
106188987Sthompsa	T_GET_TEMPLATE,
107184610Salfred	T_ADD_DEVICE_QUIRK,
108184610Salfred	T_REMOVE_DEVICE_QUIRK,
109201705Sthompsa	T_ADD_QUIRK,
110201705Sthompsa	T_REMOVE_QUIRK,
111188622Sthompsa	T_SHOW_IFACE_DRIVER,
112184610Salfred	T_DUMP_QUIRK_NAMES,
113184610Salfred	T_DUMP_DEVICE_QUIRKS,
114356404Shselasky	T_DUMP_ALL_DESC,
115184610Salfred	T_DUMP_DEVICE_DESC,
116184610Salfred	T_DUMP_CURR_CONFIG_DESC,
117184610Salfred	T_DUMP_ALL_CONFIG_DESC,
118185087Salfred	T_DUMP_STRING,
119184610Salfred	T_DUMP_INFO,
120184610Salfred	T_SUSPEND,
121184610Salfred	T_RESUME,
122184610Salfred	T_POWER_OFF,
123184610Salfred	T_POWER_SAVE,
124184610Salfred	T_POWER_ON,
125184610Salfred	T_RESET,
126184610Salfred	T_LIST,
127185087Salfred	T_DO_REQUEST,
128184610Salfred};
129184610Salfred
130184610Salfredstatic struct options options;
131184610Salfred
132184610Salfredstatic const struct token token[] = {
133184610Salfred	{"-u", T_UNIT, 1},
134184610Salfred	{"-a", T_ADDR, 1},
135201705Sthompsa	{"-d", T_UGEN, 1},
136184610Salfred	{"-i", T_IFACE, 1},
137184610Salfred	{"set_config", T_SET_CONFIG, 1},
138184610Salfred	{"set_alt", T_SET_ALT, 1},
139188987Sthompsa	{"set_template", T_SET_TEMPLATE, 1},
140188987Sthompsa	{"get_template", T_GET_TEMPLATE, 0},
141184610Salfred	{"add_dev_quirk_vplh", T_ADD_DEVICE_QUIRK, 5},
142184610Salfred	{"remove_dev_quirk_vplh", T_REMOVE_DEVICE_QUIRK, 5},
143201705Sthompsa	{"add_quirk", T_ADD_QUIRK, 1},
144201705Sthompsa	{"remove_quirk", T_REMOVE_QUIRK, 1},
145184610Salfred	{"dump_quirk_names", T_DUMP_QUIRK_NAMES, 0},
146184610Salfred	{"dump_device_quirks", T_DUMP_DEVICE_QUIRKS, 0},
147356404Shselasky	{"dump_all_desc", T_DUMP_ALL_DESC, 0},
148184610Salfred	{"dump_device_desc", T_DUMP_DEVICE_DESC, 0},
149184610Salfred	{"dump_curr_config_desc", T_DUMP_CURR_CONFIG_DESC, 0},
150184610Salfred	{"dump_all_config_desc", T_DUMP_ALL_CONFIG_DESC, 0},
151185087Salfred	{"dump_string", T_DUMP_STRING, 1},
152184610Salfred	{"dump_info", T_DUMP_INFO, 0},
153188622Sthompsa	{"show_ifdrv", T_SHOW_IFACE_DRIVER, 0},
154184610Salfred	{"suspend", T_SUSPEND, 0},
155184610Salfred	{"resume", T_RESUME, 0},
156184610Salfred	{"power_off", T_POWER_OFF, 0},
157184610Salfred	{"power_save", T_POWER_SAVE, 0},
158184610Salfred	{"power_on", T_POWER_ON, 0},
159184610Salfred	{"reset", T_RESET, 0},
160184610Salfred	{"list", T_LIST, 0},
161185087Salfred	{"do_request", T_DO_REQUEST, 5},
162184610Salfred};
163184610Salfred
164184610Salfredstatic void
165184610Salfredbe_dev_remove_quirk(struct libusb20_backend *pbe,
166184610Salfred    uint16_t vid, uint16_t pid, uint16_t lorev, uint16_t hirev,
167184610Salfred    const char *str)
168184610Salfred{
169184610Salfred	struct libusb20_quirk q;
170185087Salfred	int error;
171184610Salfred
172184610Salfred	memset(&q, 0, sizeof(q));
173184610Salfred
174184610Salfred	q.vid = vid;
175184610Salfred	q.pid = pid;
176184610Salfred	q.bcdDeviceLow = lorev;
177184610Salfred	q.bcdDeviceHigh = hirev;
178184610Salfred	strlcpy(q.quirkname, str, sizeof(q.quirkname));
179184610Salfred
180185087Salfred	error = libusb20_be_remove_dev_quirk(pbe, &q);
181185087Salfred	if (error) {
182202026Sthompsa		fprintf(stderr, "Removing quirk '%s' failed, continuing.\n", str);
183184610Salfred	}
184184610Salfred	return;
185184610Salfred}
186184610Salfred
187184610Salfredstatic void
188184610Salfredbe_dev_add_quirk(struct libusb20_backend *pbe,
189184610Salfred    uint16_t vid, uint16_t pid, uint16_t lorev, uint16_t hirev,
190184610Salfred    const char *str)
191184610Salfred{
192184610Salfred	struct libusb20_quirk q;
193185087Salfred	int error;
194184610Salfred
195184610Salfred	memset(&q, 0, sizeof(q));
196184610Salfred
197184610Salfred	q.vid = vid;
198184610Salfred	q.pid = pid;
199184610Salfred	q.bcdDeviceLow = lorev;
200184610Salfred	q.bcdDeviceHigh = hirev;
201184610Salfred	strlcpy(q.quirkname, str, sizeof(q.quirkname));
202184610Salfred
203185087Salfred	error = libusb20_be_add_dev_quirk(pbe, &q);
204185087Salfred	if (error) {
205202026Sthompsa		fprintf(stderr, "Adding quirk '%s' failed, continuing.\n", str);
206184610Salfred	}
207184610Salfred	return;
208184610Salfred}
209184610Salfred
210184610Salfredstatic uint8_t
211184610Salfredget_token(const char *str, uint8_t narg)
212184610Salfred{
213184610Salfred	uint8_t n;
214184610Salfred
215184610Salfred	for (n = 0; n != (sizeof(token) / sizeof(token[0])); n++) {
216184610Salfred		if (strcasecmp(str, token[n].name) == 0) {
217184610Salfred			if (token[n].narg > narg) {
218185087Salfred				/* too few arguments */
219184610Salfred				break;
220184610Salfred			}
221184610Salfred			return (token[n].value);
222184610Salfred		}
223184610Salfred	}
224184610Salfred	return (0 - 1);
225184610Salfred}
226184610Salfred
227184610Salfredstatic uid_t
228184610Salfrednum_id(const char *name, const char *type)
229184610Salfred{
230184610Salfred	uid_t val;
231184610Salfred	char *ep;
232184610Salfred
233184610Salfred	errno = 0;
234184610Salfred	val = strtoul(name, &ep, 0);
235184610Salfred	if (errno) {
236184610Salfred		err(1, "%s", name);
237184610Salfred	}
238184610Salfred	if (*ep != '\0') {
239184610Salfred		errx(1, "%s: illegal %s name", name, type);
240184610Salfred	}
241184610Salfred	return (val);
242184610Salfred}
243184610Salfred
244189110Sthompsastatic int
245189110Sthompsaget_int(const char *s)
246184610Salfred{
247189110Sthompsa	int val;
248184610Salfred	char *ep;
249184610Salfred
250184610Salfred	errno = 0;
251189110Sthompsa	val = strtoul(s, &ep, 0);
252184610Salfred	if (errno) {
253184610Salfred		err(1, "%s", s);
254184610Salfred	}
255184610Salfred	if (*ep != '\0') {
256189110Sthompsa		errx(1, "illegal number: %s", s);
257184610Salfred	}
258184610Salfred	return val;
259184610Salfred}
260184610Salfred
261184610Salfredstatic void
262201705Sthompsaduplicate_option(const char *ptr)
263201705Sthompsa{
264202026Sthompsa	fprintf(stderr, "Syntax error: "
265201705Sthompsa	    "Duplicate option: '%s'\n", ptr);
266201705Sthompsa	exit(1);
267201705Sthompsa}
268201705Sthompsa
269201705Sthompsastatic void
270184610Salfredusage(void)
271184610Salfred{
272202026Sthompsa	fprintf(stderr, ""
273184610Salfred	    "usbconfig - configure the USB subsystem" "\n"
274184610Salfred	    "usage: usbconfig -u <busnum> -a <devaddr> -i <ifaceindex> [cmds...]" "\n"
275201705Sthompsa	    "usage: usbconfig -d [ugen]<busnum>.<devaddr> -i <ifaceindex> [cmds...]" "\n"
276184610Salfred	    "commands:" "\n"
277185087Salfred	    "  set_config <cfg_index>" "\n"
278185087Salfred	    "  set_alt <alt_index>" "\n"
279188987Sthompsa	    "  set_template <template>" "\n"
280188987Sthompsa	    "  get_template" "\n"
281184610Salfred	    "  add_dev_quirk_vplh <vid> <pid> <lo_rev> <hi_rev> <quirk>" "\n"
282184610Salfred	    "  remove_dev_quirk_vplh <vid> <pid> <lo_rev> <hi_rev> <quirk>" "\n"
283201705Sthompsa	    "  add_quirk <quirk>" "\n"
284201705Sthompsa	    "  remove_quirk <quirk>" "\n"
285184610Salfred	    "  dump_quirk_names" "\n"
286184610Salfred	    "  dump_device_quirks" "\n"
287356404Shselasky	    "  dump_all_desc" "\n"
288184610Salfred	    "  dump_device_desc" "\n"
289184610Salfred	    "  dump_curr_config_desc" "\n"
290184610Salfred	    "  dump_all_config_desc" "\n"
291185087Salfred	    "  dump_string <index>" "\n"
292184610Salfred	    "  dump_info" "\n"
293188622Sthompsa	    "  show_ifdrv" "\n"
294184610Salfred	    "  suspend" "\n"
295184610Salfred	    "  resume" "\n"
296184610Salfred	    "  power_off" "\n"
297184610Salfred	    "  power_save" "\n"
298184610Salfred	    "  power_on" "\n"
299184610Salfred	    "  reset" "\n"
300184610Salfred	    "  list" "\n"
301185087Salfred	    "  do_request <bmReqTyp> <bReq> <wVal> <wIdx> <wLen> <data...>" "\n"
302184610Salfred	);
303184610Salfred	exit(1);
304184610Salfred}
305184610Salfred
306184610Salfredstatic void
307184610Salfredreset_options(struct options *opt)
308184610Salfred{
309185087Salfred	if (opt->buffer)
310185087Salfred		free(opt->buffer);
311184610Salfred	memset(opt, 0, sizeof(*opt));
312184610Salfred	return;
313184610Salfred}
314184610Salfred
315184610Salfredstatic void
316184610Salfredflush_command(struct libusb20_backend *pbe, struct options *opt)
317184610Salfred{
318184610Salfred	struct libusb20_device *pdev = NULL;
319184610Salfred	uint32_t matches = 0;
320184610Salfred	uint8_t dump_any;
321184610Salfred
322184610Salfred	/* check for invalid option combinations */
323184610Salfred	if ((opt->got_suspend +
324184610Salfred	    opt->got_resume +
325184610Salfred	    opt->got_reset +
326184610Salfred	    opt->got_set_config +
327184610Salfred	    opt->got_set_alt +
328184610Salfred	    opt->got_power_save +
329184610Salfred	    opt->got_power_on +
330184610Salfred	    opt->got_power_off) > 1) {
331187168Sthompsa		err(1, "can only specify one of 'set_config', "
332184610Salfred		    "'set_alt', 'reset', 'suspend', 'resume', "
333184610Salfred		    "'power_save', 'power_on' and 'power_off' "
334184610Salfred		    "at the same time!");
335184610Salfred	}
336184610Salfred	if (opt->got_dump_quirk_names) {
337184610Salfred		opt->got_any--;
338184610Salfred		dump_be_quirk_names(pbe);
339184610Salfred	}
340184610Salfred	if (opt->got_dump_device_quirks) {
341184610Salfred		opt->got_any--;
342184610Salfred		dump_be_dev_quirks(pbe);
343184610Salfred	}
344184610Salfred	if (opt->got_remove_device_quirk) {
345184610Salfred		opt->got_any--;
346184610Salfred		be_dev_remove_quirk(pbe,
347184610Salfred		    opt->vid, opt->pid, opt->lo_rev, opt->hi_rev, opt->quirkname);
348184610Salfred	}
349184610Salfred	if (opt->got_add_device_quirk) {
350184610Salfred		opt->got_any--;
351184610Salfred		be_dev_add_quirk(pbe,
352184610Salfred		    opt->vid, opt->pid, opt->lo_rev, opt->hi_rev, opt->quirkname);
353184610Salfred	}
354188987Sthompsa	if (opt->got_set_template) {
355188987Sthompsa		opt->got_any--;
356188987Sthompsa		if (libusb20_be_set_template(pbe, opt->template)) {
357202026Sthompsa			fprintf(stderr, "Setting USB template %u failed, "
358188987Sthompsa			    "continuing.\n", opt->template);
359188987Sthompsa		}
360188987Sthompsa	}
361188987Sthompsa	if (opt->got_get_template) {
362188987Sthompsa		opt->got_any--;
363188987Sthompsa		if (libusb20_be_get_template(pbe, &opt->template))
364188987Sthompsa			printf("USB template: <unknown>\n");
365188987Sthompsa		else
366188987Sthompsa			printf("USB template: %u\n", opt->template);
367188987Sthompsa	}
368184610Salfred	if (opt->got_any == 0) {
369184610Salfred		/*
370184610Salfred		 * do not scan through all the devices if there are no valid
371184610Salfred		 * options
372184610Salfred		 */
373184610Salfred		goto done;
374184610Salfred	}
375184610Salfred	while ((pdev = libusb20_be_device_foreach(pbe, pdev))) {
376184610Salfred
377184610Salfred		if (opt->got_bus &&
378184610Salfred		    (libusb20_dev_get_bus_number(pdev) != opt->bus)) {
379184610Salfred			continue;
380184610Salfred		}
381184610Salfred		if (opt->got_addr &&
382184610Salfred		    (libusb20_dev_get_address(pdev) != opt->addr)) {
383184610Salfred			continue;
384184610Salfred		}
385184610Salfred		matches++;
386184610Salfred
387201705Sthompsa		if (opt->got_remove_quirk) {
388201705Sthompsa			struct LIBUSB20_DEVICE_DESC_DECODED *ddesc;
389201705Sthompsa
390201705Sthompsa			ddesc = libusb20_dev_get_device_desc(pdev);
391201705Sthompsa
392201705Sthompsa			be_dev_remove_quirk(pbe,
393201705Sthompsa			    ddesc->idVendor, ddesc->idProduct,
394201705Sthompsa			    ddesc->bcdDevice, ddesc->bcdDevice,
395201705Sthompsa			    opt->quirkname);
396201705Sthompsa		}
397201705Sthompsa
398201705Sthompsa		if (opt->got_add_quirk) {
399201705Sthompsa			struct LIBUSB20_DEVICE_DESC_DECODED *ddesc;
400201705Sthompsa
401201705Sthompsa			ddesc = libusb20_dev_get_device_desc(pdev);
402201705Sthompsa
403201705Sthompsa			be_dev_add_quirk(pbe,
404201705Sthompsa			    ddesc->idVendor, ddesc->idProduct,
405201705Sthompsa			    ddesc->bcdDevice, ddesc->bcdDevice,
406201705Sthompsa			    opt->quirkname);
407201705Sthompsa		}
408201705Sthompsa
409184610Salfred		if (libusb20_dev_open(pdev, 0)) {
410184610Salfred			err(1, "could not open device");
411184610Salfred		}
412185087Salfred		if (opt->got_dump_string) {
413201705Sthompsa			dump_string_by_index(pdev, opt->string_index);
414185087Salfred		}
415185087Salfred		if (opt->got_do_request) {
416185087Salfred			uint16_t actlen;
417185087Salfred			uint16_t t;
418185087Salfred
419185087Salfred			if (libusb20_dev_request_sync(pdev, &opt->setup,
420185087Salfred			    opt->buffer, &actlen, 5000 /* 5 seconds */ , 0)) {
421185087Salfred				printf("REQUEST = <ERROR>\n");
422185087Salfred			} else if (!(opt->setup.bmRequestType &
423185087Salfred			    LIBUSB20_ENDPOINT_IN)) {
424185087Salfred				printf("REQUEST = <OK>\n");
425185087Salfred			} else {
426185087Salfred				t = actlen;
427185087Salfred				printf("REQUEST = <");
428185087Salfred				for (t = 0; t != actlen; t++) {
429185087Salfred					printf("0x%02x%s",
430185087Salfred					    ((uint8_t *)opt->buffer)[t],
431185087Salfred					    (t == (actlen - 1)) ? "" : " ");
432185087Salfred				}
433185087Salfred				printf("><");
434185087Salfred				for (t = 0; t != actlen; t++) {
435185087Salfred					char c;
436185087Salfred
437185087Salfred					c = ((uint8_t *)opt->buffer)[t];
438185087Salfred					if ((c != '<') &&
439185087Salfred					    (c != '>') && isprint(c)) {
440185087Salfred						putchar(c);
441185087Salfred					}
442185087Salfred				}
443185087Salfred				printf(">\n");
444185087Salfred			}
445185087Salfred		}
446184610Salfred		if (opt->got_set_config) {
447184610Salfred			if (libusb20_dev_set_config_index(pdev,
448184610Salfred			    opt->config_index)) {
449184610Salfred				err(1, "could not set config index");
450184610Salfred			}
451184610Salfred		}
452184610Salfred		if (opt->got_set_alt) {
453185087Salfred			if (libusb20_dev_set_alt_index(pdev, opt->iface,
454185087Salfred			    opt->alt_index)) {
455184610Salfred				err(1, "could not set alternate setting");
456184610Salfred			}
457184610Salfred		}
458184610Salfred		if (opt->got_reset) {
459184610Salfred			if (libusb20_dev_reset(pdev)) {
460184610Salfred				err(1, "could not reset device");
461184610Salfred			}
462184610Salfred		}
463184610Salfred		if (opt->got_suspend) {
464185087Salfred			if (libusb20_dev_set_power_mode(pdev,
465185087Salfred			    LIBUSB20_POWER_SUSPEND)) {
466184610Salfred				err(1, "could not set suspend");
467184610Salfred			}
468184610Salfred		}
469184610Salfred		if (opt->got_resume) {
470185087Salfred			if (libusb20_dev_set_power_mode(pdev,
471185087Salfred			    LIBUSB20_POWER_RESUME)) {
472184610Salfred				err(1, "could not set resume");
473184610Salfred			}
474184610Salfred		}
475184610Salfred		if (opt->got_power_off) {
476185087Salfred			if (libusb20_dev_set_power_mode(pdev,
477185087Salfred			    LIBUSB20_POWER_OFF)) {
478184610Salfred				err(1, "could not set power OFF");
479184610Salfred			}
480184610Salfred		}
481184610Salfred		if (opt->got_power_save) {
482185087Salfred			if (libusb20_dev_set_power_mode(pdev,
483185087Salfred			    LIBUSB20_POWER_SAVE)) {
484184610Salfred				err(1, "could not set power SAVE");
485184610Salfred			}
486184610Salfred		}
487184610Salfred		if (opt->got_power_on) {
488185087Salfred			if (libusb20_dev_set_power_mode(pdev,
489185087Salfred			    LIBUSB20_POWER_ON)) {
490184610Salfred				err(1, "could not set power ON");
491184610Salfred			}
492184610Salfred		}
493184610Salfred		dump_any =
494356404Shselasky		    (opt->got_dump_all_desc ||
495356404Shselasky		    opt->got_dump_device_desc ||
496184610Salfred		    opt->got_dump_curr_config ||
497184610Salfred		    opt->got_dump_all_config ||
498189110Sthompsa		    opt->got_dump_info);
499184610Salfred
500184610Salfred		if (opt->got_list || dump_any) {
501188622Sthompsa			dump_device_info(pdev,
502188622Sthompsa			    opt->got_show_iface_driver);
503184610Salfred		}
504184610Salfred		if (opt->got_dump_device_desc) {
505184610Salfred			printf("\n");
506184610Salfred			dump_device_desc(pdev);
507184610Salfred		}
508184610Salfred		if (opt->got_dump_all_config) {
509184610Salfred			printf("\n");
510184610Salfred			dump_config(pdev, 1);
511184610Salfred		} else if (opt->got_dump_curr_config) {
512184610Salfred			printf("\n");
513184610Salfred			dump_config(pdev, 0);
514356404Shselasky		} else if (opt->got_dump_all_desc) {
515356404Shselasky			printf("\n");
516356404Shselasky			dump_device_desc(pdev);
517356404Shselasky			dump_config(pdev, 1);
518184610Salfred		}
519184610Salfred		if (dump_any) {
520184610Salfred			printf("\n");
521184610Salfred		}
522184610Salfred		if (libusb20_dev_close(pdev)) {
523184610Salfred			err(1, "could not close device");
524184610Salfred		}
525184610Salfred	}
526184610Salfred
527184610Salfred	if (matches == 0) {
528187162Sthompsa		printf("No device match or lack of permissions.\n");
529184610Salfred	}
530184610Salfreddone:
531184610Salfred	reset_options(opt);
532184610Salfred
533184610Salfred	return;
534184610Salfred}
535184610Salfred
536184610Salfredint
537184610Salfredmain(int argc, char **argv)
538184610Salfred{
539184610Salfred	struct libusb20_backend *pbe;
540184610Salfred	struct options *opt = &options;
541201705Sthompsa	const char *ptr;
542201705Sthompsa	int unit;
543201705Sthompsa	int addr;
544184610Salfred	int n;
545184610Salfred	int t;
546184610Salfred
547184610Salfred	if (argc < 1) {
548184610Salfred		usage();
549184610Salfred	}
550184610Salfred	pbe = libusb20_be_alloc_default();
551184610Salfred	if (pbe == NULL)
552184610Salfred		err(1, "could not access USB backend\n");
553184610Salfred
554184610Salfred	for (n = 1; n != argc; n++) {
555184610Salfred
556184610Salfred		/* get number of additional options */
557184610Salfred		t = (argc - n - 1);
558184610Salfred		if (t > 255)
559184610Salfred			t = 255;
560184610Salfred		switch (get_token(argv[n], t)) {
561201705Sthompsa		case T_ADD_QUIRK:
562201705Sthompsa			if (opt->got_add_quirk) {
563201705Sthompsa				flush_command(pbe, opt);
564201705Sthompsa			}
565201705Sthompsa			opt->quirkname = argv[n + 1];
566201705Sthompsa			n++;
567201705Sthompsa
568201705Sthompsa			opt->got_add_quirk = 1;
569201705Sthompsa			opt->got_any++;
570201705Sthompsa			break;
571201705Sthompsa
572201705Sthompsa		case T_REMOVE_QUIRK:
573201705Sthompsa			if (opt->got_remove_quirk) {
574201705Sthompsa				flush_command(pbe, opt);
575201705Sthompsa			}
576201705Sthompsa			opt->quirkname = argv[n + 1];
577201705Sthompsa			n++;
578201705Sthompsa
579201705Sthompsa			opt->got_remove_quirk = 1;
580201705Sthompsa			opt->got_any++;
581201705Sthompsa			break;
582201705Sthompsa
583184610Salfred		case T_ADD_DEVICE_QUIRK:
584184610Salfred			if (opt->got_add_device_quirk) {
585184610Salfred				flush_command(pbe, opt);
586184610Salfred			}
587184610Salfred			opt->vid = num_id(argv[n + 1], "Vendor ID");
588184610Salfred			opt->pid = num_id(argv[n + 2], "Product ID");
589184610Salfred			opt->lo_rev = num_id(argv[n + 3], "Low Revision");
590184610Salfred			opt->hi_rev = num_id(argv[n + 4], "High Revision");
591184610Salfred			opt->quirkname = argv[n + 5];
592184610Salfred			n += 5;
593184610Salfred
594184610Salfred			opt->got_add_device_quirk = 1;
595184610Salfred			opt->got_any++;
596184610Salfred			break;
597184610Salfred
598184610Salfred		case T_REMOVE_DEVICE_QUIRK:
599184610Salfred			if (opt->got_remove_device_quirk) {
600184610Salfred				flush_command(pbe, opt);
601184610Salfred			}
602184610Salfred			opt->vid = num_id(argv[n + 1], "Vendor ID");
603184610Salfred			opt->pid = num_id(argv[n + 2], "Product ID");
604184610Salfred			opt->lo_rev = num_id(argv[n + 3], "Low Revision");
605184610Salfred			opt->hi_rev = num_id(argv[n + 4], "High Revision");
606184610Salfred			opt->quirkname = argv[n + 5];
607184610Salfred			n += 5;
608184610Salfred			opt->got_remove_device_quirk = 1;
609184610Salfred			opt->got_any++;
610184610Salfred			break;
611184610Salfred
612184610Salfred		case T_DUMP_QUIRK_NAMES:
613201705Sthompsa			if (opt->got_dump_quirk_names)
614201705Sthompsa				duplicate_option(argv[n]);
615184610Salfred			opt->got_dump_quirk_names = 1;
616184610Salfred			opt->got_any++;
617184610Salfred			break;
618184610Salfred
619184610Salfred		case T_DUMP_DEVICE_QUIRKS:
620201705Sthompsa			if (opt->got_dump_device_quirks)
621201705Sthompsa				duplicate_option(argv[n]);
622184610Salfred			opt->got_dump_device_quirks = 1;
623184610Salfred			opt->got_any++;
624184610Salfred			break;
625184610Salfred
626188622Sthompsa		case T_SHOW_IFACE_DRIVER:
627188622Sthompsa			opt->got_show_iface_driver = 1;
628188622Sthompsa			break;
629188622Sthompsa
630201705Sthompsa		case T_UGEN:
631201705Sthompsa			if (opt->got_any) {
632201705Sthompsa				/* allow multiple commands on the same line */
633201705Sthompsa				flush_command(pbe, opt);
634201705Sthompsa			}
635201705Sthompsa			ptr = argv[n + 1];
636201705Sthompsa
637201705Sthompsa			if ((ptr[0] == 'u') &&
638201705Sthompsa			    (ptr[1] == 'g') &&
639201705Sthompsa			    (ptr[2] == 'e') &&
640201705Sthompsa			    (ptr[3] == 'n'))
641201705Sthompsa				ptr += 4;
642201705Sthompsa
643201705Sthompsa			if ((sscanf(ptr, "%d.%d",
644201705Sthompsa			    &unit, &addr) != 2) ||
645201705Sthompsa			    (unit < 0) || (unit > 65535) ||
646201705Sthompsa			    (addr < 0) || (addr > 65535)) {
647201705Sthompsa				errx(1, "cannot "
648201705Sthompsa				    "parse '%s'", argv[n + 1]);
649201705Sthompsa			}
650201705Sthompsa			opt->bus = unit;
651201705Sthompsa			opt->addr = addr;
652201705Sthompsa			opt->got_bus = 1;
653214271Shselasky			opt->got_addr = 1;
654201705Sthompsa			n++;
655201705Sthompsa			break;
656201705Sthompsa
657184610Salfred		case T_UNIT:
658184610Salfred			if (opt->got_any) {
659184610Salfred				/* allow multiple commands on the same line */
660184610Salfred				flush_command(pbe, opt);
661184610Salfred			}
662184610Salfred			opt->bus = num_id(argv[n + 1], "busnum");
663184610Salfred			opt->got_bus = 1;
664184610Salfred			n++;
665184610Salfred			break;
666184610Salfred		case T_ADDR:
667184610Salfred			opt->addr = num_id(argv[n + 1], "addr");
668184610Salfred			opt->got_addr = 1;
669184610Salfred			n++;
670184610Salfred			break;
671184610Salfred		case T_IFACE:
672184610Salfred			opt->iface = num_id(argv[n + 1], "iface");
673184610Salfred			opt->got_iface = 1;
674184610Salfred			n++;
675184610Salfred			break;
676184610Salfred		case T_SET_CONFIG:
677201705Sthompsa			if (opt->got_set_config)
678201705Sthompsa				duplicate_option(argv[n]);
679185087Salfred			opt->config_index = num_id(argv[n + 1], "cfg_index");
680184610Salfred			opt->got_set_config = 1;
681184610Salfred			opt->got_any++;
682184610Salfred			n++;
683184610Salfred			break;
684184610Salfred		case T_SET_ALT:
685201705Sthompsa			if (opt->got_set_alt)
686201705Sthompsa				duplicate_option(argv[n]);
687185087Salfred			opt->alt_index = num_id(argv[n + 1], "cfg_index");
688184610Salfred			opt->got_set_alt = 1;
689184610Salfred			opt->got_any++;
690184610Salfred			n++;
691184610Salfred			break;
692188987Sthompsa		case T_SET_TEMPLATE:
693201705Sthompsa			if (opt->got_set_template)
694201705Sthompsa				duplicate_option(argv[n]);
695189110Sthompsa			opt->template = get_int(argv[n + 1]);
696188987Sthompsa			opt->got_set_template = 1;
697188987Sthompsa			opt->got_any++;
698188987Sthompsa			n++;
699188987Sthompsa			break;
700188987Sthompsa		case T_GET_TEMPLATE:
701201705Sthompsa			if (opt->got_get_template)
702201705Sthompsa				duplicate_option(argv[n]);
703188987Sthompsa			opt->got_get_template = 1;
704188987Sthompsa			opt->got_any++;
705188987Sthompsa			break;
706356404Shselasky		case T_DUMP_ALL_DESC:
707356404Shselasky			if (opt->got_dump_all_desc)
708356404Shselasky				duplicate_option(argv[n]);
709356404Shselasky			opt->got_dump_all_desc = 1;
710356404Shselasky			opt->got_any++;
711356404Shselasky			break;
712184610Salfred		case T_DUMP_DEVICE_DESC:
713201705Sthompsa			if (opt->got_dump_device_desc)
714201705Sthompsa				duplicate_option(argv[n]);
715184610Salfred			opt->got_dump_device_desc = 1;
716184610Salfred			opt->got_any++;
717184610Salfred			break;
718184610Salfred		case T_DUMP_CURR_CONFIG_DESC:
719201705Sthompsa			if (opt->got_dump_curr_config)
720201705Sthompsa				duplicate_option(argv[n]);
721184610Salfred			opt->got_dump_curr_config = 1;
722184610Salfred			opt->got_any++;
723184610Salfred			break;
724184610Salfred		case T_DUMP_ALL_CONFIG_DESC:
725201705Sthompsa			if (opt->got_dump_all_config)
726201705Sthompsa				duplicate_option(argv[n]);
727184610Salfred			opt->got_dump_all_config = 1;
728184610Salfred			opt->got_any++;
729184610Salfred			break;
730184610Salfred		case T_DUMP_INFO:
731201705Sthompsa			if (opt->got_dump_info)
732201705Sthompsa				duplicate_option(argv[n]);
733184610Salfred			opt->got_dump_info = 1;
734184610Salfred			opt->got_any++;
735184610Salfred			break;
736185087Salfred		case T_DUMP_STRING:
737201705Sthompsa			if (opt->got_dump_string)
738201705Sthompsa				duplicate_option(argv[n]);
739185087Salfred			opt->string_index = num_id(argv[n + 1], "str_index");
740185087Salfred			opt->got_dump_string = 1;
741185087Salfred			opt->got_any++;
742185087Salfred			n++;
743185087Salfred			break;
744184610Salfred		case T_SUSPEND:
745201705Sthompsa			if (opt->got_suspend)
746201705Sthompsa				duplicate_option(argv[n]);
747184610Salfred			opt->got_suspend = 1;
748184610Salfred			opt->got_any++;
749184610Salfred			break;
750184610Salfred		case T_RESUME:
751201705Sthompsa			if (opt->got_resume)
752201705Sthompsa				duplicate_option(argv[n]);
753184610Salfred			opt->got_resume = 1;
754184610Salfred			opt->got_any++;
755184610Salfred			break;
756184610Salfred		case T_POWER_OFF:
757201705Sthompsa			if (opt->got_power_off)
758201705Sthompsa				duplicate_option(argv[n]);
759184610Salfred			opt->got_power_off = 1;
760184610Salfred			opt->got_any++;
761184610Salfred			break;
762184610Salfred		case T_POWER_SAVE:
763201705Sthompsa			if (opt->got_power_save)
764201705Sthompsa				duplicate_option(argv[n]);
765184610Salfred			opt->got_power_save = 1;
766184610Salfred			opt->got_any++;
767184610Salfred			break;
768184610Salfred		case T_POWER_ON:
769201705Sthompsa			if (opt->got_power_on)
770201705Sthompsa				duplicate_option(argv[n]);
771184610Salfred			opt->got_power_on = 1;
772184610Salfred			opt->got_any++;
773184610Salfred			break;
774184610Salfred		case T_RESET:
775201705Sthompsa			if (opt->got_reset)
776201705Sthompsa				duplicate_option(argv[n]);
777184610Salfred			opt->got_reset = 1;
778184610Salfred			opt->got_any++;
779184610Salfred			break;
780184610Salfred		case T_LIST:
781201705Sthompsa			if (opt->got_list)
782201705Sthompsa				duplicate_option(argv[n]);
783184610Salfred			opt->got_list = 1;
784184610Salfred			opt->got_any++;
785184610Salfred			break;
786185087Salfred		case T_DO_REQUEST:
787201705Sthompsa			if (opt->got_do_request)
788201705Sthompsa				duplicate_option(argv[n]);
789185087Salfred			LIBUSB20_INIT(LIBUSB20_CONTROL_SETUP, &opt->setup);
790185087Salfred			opt->setup.bmRequestType = num_id(argv[n + 1], "bmReqTyp");
791185087Salfred			opt->setup.bRequest = num_id(argv[n + 2], "bReq");
792185087Salfred			opt->setup.wValue = num_id(argv[n + 3], "wVal");
793185087Salfred			opt->setup.wIndex = num_id(argv[n + 4], "wIndex");
794185087Salfred			opt->setup.wLength = num_id(argv[n + 5], "wLen");
795185087Salfred			if (opt->setup.wLength != 0) {
796185087Salfred				opt->buffer = malloc(opt->setup.wLength);
797185087Salfred			} else {
798185087Salfred				opt->buffer = NULL;
799185087Salfred			}
800185087Salfred
801185087Salfred			n += 5;
802185087Salfred
803185087Salfred			if (!(opt->setup.bmRequestType &
804185087Salfred			    LIBUSB20_ENDPOINT_IN)) {
805185087Salfred				/* copy in data */
806185087Salfred				t = (argc - n - 1);
807185087Salfred				if (t < opt->setup.wLength) {
808185087Salfred					err(1, "request data missing");
809185087Salfred				}
810185087Salfred				t = opt->setup.wLength;
811185087Salfred				while (t--) {
812185087Salfred					((uint8_t *)opt->buffer)[t] =
813185087Salfred					    num_id(argv[n + t + 1], "req_data");
814185087Salfred				}
815185087Salfred				n += opt->setup.wLength;
816185087Salfred			}
817185087Salfred			opt->got_do_request = 1;
818185087Salfred			opt->got_any++;
819185087Salfred			break;
820184610Salfred		default:
821184610Salfred			usage();
822184610Salfred			break;
823184610Salfred		}
824184610Salfred	}
825184610Salfred	if (opt->got_any) {
826184610Salfred		/* flush out last command */
827184610Salfred		flush_command(pbe, opt);
828184610Salfred	} else {
829184610Salfred		/* list all the devices */
830184610Salfred		opt->got_list = 1;
831184610Salfred		opt->got_any++;
832184610Salfred		flush_command(pbe, opt);
833184610Salfred	}
834184610Salfred	/* release data */
835184610Salfred	libusb20_be_free(pbe);
836184610Salfred
837184610Salfred	return (0);
838184610Salfred}
839