1 files changed, 61 insertions, 0 deletions
diff --git a/src/jtag/drivers/usb_common.c b/src/jtag/drivers/usb_common.c
new file mode 100644
index 00000000..463f1af9
--- /dev/null
+++ b/src/jtag/drivers/usb_common.c
@@ -0,0 +1,61 @@
+/***************************************************************************
+ *   Copyright (C) 2009 by Zachary T Welch <zw@superlucidity.net>          *
+ *                                                                         *
+ *   This program is free software; you can redistribute it and/or modify  *
+ *   it under the terms of the GNU General Public License as published by  *
+ *   the Free Software Foundation; either version 2 of the License, or     *
+ *   (at your option) any later version.                                   *
+ *                                                                         *
+ *   This program 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 General Public License for more details.                          *
+ *                                                                         *
+ *   You should have received a copy of the GNU General Public License     *
+ *   along with this program; if not, write to the                         *
+ *   Free Software Foundation, Inc.,                                       *
+ *   59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.             *
+ ***************************************************************************/
+
+#ifdef HAVE_CONFIG_H
+#include "config.h"
+#endif
+#include "usb_common.h"
+
+
+static bool jtag_usb_match(struct usb_device *dev,
+		const uint16_t vids[], const uint16_t pids[])
+{
+	for (unsigned i = 0; vids[i] && pids[i]; i++)
+	{
+		if (dev->descriptor.idVendor == vids[i] &&
+			dev->descriptor.idProduct == pids[i])
+		{
+			return true;
+		}
+	}
+	return false;
+}
+
+int jtag_usb_open(const uint16_t vids[], const uint16_t pids[],
+		struct usb_dev_handle **out)
+{
+	usb_find_busses();
+	usb_find_devices();
+
+	struct usb_bus *busses = usb_get_busses();
+	for (struct usb_bus *bus = busses; bus; bus = bus->next)
+	{
+		for (struct usb_device *dev = bus->devices; dev; dev = dev->next)
+		{
+			if (!jtag_usb_match(dev, vids, pids))
+				continue;
+
+			*out = usb_open(dev);
+			if (NULL == *out)
+				return -errno;
+			return 0;
+		}
+	}
+	return -ENODEV;
+}