#include <iostream>
#include <libusb.h>
#include <iomanip>

using namespace std;
using std::hex;

void dump(char* str, unsigned char *data, int size) {
  int i;
  int j;
  cout << str;
  for(i=0; i < size; i++ ){
    j=data[i];
    cout << " " << setfill('0') << setw(2) << hex << j;
  }
}


void transact(libusb_device_handle * dev_handle, unsigned char *data, int tx_len, unsigned char *result, int rx_len) {
  int r;

  dump((char *)"Sending ...:", data, tx_len);
  cout << "    ";

  r = libusb_control_transfer(dev_handle, 
			      LIBUSB_REQUEST_TYPE_CLASS |LIBUSB_RECIPIENT_INTERFACE,
			      0x09,
			      0x200,
			      0x0,
			      data,
			      tx_len,
			      5000);

  if(r != 8) {
    cout<<"Write Error "<<r<<endl;
    return;
  }

  int actual=0;

  r=libusb_bulk_transfer(dev_handle,
			 0x81,
			 result,
			 rx_len,
			 &actual,
			 2000);

  dump((char *)"Post read ...:", result, actual);

  if (r!=0)
    cout<<"Read error " << r << ". Actual read =" << actual << endl;

  cout << endl;
}


int main() {
  libusb_device **devs; //pointer to pointer of device, used to retrieve a list of devices
  libusb_device_handle *dev_handle; //a device handle
  libusb_context *ctx = NULL; //a libusb session
  int r; //for return values
  ssize_t cnt; //holding number of devices in list
  int i;

  unsigned char *data = new unsigned char[8]; //data to write
  data[0]=0; data[1]=0; data[2]=0; data[3]=0;
  data[4]=0; data[5]=0; data[6]=0xC8; data[7]=0x02;
  unsigned char *result = new unsigned char[255];

  r = libusb_init(&ctx); //initialize the library for the session we just declared
  if(r < 0) {
    cout<<"Init Error "<<r<<endl; //there was an error
    return 1;
  }
  libusb_set_debug(ctx, 3); //set verbosity level to 3, as suggested in the documentation

  cnt = libusb_get_device_list(ctx, &devs); //get the list of devices
  if(cnt < 0) {
    cout<<"Get Device Error"<<endl; //there was an error
    return 1;
  }
  cout<<cnt<<" Devices in list."<<endl;

  dev_handle = libusb_open_device_with_vid_pid(ctx, 0x0C45, 0x70C1); //these are vendorID and productID I found for my usb device
  if(dev_handle == NULL)
    cout<<"Cannot open device"<<endl;
  else
    cout<<"Device Opened"<<endl;
  libusb_free_device_list(devs, 1); //free the list, unref the devices in it

  /* sort out the kernel ... put it in it's rightful place */

  if(libusb_kernel_driver_active(dev_handle, 0) == 1) { //find out if kernel driver is attached
    cout<<"Kernel Driver Active"<<endl;

    if(libusb_detach_kernel_driver(dev_handle, 0) == 0) //detach it
      cout<<"Kernel Driver Detached!"<<endl;
  }

  r = libusb_claim_interface(dev_handle, 0); //claim interface 0 (the first) of device (mine had jsut 1)
  if(r < 0) {
    cout<<"Cannot Claim Interface"<<endl;
    return 1;
  }
  cout<<"Claimed Interface"<<endl;
 
  transact(dev_handle, data, 8, result, 8);

  /*
  ** Not sure yet what these packets are, but from USB Snoop ...
  */

  for (i=0; i<17; i++) {
    data[0]=i*6;
    data[1]=data[2]=data[3]=data[4]=data[5]=0;
    data[6]=i+1;
    data[7]=2;
    transact(dev_handle, data, 8, result, 8);
  }

  data[0]=0; data[1]=0; data[2]=0; data[3]=0;
  data[4]=0; data[5]=0; data[6]=0; data[7]=0x02;
  transact(dev_handle, data, 8, result, 8);

  data[0]=1; data[1]=0; data[2]=0; data[3]=0;
  data[4]=0; data[5]=0; data[6]=0xC9; data[7]=0x02;
  transact(dev_handle, data, 8, result, 8);

  data[0]=0; data[1]=0; data[2]=7; data[3]=0x20;
  data[4]=0x85; data[5]=0x05; data[6]=0x01; data[7]=0x03;
  transact(dev_handle, data, 8, result, 8);

  data[0]=4; data[1]=0; data[2]=0; data[3]=0;
  data[4]=0; data[5]=0; data[6]=0xC9; data[7]=0x02;
  transact(dev_handle, data, 8, result, 8);

  data[0]=0x01; data[1]=0x10; data[2]=0x51; data[3]=0x00;
  data[4]=0x00; data[5]=0x07; data[6]=0x01; data[7]=0x03;
  transact(dev_handle, data, 8, result, 8);



  r = libusb_release_interface(dev_handle, 0); //release the claimed interface
  if(r!=0) {
    cout<<"Cannot Release Interface"<<endl;
    return 1;
  }
  cout<<"Released Interface"<<endl;

  libusb_close(dev_handle); //close the device we opened
  libusb_exit(ctx); //needs to be called to end the

  delete[] data; //delete the allocated memory for data
  delete[] result;

  return 0;
}