--- /dev/null
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <usb.h>
+#include <strings.h>
+#include <errno.h>
+
+#include "translate.h"
+#include "prox.h"
+#include "proxmark3.h"
+
+usb_dev_handle *devh = NULL;
+static unsigned int claimed_iface = 0;
+unsigned char return_on_error = 0;
+unsigned char error_occured = 0;
+
+void SendCommand(UsbCommand *c, BOOL wantAck) {
+ int ret;
+
+#if 0
+ printf("Sending %d bytes\n", sizeof(UsbCommand));
+#endif
+ ret = usb_bulk_write(devh, 0x01, (char*)c, sizeof(UsbCommand), 1000);
+ if (ret<0) {
+ error_occured = 1;
+ if (return_on_error)
+ return;
+
+ fprintf(stderr, "write failed: %s!\nTrying to reopen device...\n",
+ usb_strerror());
+
+ if (devh) {
+ usb_close(devh);
+ devh = NULL;
+ }
+ while(!(devh=OpenProxmark(0))) { sleep(1); }
+ printf(PROXPROMPT);
+ fflush(NULL);
+
+ return;
+ }
+
+ if(wantAck) {
+ UsbCommand ack;
+ ReceiveCommand(&ack);
+ if(ack.cmd != CMD_ACK) {
+ printf("bad ACK\n");
+ exit(-1);
+ }
+ }
+}
+
+int ReceiveCommandP(UsbCommand *c) {
+ int ret;
+
+ bzero(c, sizeof(UsbCommand));
+ ret = usb_bulk_read(devh, 0x82, (char*)c, sizeof(UsbCommand), 500);
+ if (ret<0) {
+ if (ret != -ETIMEDOUT) {
+ error_occured = 1;
+ if (return_on_error)
+ return 0;
+
+ fprintf(stderr, "read failed: %s(%d)!\nTrying to reopen device...\n",
+ usb_strerror(), ret);
+
+ if (devh) {
+ usb_close(devh);
+ devh = NULL;
+ }
+ while(!(devh=OpenProxmark(0))) { sleep(1); }
+ printf(PROXPROMPT);
+ fflush(NULL);
+
+ return 0;
+ }
+ } else {
+ if (ret && (ret < sizeof(UsbCommand))) {
+ fprintf(stderr, "Read only %d instead of requested %d bytes!\n",
+ ret, (int)sizeof(UsbCommand));
+ }
+
+#if 0
+ {
+ int i;
+
+ printf("Read %d bytes\n", ret);
+ for (i = 0; i < ret; i++) {
+ printf("0x%02X ", ((unsigned char*)c)[i]);
+ if (!((i+1)%8))
+ printf("\n");
+ }
+ printf("\n");
+ }
+#endif
+ }
+
+ return ret;
+}
+
+void ReceiveCommand(UsbCommand *c) {
+ while(ReceiveCommandP(c)<0) {}
+}
+
+usb_dev_handle* findProxmark(int verbose, unsigned int *iface) {
+ struct usb_bus *busses, *bus;
+ usb_dev_handle *handle = NULL;
+
+ usb_find_busses();
+ usb_find_devices();
+
+ busses = usb_get_busses();
+
+ for (bus = busses; bus; bus = bus->next) {
+ struct usb_device *dev;
+
+ for (dev = bus->devices; dev; dev = dev->next) {
+ struct usb_device_descriptor *desc = &(dev->descriptor);
+
+ if ((desc->idProduct == 0x4b8f) && (desc->idVendor == 0x9ac4)) {
+ handle = usb_open(dev);
+ if (!handle) {
+ if (verbose)
+ fprintf(stderr, "open failed: %s!\n", usb_strerror());
+ return NULL;
+ }
+
+ *iface = dev->config[0].interface[0].altsetting[0].bInterfaceNumber;
+
+ return handle;
+ }
+ }
+ }
+
+ return NULL;
+}
+
+usb_dev_handle* OpenProxmark(int verbose) {
+ int ret;
+ usb_dev_handle *handle = NULL;
+ unsigned int iface;
+
+#ifndef __APPLE__
+ handle = findProxmark(verbose, &iface);
+ if (!handle)
+ return NULL;
+
+ /* Whatever... */
+ usb_reset(handle);
+#endif
+
+ handle = findProxmark(verbose, &iface);
+ if (!handle)
+ return NULL;
+
+#ifndef __APPLE__
+ /* detach kernel driver first */
+ ret = usb_detach_kernel_driver_np(handle, iface);
+ /* don't complain if no driver attached */
+ if (ret<0 && ret != -61 && verbose)
+ fprintf(stderr, "detach kernel driver failed: (%d) %s!\n", ret, usb_strerror());
+#endif
+ ret = usb_claim_interface(handle, iface);
+ if (ret<0) {
+ if (verbose)
+ fprintf(stderr, "claim failed: %s!\n", usb_strerror());
+ return NULL;
+ }
+
+ claimed_iface = iface;
+ devh = handle;
+ return handle;
+}
+
+void CloseProxmark(void) {
+ usb_release_interface(devh, claimed_iface);
+ usb_close(devh);
+}