//  VIA USB2 Fix
 
#include <stdio.h>
#include <proto/exec.h>
#include <proto/dos.h>
#include <proto/expansion.h>
#include <expansion/pci.h>
 
struct PCIDevice *USB2 = NULL;
struct Library *ExpansionBase;
struct PCIIFace *IPCI;
 
void clean_up()
{
  if (USB2) IPCI ->FreeDevice(USB2);
  IExec->DropInterface((struct Interface *)IPCI);
  IExec->CloseLibrary(ExpansionBase);
}
 
int main(int argc, char *argv[])
{
  UBYTE Data;
 
  printf("VIA USB2:\n");
 
  /* Open required OS resources, get handle to specified PCI device. */
  ExpansionBase = IExec->OpenLibrary("expansion.library", 50L);
  if (!ExpansionBase)
  {
    printf("\nCould not open expansion.library.\n\n");
    return 20;
  }
 
  IPCI = (struct PCIIFace *)IExec->GetInterface(ExpansionBase, "pci", 1, NULL);
  if (!IPCI)
  {
    printf("\nUnable to obtain PCI interface.\n\n");
    IExec->CloseLibrary(ExpansionBase);
    return 20;
  }
 
  USB2 = IPCI->FindDeviceTags(
      FDT_VendorID, 0x1106,
      FDT_DeviceID, 0x3104,
      TAG_DONE);
 
  if (!USB2)
  {
    printf("\nCannot find VIA USB2 device.\n\n");
    clean_up();
    return 5;
  }
 
  if ((USB2->ReadConfigByte(PCI_REVISION_ID) & 0xF0) == 0x60)
  {
    printf("Found VT6212\n");
 
	Data = USB2->ReadConfigByte(0x4B);
	printf("Data: %2x\n",Data);
	if (Data & 0x20)
	{
	  printf("Timer set\n");
	}
	else
	{
	  printf("Timer clear\n");
	  USB2->WriteConfigByte(0x4B, Data | 0x20);
	  Data = USB2->ReadConfigByte(0x4B);
	}
 
	Data = USB2->ReadConfigByte(0x49);
	printf("Data: %2x\n",Data);
	if (Data & 0x20)
	{
	  printf("Data set\n");
	  USB2->WriteConfigByte(0x4B, Data & (~0x20));
	  Data = USB2->ReadConfigByte(0x4B);
	}
	else
	{
	  printf("Data clear\n");
	}
  }
 
	Data = USB2->ReadConfigByte(0x6E);
	printf("Data: %2x\n",Data);
 	if (Data & 0x08)
	{
	  printf("Data set\n");
	}
	else
	{
	  printf("Data clear\n");
      USB2->WriteConfigByte(0x6E, Data | 0x08);
      Data = USB2->ReadConfigByte(0x6E);
	}
 
  clean_up();
  return 0;
}