// *****************************************
    // * (UDP) USB Resume Interrupt or WAKE_UP *
    // *****************************************
    if( (_IT_reg_b1 & AT91C_UDP_RXRSM) ||(_IT_reg_b1 & AT91C_UDP_WAKEUP))
    {
      AT91F_PMC_CfgSysClkEnableReg( AT91C_BASE_PMC, AT91C_PMC_PCK );
      USB_EVENT |= USB_EVENT_MASK_RESUME;

      AT91F_UDP_DisableIt( USBDEV_BASE_UDP, DISABLE_ALL_IT );
      AT91F_UDP_InterruptClearRegister( USBDEV_BASE_UDP, CLEAR_ALL_IT );
      AT91F_UDP_EnableIt( USBDEV_BASE_UDP,  AT91C_UDP_EPINT0 | AT91C_UDP_EPINT1
                                        | AT91C_UDP_EPINT2 | AT91C_UDP_RXSUSP
                                        | AT91C_UDP_RXRSM  | AT91C_UDP_EXTRSM
                                        | AT91C_UDP_SOFINT | AT91C_UDP_WAKEUP );
    
      AT91F_PMC_CfgSysClkEnableReg( AT91C_BASE_PMC, AT91C_PMC_UDP );

      AT91F_PMC_EnablePeriphClock( AT91C_BASE_PMC, (1 << AT91C_ID_UDP) );

      AT91F_UDP_EnableTransceiver(USBDEV_BASE_UDP);
      }

FW_FULL_CONFIG_DESCRIPTOR fw_config =
{
  { // Standard Configuration Descriptor
    sizeof(USB_CONFIGURATION_DESCRIPTOR),  // Size of this descriptor in bytes
    USB_CONFIGURATION_DESCRIPTOR_TYPE,     // CONFIGURATION Descriptor Type
    sizeof(FW_FULL_CONFIG_DESCRIPTOR),     // Total length of data returned for this configuration.
    1,                                      // Number of interfaces supported by this configuration
    1,                                     // Value to use as an argument to the SetConfiguration() request to select this configuration
    0,                                     // Index of string descriptor describing this configuration
    0x60,//USB_CONFIG_SELF_NOWAKEUP,//Must be 0x60    //USB_CONFIG_BUS_NOWAKEUP,               // attribute : Bus-powered, no wakeup
    0x01                                   // Maximum power consumption (in 2mA unit, so 0x01 =1= 2mA)
  },

/*
typedef struct _AT45_Device{
  int buflen;
  int pages;
  int blocks;
  char pagebits;
  char sign;
  const char * name;
}AT45_Device;
*/
#define AT45_Types  8
const AT45_Device AT45_Type[AT45_Types]=
  {
    { 264, 4096,  512,  9,  0,   "Unknown"},
    { 264,  512,   64,  9,  3, "AT45DB011"}, // 1  Mbit
    { 264, 1024,  128,  9,  5, "AT45DB021"}, // 2  Mbit
    { 264, 2048,  256,  9,  7, "AT45DB041"}, // 4  Mbit
    { 264, 4096,  512,  9,  9, "AT45DB081"}, // 8  Mbit
    { 528, 4096,  512, 10, 11, "AT45DB161"}, // 16 Mbit
    { 528, 8192, 1024, 10, 13, "AT45DB128"}, // 32 Mbit
    {1056, 8196, 1024, 11, 15, "AT45DB642"}  // 64 Mbit
  };



FS_AT45_InitSPI(void)
  {
  AT91PS_SPI pSPI = AT91C_BASE_SPI0;

  // enable peripheral clock for SPI
  AT91F_PMC_EnablePeriphClock (AT91C_BASE_PMC, (1 << AT91C_ID_SPI0));

  // SPI enable and reset
  if (!(pSPI->SPI_CR & AT91C_SPI_SPIEN))
    {
    pSPI->SPI_CR = AT91C_SPI_SWRST;
    pSPI->SPI_CR = AT91C_SPI_SPIDIS;
    pSPI->SPI_CR = AT91C_SPI_SPIEN;
    }
  // SPI mode: master, fixed periph. sel., FDIV=0, fault detection disabled
  pSPI->SPI_MR  = AT91C_SPI_MSTR | AT91C_SPI_PS_FIXED | AT91C_SPI_MODFDIS;

  // set chip-select-register
  // SPI mode 0: 8 bits per transfer, CPOL=0, ClockPhase=0, DLYBCT = 0
  //pSPI->SPI_CSR[AT45_SPI_CSRNum] = /*AT91C_SPI_CPOL |*/ AT91C_SPI_NCPHA | AT91C_SPI_BITS_8 | AT91C_SPI_CSAAT | (0xFF << 8);

  // SPI mode 3: 8 bits per transfer, CPOL=1, ClockPhase=1, DLYBCT = 0
  pSPI->SPI_CSR[AT45_SPI_CSRNum] = AT91C_SPI_CPOL | /*AT91C_SPI_NCPHA |*/ AT91C_SPI_BITS_8 | 0x0F << 8;
//  pSPI->SPI_CR = AT91C_SPI_SPIEN;

//  if(pSPI->SPI_SR & AT91C_SPI_SPIENS)
//    printf("SPI initialized...\n");
  }

  

// Read DataFlash status register
__ramfunc char FS_AT45_ReadStatus(U8 Unit)
  {
  char s;
  FS_AT45_DisableCS(Unit);
  FS_AT45_EnableCS(Unit);
  FS_AT45_RW(StatusReg);
  s = FS_AT45_RW(0xFF);
  FS_AT45_DisableCS(Unit);
  return s;
  }

int FS_AT45_InitDev(U8 Unit)
  {
  char result;
  int i;

  result = FS_AT45_ReadStatus(Unit);
//  printf("AT45 status %X\r\n", result);
  AT45_Devs[Unit] = &(AT45_Type[0]);
  for (i = AT45_Types; i >= 0; i--)
    if (((result >> 2) & 0x0F) == AT45_Type[i].sign)
      break;
  AT45_Devs[Unit] = &AT45_Type[i];
  if (i != 0)
    return 0;
  else
    return 1;
  }



int FS_AT45_InitDevice(U8 Unit)  // Called from AddDevice. Usually the first call to the driver
  {
  int result, i;
  char prev_dev;

  FS_AT45_InitPIO();
  FS_AT45_InitSPI();
  FS_AT45_DisableCS(Unit);
  prev_dev = FS_AT45_Select(AT45_SPI_CSRMask);
  FS_AT45_SetSpeed(AT45_MIN_SPEED);  //slow during init
  for(i=0;i<41;i++)
    FS_AT45_RW(0xFF);
  FS_AT45_SetSpeed(AT45_MAX_SPEED);
  result = FS_AT45_InitDev(Unit);
  //DataAbort will be detected if we use printf here! FS bag?
/*  if (result != 0)
    {
    printf("Error init AT45 devise No %d\n\r", Unit);
    }
  else
    {
    printf("Found %s\n\r", AT45_Devs[Unit]->name);
    }*/
  FS_AT45_Select(prev_dev);
  return result;
  }